U轴移动量
St(u)=((Ux-at)×(sin(θ´+θ)tan(θ´+θ)+cos(θ´+θ))+(bt+(Y´+Y)-Uy)× tan(θ´+θ)+at+(X´+X)-Ux) -((Ux-at)×(sinθtanθ+cosθ)+(bt+Y-Uy)×tanθ+at+X-Ux)
V轴移动量
St(v)=((Vy-bt)×(sin(θ´+θ)tan(θ´+θ)+cos(θ´+θ))+(Vx-at-(X´+X))× tan(θ´+θ)+bt+(Y´+Y)-Vy) -((Vy-bt)×(sinθtanθ+cosθ)+(Vx-at-X)×tanθ+bt+Y-Vy)
W轴移动量
St(w)=((Wy-bt)×(sin(θ´+θ)tan(θ´+θ)+cos(θ´+θ))+(Wx-at-(X´+X))× tan(θ´+θ)+bt+(Y´+Y)-Wy) -((Wy-bt)×(sinθtanθ+cosθ)+(Wx-at-X)×tanθ+bt+Y-Wy)