Added motor setter for speed. Seems to do nothing
Motor test: keep position and return to it if moved out
Display int correctly
Sensor test => failed. Imported code from http://robotnav.wordpress.com/uart_sensors/