SMC_TRAFO_Gantry2Tool2 (FB)ΒΆ
FUNCTION_BLOCK SMC_TRAFO_Gantry2Tool2
Reverse transformations for gantry systems with tool offset. The tool is approximated by a rectangular triangle.
- InOut:
Scope
Name
Type
Comment
Input
pi
Target vector position (x,y), ouptput of interpolator. SMC_POSINFO
dOffsetX
LREAL
Additional offset for x-axis
dOffsetY
LREAL
Additional offset for y-axis
dAlpha
LREAL
Angle indicating orientation of tool, can be calculated by use of SMC_CalcDirectionFromVector
dToolA
LREAL
Size of tool A = distance( set position) - (machine position)
dToolB
LREAL
Size of tool B = distance( set position) - (machine position)
Output
dx
LREAL
Resulting position for x-axis
dy
LREAL
Resulting position for y-axis