He hecho el código fuente del robot, y me queda por añadirle los botones de subir y bajar la pala, como me pedisteis, pero tardare un poco dado que es mas complejo de lo que me creía. Me lo corrigió uno de los ''monitores'' que tenemos en el proyecto, así que creo que debería funcionar correctamente.
Antonio Camarero.