%求解滅點
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;