相对定向代码

function [BxByBz]=xiangduidingxiang %相对定向
%[filenamepathname]=uigetfile（‘14-15.txt‘‘选择相对定向点文件‘）;
%fid1=fopen（strcat（pathnamefilename）‘rt‘）;
%i=find（‘.‘==filename）;
%net_name=filename（1:i-1）;
%nt=fscanf（fid1‘%f‘1）;%点对个数
%f1=fscanf（fid1‘%f‘1）;%左片
%f2=fscanf（fid1‘%f‘1）;%右片
%f3=fscanf（fid1‘%f‘[4nt]）;%4行nt列
%fclose（fid1）;
x1=[0.1535.0522.522100.3268.34873.831]‘;%x1
y1=[91.7987.421-72.59861.9654.972-81.698]‘;%y1
x2=[-78.672-69.221-70.23826.822-4.8463.148]‘;%x2
y2=[89.1224.885-75.72360.7253.232-84.14]‘;%y2
sz=size（y2）;
np=sz（1）;

%确定初始值
f=152.910;
phi2=0;omega2=0;kappa2=0;u=0;r=0;
Bx=1000;%Bv=0;Bw=0;
X0=[phi2;omega2;kappa2;u;r];


DX=ones（51）;
z=-f*ones（1np）;
ct=0;%循环次数
while （abs（DX（1））>0.0003 || abs（DX（2））>0.0003 || abs（DX（3））>0.0003 || abs（DX（4））>0.0003 || abs（DX（5））>0.0003）
%计算像空辅助坐标
a1=cos（X0（1））*cos（X0（3））-sin（X0（1））*sin（X0（2））*sin（X0（3））;
a2=-cos（X0（1））*sin（X0（3））-sin（X0（1））*sin（X0（2））*cos（X0（3））;
a3=-sin（X0（