FUNCTION_BLOCK Kin_Scara2_Z_Config
This FB contains the data that defines the configuration of SM3_Trafo_Scara2_Z.
InOut:
|
Scope |
Name |
Type |
Comment |
|
Input |
xElbowRight |
BOOL |
TRUE: the angle of the second joint is in the range [0° .. 180°[ FALSE: the angle of the second joint is in the range ]-180° .. 0°[ |
|
nPeriodA1 |
DINT |
see nPeriodA2 |
|
|
nPeriodA2 |
DINT |
Determines the period used for orientation axis A2. If the range of A2 is greater than 360°, the period to choose can be set here. If the value is zero, then the period is determined automatically, based on the last position. A positive value i > 0 means the range [360°*(i-1)-180° .. 360°*i-180°[ is used. A negative value i < 0 means the range [360°*i-180° .. 360°*(i+1)-180°[ is used. Note if nPeriodA2 <> 0 and the chosen period is not feasible due to the axis limits, an error is created during transformation (CartesianToAxes). |
|
|
Output |
Config |
The configuration data |
