1 function z = get_dp(xDist,zDist,Vx,Vz,Ix,Iz,Ixz,A) 2 3 denom = (Ix*Iz-Ixz^2); 4 z = -A*xDist*(Ix*Vx-Ixz*Vz)/denom - A*zDist*(Iz*Vz-Ixz*Vx)/denom; 5