void
terminate(char msg[]){
    printf(msg);
	off(MOTOR_NUMBER);
	running = 0;
	*SERVO = SERVO_RESET_POSITION;
	kill_process(runPID);
	kill_process(startPID);
	kill_process(stopPID);
}