Kin_Gantry2 (FB)

FUNCTION_BLOCK Kin_Gantry2 IMPLEMENTS ISMPositionKinematics_Offset,

ISMPositionKinematicsInternal, ISMKinematicWithInfo2

Transformation FB for a 2-axis gantry. In a gantry system, the machine coordinates correspond directly to the positions of the axes.

Machine coordinate system (MCS)

Origin

Location of the TCP when the position values of both axes are 0.

X

Corresponds directly to the direction of the first axis (a0), i.e. a positive velocity on the first axis leads to a movement in positive X direction in the MCS.

Y

Corresponds directly to the direction of the second axis (a1), i.e. a positive velocity on the second axis leads to a movement in positive Y direction in the MCS.

One may think of x and y as the width and length of a rectangle. The interior of this rectangle is referred to as the working envelope of the gantry robot.

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 x axis of the machine (X)

a1

position of the y axis of the machine (Y)

Attributes:
sm_kin_libdoc

Properties:

Methods:

Structure: