www.gusucode.com > Simulink,飞行器控制源码程序 > Simulink,飞行器控制源码程序/Aerial_recovery_demo/drogue_mav_distance.m

    function uout = drogue_mav_distance(uu)
NN = 0;
mav.n = uu(NN+1);
mav.e = uu(NN+2);
mav.d = uu(NN+3);

NN = 9;
drogue.n = uu(NN+1);
drogue.e = uu(NN+2);
drogue.d = uu(NN+3);
uout = norm([mav.n;mav.e;mav.d] - [drogue.n;drogue.e;drogue.d]);