control.statederivativepid: fix warnings correctly
fix more warnings correctly
nav now has failsafe stubbed out