Added test program to control robot. Uses pygame.