[LATER IN EARLY ACCESS] AP modes

[PJG]

Are all the automatic pilot modes functioning yet.

 

Altitude hold is all I can get to work.

[razo+r]

Altitude works, Attitude maybe, rest is WIP.