Added code to control the robot with a Wiimote :D