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); } }
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); }