void loop() { char cmd = 'N'; //NULL if(Serial.available()) { cmd = (char)Serial.read(); printf("CMD = %c(%d) \n", cmd, cmd); } switch(cmd) { case 'L': servoAngle(LEFT, 2000); break; case 'R': servoAngle(RIGHT, 2000); break; case 'D': servoAngle(LEFT, 1000); servoAngle(RIGHT, 1000); break; default: break; } delay(200); }
void setup() { pinMode(LEFT, OUTPUT); pinMode(RIGHT, OUTPUT); servoAngle(LEFT, 1000); servoAngle(RIGHT, 1000); Serial.begin(9600); }
task main() { initializeRobot(); while(true) { getJoystickSettings(joystick); main_wheel(joystick.joy1_x1, joystick.joy1_y1); lift(joystick.joy2_y1); if ( joy2Btn(8)==1 ) elevMoveFree(joystick.joy2_y2); else elevMove(joystick.joy2_y2); resetElevEncoder(joy2Btn(3)); servoInitial(joy2Btn(2)); servoAngle (joy2Btn(4)); displayMessage(joy2Btn(1)); wait1Msec(TIME_INTERVAL); } }