Fixing jacobian calculation in aircraft kinematic model