SensorModule update

Started to implement the sensor position calibration. Not yet finished,
only rough implemented!