AP_NavEKF :fix bug in state index used to access accel bias