Custom IMU read program

UNTESTED.