FUNCTION_BLOCK SMC_TRAFOF_Gantry2Tool1
Forward transformation for two-dimensional gantries (X/Y) with tool offset, i.e. with the tool axis differing from the z-axis. The tool is approximated by a line.
Note
For detailed information on transformations see Overview to SM_Trafo_POUs.
InOut:
|
Scope |
Name |
Type |
Comment |
|
Inout |
DriveX |
AXIS_REF_SM3 |
Reference to x-axis. |
|
DriveY |
AXIS_REF_SM3 |
Reference to y-axis. |
|
|
Input |
dOffsetX |
LREAL |
Offset x-position. Equivalent to SMC_TRAFO_Gantry2 |
|
dOffsetY |
LREAL |
Offset y-position. Equivalent to SMC_TRAFO_Gantry2 |
|
|
dAlpha |
LREAL |
Angle indicating orientation of tool, can be calculated by use of SMC_CalcDirectionFromVector |
|
|
dToolA |
LREAL |
Tool size = distance(set position) - (machine position) |
|
|
minX |
LREAL |
Lower bound of move range in x-direction(for visualization purpose) |
|
|
maxX |
LREAL |
Upper bound of move range in x-direction(for visualization purpose) |
|
|
minY |
LREAL |
Lower bound of move range in y-direction(for visualization purpose) |
|
|
maxY |
LREAL |
Upper bound of move range in y-direction(for visualization purpose) |
|
|
Output |
dx |
LREAL |
X-position |
|
dy |
LREAL |
Y-position |
|
|
dnx |
LREAL |
Normed x-position (with value in [0,1]) |
|
|
dny |
LREAL |
Normed y-position (with value in [0,1]) |
|
|
dnl |
LREAL |
Normed length of the tool |
|
|
ratio |
LREAL |
ratio x-interval / y-interval |
|
|
dnOffsetX |
LREAL |
X-offset for visualization |
|
|
dnOffsetY |
LREAL |
Y-offset for visualization |
