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 |
