Fix scaling of sensor values in microcontroller
Calculate pitch and roll in test script