Added motion controller module and a calibration routine to the Sensor code