Added a line to set manual bearing to current bearing when you switch to
manual flight mode
Merge remote-tracking branch 'origin/manual_bearing_fix'