坐标系转换(七参数) MathLab
Xa=3516360.719;
Ya=518402.782;
Za=34.964;

%七参数

Tx=-5.855977597879;
Ty=-63.421779679192;
Tz=9.188365321063;
Wx= 0.000004463236;
Wy=-0.000002473494;
Wz=-0.000005115077;
M=-0.000011107611;

 

A=[Xa;Ya;Za];
B=[1 0 0 0 -Za Ya Xa;0 1 0 Za 0 -Xa Ya;0 0 1 -Ya Xa 0 Za];
C=[Tx;Ty;Tz;Wx;Wy;Wz;M];
D=A+  B*C;

X=D(1);
Y=D(2);
Z=D(3);