相机标定中灭点求解

%求解灭点
clear;
clc;
f=2241.69555523;
u0=643.46847217;
v0=511.75094915;
% dx=0.713604028998;
% dy=0.71385824382;
%将角点的像素坐标导入x，y
x=load（‘F:\刘新厂\IMU及视觉传感融合试验\旋转量的求解\角点数据\10x.txt‘）;
y=load（‘F:\刘新厂\IMU及视觉传感融合试验\旋转量的求解\角点数据\10y.txt‘）;
%分别取线上的开始以及最后的点
x1=x（1）;
x2=x（11）;
x3=x（12）;
x4=x（22）;
x5=x（23）;
x6=x（33）;
x7=x（34）;
x8=x（44）;
x9=x（45）;
x10=x（55）;
x11=x（56）;
x12=x（66）;
x13=x（67）;
x14=x（77）;
x15=x（78）;
x16=x（88）;

y1=y（1）;
y2=y（11）;
y3=y（12）;
y4=y（22）;
y5=y（23）;
y6=y（33）;
y7=y（34）;
y8=y（44）;
y9=y（45）;
y10=y（55）;
y11=y（56）;
y12=y（66）;
y13=y（67）;
y14=y（77）;
y15=y（78）;
y16=y（88）;
% %将像素坐标变换为物理坐标
% x1=（x1-u0）*dx;
% x2=（x2-u0）*dx;
% x3=（x3-u0）*dx;
% x4=（x4-u0）*dx;
% x5=（x5-u0）*dx;
% x6=（x6-u0）*dx;
% x7=（x7-u0）*dx;
% x8=（x8-u0）*dx;
% x9=（x9-u0）*dx;