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