Added ThermalCommand code; Added NavigationCommand code for talking to IMU;