WPNav: bug fix to loiter accel calculation

Contribution from Leonard Hall