ardupilot/libraries/AP_NavEKF/Models/GimbalEstimatorExample/calcF.cpp