Fixed rover autopilot swerving when target heading is due north (#106).

The fix makes the AP use the instantaneous vessel heading instead of the moving average one. This may make the controller less smooth, but in the worst case we should be able to deal with that by retuning the heading PID controller.
Merge branch 'dev' of https://github.com/MuMech/MechJeb2 into dev