zzk.m

序惯最小二乘法

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