Fixed some motion stuff, need turn2
wip
Com check working
Merged in bearing control
Controls improved