这是一个例子：
1.function Q = FINDabc(A) %给定B1，B2两点坐标计算平面参数a，b，c
v = 1e-3*[1 1 1 1];r=1.3;l=0;
K=6;
a = RAND;
a = RESHAP_MAX(A,a,K);
while(sum(STAND(A,a(K,:))>v)~=0)
l=0;
[Q,w]=REF(a,r,K);
while((~D_ZONE1(Q))|(COMP(A,Q)>=COMP(A,a(K,:))))
[Q,w]=REF(a,w,K);
if (w<=eps^12)
a(K,:)=[];
K=K-1;
l = 1;
end
if(l==1)
break;
end
end
if(~l)
a(K,:)=Q;
end
if(K<=1)
a=FINDabc(A);
break;
end
a = RESHAP_MAX(A,a,K);
end
if(K<=1)
Q = a(1,:);
else Q=sum(a)./K;
end
11
2.function P=TEXT(i)
%对i组[a,b,c]检验，返回[a,b,c,a',b',c']
j = 1;
while(j<=i)
A(1,1:2)= CREAT_RAND12;
A(1,3)=CREAT_RAND3;
if(D_ZONE(A(1,:))==1)
b(j,:)=A(1,:);j=j+1;
end
end
for j=1:i
c(j,:)=Fx(b(j,:));
d(j,:)=FINDabc(c(j,:));
e(j,:)=(d(j,:)-b(j,:))./b(j,:);
end
P=[b,d,e];
plot(e(:,1),'b--o');hold on;
plot(e(:,2),'g-.x');
plot(e(:,3),'r:+');
3.function p = recognize(i)
%分辨率的影响
j = 1;
while(j<=i)
a(1,1:2) = CREAT_RAND12 ();
a(1,3) = CREAT_RAND3();
if(D_ZONE(a(1,:)))
b(j,:) = a(1,:);
j = j+1;
end
end
for j = 1:i
c(j,:) = Fx(b(j,:));
e(j,:)=1e-4*round(1e4*c(j,:));
end
for j = 1:i
f(j,1:3) = FINDabc(e(j,:));
end
hl = (b-f)./b;
for j = 1:3
h(:,j)=sum(abs(hl(:,j)))/i*ones(i,1);
end
plot(h(:,1),'--r');hold on;plot(h(:,2),'-y');plot(h(:,3),':k');
p = h;
12
4.function Q_C12 =CREAT_RAND12 ()
if(y_C12<=0.5)
Q_C12(1) =0.0017 *rand(1);
else
Q_C12(1) = -0.0017*rand(1);
end
y_C12 = rand(1);
if(y_C12<=0.5)
Q_C12(2) = 0.0017*rand(1);
else
Q_C12(2) = -0.0017*rand(1);
End
5.function Q_C = CREAT_RAND3()
y_C = rand(1);
if(y_C<=0.5)
Q_C = 3*1e-6*rand(1);
else
Q_C = -3*1e-6*rand(1);
end
6.function y = D_ZONE(Q_D)
p = pi/180/10;
a=Q_D(1);b=Q_D(2);c=Q_D(3);
if((abs(c)<3*1e-6)&((a^2+b^2)<(1/cos(p))^2-1))
y =1;
else
y=0;
end
7.function y = D_ZONE1(Q_D)
p = pi/180/10;
a=Q_D(1);b=Q_D(2);c=Q_D(3);
if((abs(c)<=3*1e-6)&((a^2+b^2)<=4*(1/cos(p))^2-1))
y =1;
else
y=0;
end
13
8.function Q_F = Fx(x)
D=-7*1e-1;h=3*1e-1;
B = -0.253; F = -0.259;
a = x(1);
b = x(2);
c = x(3);
s3 = 2*(c+D)/(1+a^2+b^2);
s2=-b*s3;
s1=-a*s3;
c13 = (c+D)/(1-b*B);
c12 = B*c13;
c23 = (c+D)/(1-b*F);
c22 = F*c23;
B11 = (h-s3)*(-s1)/(c13-s3)+s1;
B12 = (h-s3)*(c12-s2)/(c13-s3)+s2;
B21 = (h-s3)*(-s1)/(c23-s3)+s1;
B22 = (h-s3)*(c22-s2)/(c23-s3)+s2;
Q_F=[B11,B12,B21,B22];
9.function A = RAND()
i = 1;
while(i<=6)
A(i,1:2)= CREAT_RAND12;
A(i,3)=CREAT_RAND3;
if(D_ZONE(A(i,:))==1)
i=i+1;
end
end
10.function [Q,w] = REF(C,r,k)
B=C(k,:);C(k,:)=[];A=zeros(1,3);
for i=1:(k-1)
A=A+C(i,:);
end
if k>=2
A=A/(k-1);
end
Q = A+r*(A-B);
w=r/2;
end
14
11.function Q_M = RESHAP_MAX(B,A,K)
p=0;a=0;
for i =1:K
x(i)=COMP(B,A(i,:));
end
j=max(x);
for i=1:K
if x(i)==j,p=i;
end
end
a=A(p,:);
A(p,:) = A(K,:);
A(K,:)=a;
Q_M=A;
End
12.function w=STAND(A,R)
D=-7*1e-1;h=3*1e-1;
B = -.253; F = -.259;
a = R(1);
b = R(2);
c = R(3);
B11 = A(1);
B12 = A(2);
B21 = A(3);
B22 = A(4);
s3 = 2*(c+D)/(1+a^2+b^2);
s2=-b*s3;
s1=-a*s3;
c13 = (c+D)/(1-b*B);
c12 = B*c13;
c23 = (c+D)/(1-b*F);
c22 = F*c23;
F11 = (h-s3)*(-s1)/(c13-s3)+s1;
F12 = (h-s3)*(c12-s2)/(c13-s3)+s2;
F21 = (h-s3)*(-s1)/(c23-s3)+s1;
F22 = (h-s3)*(c22-s2)/(c23-s3)+s2;
w(1)=abs(B11-F11);
w(2)=abs(B12-F12);
w(3)=abs(B21-F21);
w(4)=abs(B22-F22);
