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]);