Added USB integration and lost GPS/lost data link modes
Fixed reference trajectory generation hangs; added minimum throttle constraint; added sensor health checks