GalileoBotball

1	// Test program: verifies all motors and servos are functioning.
2	// Run this on the robot before competition to check hardware.
3
4	#include <kipr/wombat.h>
5
6	void test_servo(int port) {
7	printf("testing servo %d\n", port);
8	printf("\tup 2 seconds\n");
9	enable_servo(port);
10	enable_servos();