Sensor scaling validation

Fixed velocity and position scaling. Missing magnetometer calibration.