Sensors temperature correct

Fix gyro temp register address
Expand mag temp dimension (2 byte)
Using the measured coefficients for temperature calculation