void MotorPwm::setLevel(int level) 
{
	if (level > 0) {
		set_r_motor_mode(MOTOR_FORWARD);
		set_r_motor_pwm(level);
	} else if (level < 0) {
		set_r_motor_mode(MOTOR_REVERSE);
		set_r_motor_pwm(-level);
	} else {
		set_r_motor_mode(MOTOR_STOP);
		set_r_motor_pwm(0);
	}
} 
Esempio n. 2
0
int main()
{
	
	init();

	set_r_motor_mode(MOTOR_FORWARD);	
	set_l_motor_mode(MOTOR_FORWARD);
	set_r_motor_pwm(30);
	set_l_motor_pwm(30);
	wait_ms(2000);
	set_r_motor_pwm(60);
	set_l_motor_pwm(60);
	wait_ms(2000);
	set_r_motor_mode(MOTOR_REVERSE);	
	set_l_motor_mode(MOTOR_REVERSE);
	set_r_motor_pwm(40);
	set_l_motor_pwm(40);
	wait_ms(2000);
	set_r_motor_mode(MOTOR_STOP);
	set_l_motor_mode(MOTOR_STOP);
}