zzk.m

来自「序惯最小二乘法」· M 代码 · 共 7 行

function   y=ZZk(measure_maxtri)
u=100;
v=10;

y1=(measure_maxtri(1,:)).*sin(measure_maxtri(2,:))-u-(measure_maxtri(3,:)).*sin(measure_maxtri(4,:));
y2=(measure_maxtri(1,:)).*cos(measure_maxtri(2,:))-v-(measure_maxtri(3,:)).*cos(measure_maxtri(4,:));    
y=[y1;y2];