FunctionBlocks Write MC_WriteRobotDefaultDynamicsFB - ThorstenBrach/SRCI GitHub Wiki

MC_WriteRobotDefaultDynamicsFB

📝 Description:

Write default values of dynamic parameters used by move commands.

⚙️ FB Variables:

VAR_INPUT
Parameter Data Type Default Value Description Required

InternalLogger

IMessageLogger

-

For internal usage only

-

ExternalLogger

IMessageLogger

-

For internal usage only

-

LogLevel

LogLevelEnum

-

For internal usage only

-

Name

STRING(20)

-

User defined command name

O

ExecMode

ExecutionMode

SEQExecutionMode.PARALLEL

Execution mode of the command

M

Priority

PriorityLevel

PriorityMode.NORMAL

Priority of the command

M

AxesGroup

AxesGroup

-

Robot group assigned to the function

M

Execute

BOOL

-

Start of the command at the rising edge

M

ParCmd

[WriteRobotDefaultDynamicsParCmd]

-

Command specific parameter

M
VAR_IN_OUT
Parameter Data Type Default Value Description Required

AxesGroup

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

BOOL

FALSE

Error occurred during execution. See ErrorID for details

M

ErrorID

WORD

0

Error ID as raw value for error diagnosis

M

ErrorIDEnum

RobotLibraryErrorIdEnum

NONE

Error ID as enumeration for error diagnosis

M

ErrorAddTxt

STRING(MAX_ADD_TEXT_LENGTH)

-

Additional error text information

M

WarningID

WORD

0

Warning ID as raw value for identifying warnings

M

WarningIDEnum

RobotLibraryWarningIdEnum

0

Warning ID as enumeration for identifying warning

M

InfoID

WORD

0

Info ID for as raw value for identifying additional information

M

InfoIDEnum

RobotLibraryInfoIdEnum

0

Info ID for as enumeration for identifying additional information

M

Done

BOOL

FALSE

Command executed successfully

M

Busy

BOOL

FALSE

Function block is being processed

M

CommmandBuffered

BOOL

FALSE

Command was transferred to the robot-controller and confirmed

M

CommandAborted

BOOL

FALSE

The command was aborted by another command

M

CommandInterrupted

BOOL

FALSE

TRUE, while command is interrupted during execution and can be continued.

M

OutCmd

[WriteRobotDefaultDynamicsOutCmd]

-

Command specific outputs

M

⚙️ FB Structures:

WriteRobotDefaultDynamicsParCmd
Parameter Data Type Default Value Description Required

DynamicValues

DefaultDynamics

-

Default dynamics values according to Table 6-141

M
WriteRobotDefaultDynamicsOutCmd
Parameter Data Type Default Value Description Required

DefaultDynamicValues

DefaultDynamics

-

Commanded dynamics values according to Table 6-141

M

⏳ Timing Diagram:

Work in progress – more content coming soon.

📋 Examples:

Declaration 
VAR_GLOBAL
  /// Robot assignment of function
  AxesGroup                 : AxesGroup;
  /// Robot Task
  RobotTask                 : MC_RobotTaskFB;
  /// Write default dynamics
  WriteRobotDefaultDynamics : MC_WriteRobotDefaultDynamicsFB;
END_VAR
Call 
// call function block
WriteRobotDefaultDynamics
(
  Name      := 'SRCI_Robot',
  ExecMode  := ExecutionMode.PARALLEL,
  Priority  := PriorityLevel.NORMAL,
  AxesGroup := AxesGroup
);
Usage 
VAR_INPUT
  /// Start command execution
  Execute : BOOL;
  /// Command parameter
  ParCmd  : WriteRobotDefaultDynamicsParCmd;
END_VAR

VAR_OUTPUT
  /// Error ID
  ErrorID     : DINT;
  /// Error addition text
  ErrorAddTxt : STRING;
  /// Command output
  OutCmd      : WriteRobotDefaultDynamicsOutCmd;
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)
WriteRobotDefaultDynamics.ParCmd := ParCmd;
// forwarding command output(s)
OutCmd := WriteRobotDefaultDynamics.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 WriteRobotDefaultDynamics.Busy  ) AND
         ( NOT WriteRobotDefaultDynamics.Error ))
     THEN
       // start execution
       WriteRobotDefaultDynamics.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 (WriteRobotDefaultDynamics.Error)
       THEN
         ErrorID     := WriteRobotDefaultDynamics.ErrorID;
         ErrorAddTxt := CONCAT('_stepCmd = ' , DINT_TO_STRING(_stepCmd));
       END_IF
     END_IF

  2: // Wait Execution done ?
     IF (( NOT WriteRobotDefaultDynamics.Busy ) AND
         (     WriteRobotDefaultDynamics.Done ))
     THEN
       // stop execution
       WriteRobotDefaultDynamics.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 (WriteRobotDefaultDynamics.Error)
       THEN
         ErrorID     := WriteRobotDefaultDynamics.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

💡 Additional Information:

Work in progress – more content coming soon.

This project is made with ❤️ for automation ⚙️ and robotics 🤖

⚠️ **GitHub.com Fallback** ⚠️