AP_NavEKF : fixed bug in weighting calc and increased zacc bias limits