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
piTarget vector position (x,y), ouptput of interpolator. SMC_POSINFO
dOffsetXLREALAdditional offset for x-axis
dOffsetYLREALAdditional offset for y-axis
dAlphaLREALAngle indicating orientation of tool, can be calculated by use of SMC_CalcDirectionFromVector
dToolALREALSize of tool A = distance( set position) - (machine position)
dToolBLREALSize of tool B = distance( set position) - (machine position)
Output
dxLREALResulting position for x-axis
dyLREALResulting position for y-axis