void kickBall(struct RoboAI* ai) { all_stop(); printf("KICKING\n"); kick_speed(100); drive_speed(100); sleep(2); stop_kicker(); all_stop(); // go to reset state ai->st.state++; }
int retract_speed(int speed){ return kick_speed(-speed); }
int stop_kicker(){ return kick_speed(0); }
//kick int kick(){ return kick_speed(MAX_SPEED); }
int all_stop(){ kick_speed(0); return drive_speed(0); }