Commander+Traj

Commander e trajectory app revamped.
Everything compiles.
TODO: test with qgroudcontrol