Initial round of fixes after rebase with next.
Fixed HiTL breakage left over from control refactoring.
Merge branch 'gcs-controller-fix' into path-refactor-v3
Fixed fixed-wing path follower after review comments.
Removed support for minimal memory path following.