"//Code to test if all on bot is working #include void test_servo(port) { printf(""testing servo%d\n"",port); printf(""\tup 2 seconds\n""); enable_servo(port); enable_servos(); set_servo_position(port,0); msleep(2000); set_servo_position(port,2047); msleep(2000); disable_servo(port); disable_servos(); } void test_motor(port) { printf(""testing motor%d\n"",port); printf(""\tforward 2 seconds\n""); motor(port,100); msleep(2000); printf(""\tbackwords 2 seconds\n""); motor(port,-100); msleep(2000); ao(); } int main() { test_motor(0); test_motor(1); test_motor(2); test_motor(3); test_servo(0); test_servo(1); return 0; }"