Added IMU data to 50Hz loop and added logging to control callback.  Currently, the callback is never entered.  Disconnects after sending Ctrl.