/*已知原坐標(biāo)A1(Xa1,Ya1),B1(Xb1,Yb1),C1(Xc1,Yb1)
原產(chǎn)品經(jīng)過擺動后，新坐標(biāo)為
偏移量，ΔX,ΔY

2點(diǎn)拍照，得出A2(Xa2,Ya2),B2(Xb2,Yb2)

求C點(diǎn)新坐標(biāo)C2（Xc2,Yc2）

K1=(Ya1-Yb1)/(Xa1-Xb1)
K2=(Ya2-Yb2)/(Xa2-Xb2)
第一步
利用夾角公式，求得tan&的值。
tan&=|(k1-k2)/(1+k1*k2)|

K1-K2>0,在原圖像上進(jìn)行順時(shí)針旋轉(zhuǎn)偏移，即Tan&為正值
K1-K2<0,在原圖像上進(jìn)行逆時(shí)針旋轉(zhuǎn)偏移，即Tan&為負(fù)值

利用兩點(diǎn)確立的直線在坐標(biāo)系中，斜率想減的值，確認(rèn)&為正值還是負(fù)值
確定&是正角度偏移或負(fù)角度偏移，即tan&取正值還是負(fù)值

第二步

TAN&為已知，則弧度=ARCTAN&
那么SIN&=SIN(arctan&)
    COS&=COS(arctan&)
    /
    
第三步
由最初A1,B1,C1.
到|AC|=√[(Xa1-Xc1)^2+(Ya1-Yc1)^2]

那么C2的坐標(biāo)Xc2=(COS&*|AC|)+Xa2
            Yc2=SIN&*|AC|+Ya2

    
總結(jié)，1，根據(jù)已知坐標(biāo)值，求得圖像旋轉(zhuǎn)偏移角度（弧度）值，
      2，已知坐標(biāo)，求得第三點(diǎn)基于已知點(diǎn)的關(guān)系，兩點(diǎn)線段長度
      3，推到得出改變后第三點(diǎn)，相對于改變后已知點(diǎn)的，坐標(biāo)值
      
      */
DATAN(TRUE, 1, TEMP1 );
DSIN(TRUE,TEMP1,D1000:E);

數(shù)學(xué)不過關(guān)，矩陣看不懂。

還是平面內(nèi)的旋轉(zhuǎn)好理解些