SMC_TRAFOV_GantryH2 (FB)ΒΆ
FUNCTION_BLOCK SMC_TRAFOV_GantryH2
Reverse transformation fortwo-dimensional H-gantry systems, taking into account the path velocity and path direction as control variables for the axis.
Note
For detailed information on transformations see overview to SM_Trafo_POUs.
- InOut:
Scope
Name
Type
Comment
Input
piTarget position vector (x,y), output of interpolator
dVelLREALPath velocity, output of interpolator
vSMC_VECTOR3DTangent path vector, output of interpolator
dOffsetXLREALAdditional offset for x-axis
dOffsetYLREALAdditional offset for y-axis
Output
daLREALResulting position of axis a
dvaLREALResulting velocity of axis a
dbLREALResulting position of axis b
dvbLREALResulting velocity of axis b