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