日本HEPHAIST-UVW平台系列
2023-06-14 10:01
多摩川精机
TS3664N16E2
三菱电机
HG-AK0236(20W)
东方马达
PK543NAW
三菱电机
HG-KR053(50W)
东方马达
PK546PA
三菱电机
HG-KR053(50W)
东方马达
PK546PA
三菱电机
HG-KR053(50W)
【算法所需的值】
各轴执行器 pin 的初始坐标(固有值)
U轴:(Ux,Uy)
V轴:(Vx,Vy)
W轴:(Wx,Wy)
回转中心 :(at,bt)
现台面位置 (绝对坐标):(X,Y,θ)
台面移动量 (相对坐标) :(X´,Y´,θ´)
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)