all compiles and seems to work. Needs proper testing. The IMU outputs a
position however and it moves in the correct range.