AP_NavEKF : Fix bug that causes false positive on EKF divergence test

The introduction of the EKF smoothing patch means that when manoeuvring rapidly, the EKF does GPS fusion immediately rather than spreading it. This improves stability of the filter, but has had the unintended consequence of making it easier to false trigger the divergence check. The following figures are the divergence test level taken from two flights, one with rapid 5 rad/sec continuous yaw of an IRIS+ and one with hammerhead manoueves on a trad heli. A test value of 100 will cause the divergence check to false trigger, so it can be seen from these logs we need to improve the trigger margin significantly
![iris rapid yaw divergence test](https://cloud.githubusercontent.com/assets/3596952/4268547/370774c0-3cb0-11e4-9644-b38672d661d2.png)
![trad heli aerobatics divergence test](https://cloud.githubusercontent.com/assets/3596952/4268549/3f48ca12-3cb0-11e4-998f-fdd42d2429dc.png)