Added IMU guts and preliminary callback