This kinematic system is similar to H-gantry systems. The drives here are also mounted stationary and the tool holder is moved by means of a belt.
The transformations that are executed by the POUs SMC_TRAFO_GantryT2 and SMC_TRAFOF_GantryT2 are designed for the following drive constellations.
Please note that a special homing is necessary for this transformation.
If you execute a movement in the X direction, then you must move the A and B drives at the same velocity. If you execute a purely Y movement, then the drives must rotate in opposite directions. If the drive finds the homing position, then the X and Y values calculated from the forward transformation POU are used as the offset (dOffsetX and dOffsetY).
The SMC_TRAFO_GantryT2_O and SMC_TRAFOF_GantryT2_O function blocks execute the same calculation with the following constellation:
See also