Kin_TGantry2 (FB)

 

FUNCTION_BLOCK Kin_TGantry2 IMPLEMENTS ISMPositionKine­matics_Offset,

ISMPositionKinematicsInternal, ISMKinematicWithInfo2, ISMKine­maticAxisSettings

Transformation FB for a 2-axis T gantry.

The kinematics configuration is similar to Kin_HGantry2. The drives are mounted stationary and they move the y-axis rail and slider by means of a drive belt on the perimeter of the frame. (see picture aside; belt in pink).

TGantry.png

The transformation is adequate for the following axes configuration (other configurations can be reached by interchanging A and B):

TGantry_Config.png

A and B moving with the same speed results in a movement along the X axis, whereas A und B moving in opposite direction results in a pure Y-movement.

The orientation of the tool coordinate system equals the one of the machine coordinate system.

The single axes values have the following interpretation:

a0

position of the 1st axis of the machine (A)

a1

position of the 2nd axis of the machine (B)

Attributes:

sm_kin_libdoc