The IMU was mounted upside down on the final PCB

Also turning was inverted after we soldered everything together
Read diagnostic pins - deactivated for now
Move currentSpeed calculation up before turning