static void go_to_start_position(void) { motor_backward(0, REVERSE_DUTY); motor_backward(1, REVERSE_DUTY); wait_until_start_position(); }
void go_to_center() { clear_screen(); print_string("BackUp"); left_count = 0; motor_backward(); while (left_count < HALF_WAY_DISTANCE); state = &find_target; motor_stop(); }
void loop() { if (Serial.available()) { String readString = ""; while (Serial.available()) { delay(3); if (Serial.available() > 0) { char c = Serial.read(); readString += c; } } if (readString.charAt(0) == 'M') { switch (readString.charAt(1)) { case 'f' : case 'F': motor_forward(); break; case 'b': case 'B': motor_backward(); break; case 'l': case 'L': motor_turnLeft(); break; case 'r': case 'R': motor_turnRight(); break; case 's': case 'S': motor_stop(); break; case 'm': case 'A': isUltra = !isUltra; break; case 'p': case 'P': char c = readString.charAt(2); ChangeSpeed((c - '0') * factor + minSpeed); break; } } } else { if (isUltra) { //ultraCarProcess(); } else { //motor_stop(); } } }