FunctionBlocks AdvancedMove MC_MoveLinearRelativeFB - ThorstenBrach/SRCI GitHub Wiki
VAR_INPUT
Parameter | Data Type | Default Value | Description | Required |
---|---|---|---|---|
InternalLogger |
- |
For internal usage only |
- |
|
ExternalLogger |
- |
For internal usage only |
- |
|
LogLevel |
- |
For internal usage only |
- |
|
Name |
- |
User defined command name |
O |
|
ExecMode |
SEQUENCE_PRIMARY |
Execution mode of the command |
M |
|
Priority |
PriorityLevel.NORMAL |
Priority of the command |
M |
|
AbortingMode |
AbortingMode.BUFFER |
Parameter which determines the behavior towards the previously sent and still active or buffered commands |
M |
|
SequenceFlag |
SequenceFlag.PRIMARY_SEQUENCE |
Defines the target sequence in which the command will be executed |
M |
|
Execute |
- |
Start of the command at the rising edge |
M |
|
ParCmd |
- |
Command specific parameter |
M |
VAR_IN_OUT
Parameter | Data Type | Default Value | Description | Required |
---|---|---|---|---|
AxesGroup |
- |
Robot group assigned to the function |
M |
VAR_OUTPUT
Parameter | Data Type | Default Value | Description | Required |
---|---|---|---|---|
CommandData |
RobotLibraryCommandDataFB |
- |
For internal usage only |
- |
ResponseData |
RobotLibraryResponseDataFB |
- |
For internal usage only |
- |
Error |
- |
Error occurred during execution. See ErrorID for details |
M |
|
ErrorID |
- |
Error ID as raw value for error diagnosis |
M |
|
ErrorIDEnum |
- |
Error ID as enumeration for error diagnosis |
M |
|
ErrorAddTxt |
- |
Additional error text information |
M |
|
WarningID |
- |
Warning ID as raw value for identifying warnings |
M |
|
WarningIDEnum |
- |
Warning ID as enumeration for identifying warning |
M |
|
InfoID |
- |
Info ID for as raw value for identifying additional information |
M |
|
InfoIDEnum |
- |
Info ID for as enumeration for identifying additional information |
M |
|
Done |
- |
Command executed successfully |
M |
|
Busy |
- |
Function block is being processed |
M |
|
CommmandBuffered |
- |
Command was transferred to the robot-controller and confirmed |
M |
|
OutCmd |
- |
Command specific outputs |
M |
MoveLinearRelativeParCmd
Parameter | Data Type | Default Value | Description | Required |
---|---|---|---|---|
Distance |
- |
Relative distance and rotation from the current or last target position to the end point |
M |
|
ReferenceType |
- |
Defines type of reference coordinate system of the offset position. |
M |
|
VelocityRate |
- |
TCP velocity in % of nominal velocity |
M |
|
AccelerationRate |
- |
Acceleration for movement in % of nominal acceleration |
M |
|
DecelerationRate |
- |
Deceleration for movement in % of nominal deceleration |
M |
|
JerkRate |
- |
Jerk of the movement in % of nominal jerk |
M |
|
ToolNo |
- |
Index of tool |
M |
|
FrameNo |
- |
Index of frame |
M |
|
BlendingMode |
- |
Transition behavior at the end of the movement |
M |
|
BlendingParameter |
ARRAY [0..1] OF REAL |
[10, 0] |
Defines velocity limit (%) or blending radius depending on the blending mode |
M |
MoveTime |
- |
If > 0, overrides velocity and defines time for the move |
M |
|
OriMode |
- |
Describes how orientation axes (RX, RY, RZ) are interpolated |
M |
|
ConfigMode |
- |
Defines usage of the config byte in the position |
M |
|
TurnMode |
- |
Defines usage of the TurnNumber byte in the position |
M |
|
Manipulation |
- |
TRUE = allow manipulation of this command through superimposing functions |
M |
|
EmitterID |
ARRAY [0..3] OF SINT |
- |
ID of Action executed with this command |
M |
MoveLinearRelativeOutCmd
Parameter | Data Type | Default Value | Description | Required |
---|---|---|---|---|
Progress |
- |
Percentage of already traversed distance of current job. |
M |
|
RemainingDistance |
- |
Distance-to-go of the current job. |
M |
|
FollowID |
- |
Unique system-generated ID of the trigger function when called by the user. |
M |
Declaration
VAR_GLOBAL
/// Robot assignment of function
AxesGroup : AxesGroup;
/// Robot Task
RobotTask : MC_RobotTaskFB;
/// Move linear relative
MoveLinearRelative : MC_MoveLinearRelativeFB;
END_VAR
Call
// Call functionblock
MoveLinearRelative
(
Name := 'SRCI_Robot',
ExecMode := ExecutionMode.SEQUENCE_PRIMARY,
Priority := PriorityLevel.NORMAL,
AbortingMode := AbortingModeEnum.BUFFER,
SequenceFlag := SequenceFlagEnum.PRIMARY_SEQUENCE,
AxesGroup := AxesGroup
);
Usage
VAR_INPUT
/// Start command execution
Execute : BOOL;
/// Command parameter
ParCmd : MoveLinearRelativeParCmd;
END_VAR
VAR_OUTPUT
/// Error ID
ErrorID : DINT;
/// Error addition text
ErrorAddTxt : STRING;
/// Command outputs
OutCmd : MoveLinearRelativeOutCmd;
END_VAR
VAR
/// internal step counter
_stepCmd : DINT;
/// internal timer for command
_timerCmd : TON;
/// internal timeout for command
_timeoutCmd : TIME := T#5S;
END_VAR
// forwarding command parameter(s)
MoveLinearRelative.ParCmd := ParCmd;
// forwarding command output(s)
OutCmd := MoveLinearRelative.OutCmd;
CASE _stepCmd OF
0: // start execution ?
IF ( Execute )
THEN
// Reset request
Execute := FALSE;
// set timeout
SetTimeout(PT := _timeoutCmd, rTimer := _timerCmd);
// inc step counter
_stepCmd := _stepCmd + 1;
END_IF
1: // Start Execution
IF (( NOT MoveLinearRelative.Busy ) AND
( NOT MoveLinearRelative.Error ))
THEN
// start execution
MoveLinearRelative.Execute := TRUE;
// set timeout
SetTimeout(PT := _timeoutCmd, rTimer := _timerCmd);
// inc step counter
_stepCmd := _stepCmd + 1;
ELSE
// timeout exceeded ?
IF (CheckTimeout(_timerCmd) = RobotLibraryConstants.OK)
THEN
ErrorID := RobotLibraryErrorIdEnum.ERR_TIMEOUT_CMD;
ErrorAddTxt := CONCAT('_stepCmd = ' , DINT_TO_STRING(_stepCmd));
END_IF
// Error occurred ?
IF (MoveLinearRelative.Error)
THEN
ErrorID := MoveLinearRelative.ErrorID;
ErrorAddTxt := CONCAT('_stepCmd = ' , DINT_TO_STRING(_stepCmd));
END_IF
END_IF
2: // Wait Execution done ?
IF (( NOT MoveLinearRelative.Busy ) AND
( MoveLinearRelative.Done ))
THEN
// stop execution
MoveLinearRelative.Execute := FALSE;
// set timeout
SetTimeout(PT := _timeoutCmd, rTimer := _timerCmd);
// set step counter
_stepCmd := 0;
ELSE
// timeout exceeded ?
IF (CheckTimeout(_timerCmd) = RobotLibraryConstants.OK)
THEN
ErrorID := RobotLibraryErrorIdEnum.ERR_TIMEOUT_CMD;
ErrorAddTxt := CONCAT('_stepCmd = ' , DINT_TO_STRING(_stepCmd));
END_IF
// Error occurred ?
IF (MoveLinearRelative.Error)
THEN
ErrorID := MoveLinearRelative.ErrorID;
ErrorAddTxt := CONCAT('_stepCmd = ' , DINT_TO_STRING(_stepCmd));
END_IF
END_IF
ELSE
// invalid step
ErrorID := RobotLibraryErrorIdEnum.ERR_INVALID_STEP;
ErrorAddTxt := CONCAT('_stepCmd = ' , DINT_TO_STRING(_stepCmd));
END_CASE