Working on trying to remove the 12 second latency caused when I insert the command send_message(MSG_THERMO_ATTITUDE)