Control/UAV/Ardupilot: Entity State was not updating correctly.
Transports/SerialOverTCP: Better handling buffer data and corrected concurrency issues with queue access.