
3.MANUAL OPERATION OPERATION B-63324EN-1/03
- 98 -
Movement amount of linear axis
Xp=L× [sin(A+Ap)×sin(C+Cp)-sin(A)×sin(C)]
Yp=L× [sin(A+Ap)×cos(C+Cp)-sin(A)×cos(C)]
Zp=L× [cos(A+Ap)-cos(A)]
Angular displacement of the rotation axis
Ap=Hp or Cp=Hp
- Rotation axes A and B (with the X-axis representing the tool axis)
B
X
Y
Z
T
1
A
T
2
Ap
Bp
Zp
Xp
Yp
T1 :
Tool rotation center position
T2 :
Tool rotation center position after movement
Ap, Bp : Angular displacement of the rotation axis
Movement amount of linear axis
Xp=L× [cos(B+Bp)-cos(B)]
Yp=L× [sin(B+Bp)×sin(A+Ap)-sin(B)×sin(A)]
Zp=-L× [sin(B+Bp)×cos(A+Ap)-sin(B)×cos(A)]
Angular displacement of the rotation axis
Ap=Hp or Bp=Hp