Added additional vector functions, fixed seatbelt for global estimators
Merge branch 'fixedwing_l1' of github.com:PX4/Firmware into fixedwing_l1