MC_MoveCircularCamFB

Quick Links :

📝 Description:
⚙️ FB Variables:
⚙️ FB Structures:
⏳ Timing Diagram:
📋 Examples:
💡 Additional Information:

📝 Description:

Move the TCP to an absolute cartesian position (circular interpolation).

⚙️ 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	ExecutionMode.SEQUENCE_PRIMARY	Execution mode of the command	M
Priority	PriorityLevel	PriorityLevel.NORMAL	Priority of the command	M
AbortingMode	AbortingMode	AbortingMode.BUFFER	Parameter which determines the behavior towards the previously sent and still active or buffered commands	M
SequenceFlag	SequenceFlag	SequenceFlag.PRIMARY_SEQUENCE	Defines the target sequence in which the command will be executed	M
Execute	BOOL	FALSE	Start of the command at the rising edge	M
ParCmd	[MoveCircularCamParCmd]	FALSE	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	-	Error occurred during execution. See ErrorID for details	M
ErrorID	WORD	-	Error ID as raw value for error diagnosis	M
ErrorIDEnum	RobotLibraryErrorIdEnum	-	Error ID as enumeration for error diagnosis	M
ErrorAddTxt	STRING(MAX_ADD_TEXT_LENGTH)	-	Additional error text information	M
WarningID	WORD	-	Warning ID as raw value for identifying warnings	M
WarningIDEnum	RobotLibraryWarningIdEnum	-	Warning ID as enumeration for identifying warning	M
InfoID	WORD	-	Info ID for as raw value for identifying additional information	M
InfoIDEnum	RobotLibraryInfoIdEnum	-	Info ID for as enumeration for identifying additional information	M
Done	BOOL	-	Command executed successfully	M
Busy	BOOL	-	Function block is being processed	M
CommmandBuffered	BOOL	-	Command was transferred to the robot-controller and confirmed	M
OutCmd	[MoveCircularCamOutCmd]	-	Command specific outputs	M

⚙️ FB Structures:

MoveCircularCamParCmd

Parameter	Data Type	Default Value	Description	Required
CircMode	CircMode	-	Specifies the meaning of the input parameter `AuxPoint`	M
AuxPoint	RobotCartesianPosition	-	Auxiliary position used for circular path calculation	M
CircPlane	CircPlane	-	Specifies the circle’s plane (only relevant if `CircMode = 2`)	M
Tolerance	REAL	-	Deviation tolerance for center distances (used with `CircMode = 1`) If exceeded, command returns an error	M
EndPoint	RobotCartesianPosition	-	Absolute end position (ignored if `CircMode = 2`)	M
Angle	REAL	-	Circular angle (used only when `CircMode = 2`) Always positive	M
PathChoice	PathChoice	-	Choice of the path (e.g., short/long arc)	M
VelocityRate	REAL	-	TCP velocity in % of nominal velocity • <0% (default): Use default velocity • 0%: Use internal minimal velocity • 100%: Use maximal reference velocity	M
AccelerationRate	REAL	-	Acceleration in % of nominal acceleration	M
DecelerationRate	REAL	-	Deceleration in % of nominal deceleration	M
JerkRate	REAL	-	Jerk in % of nominal jerk	M
ToolNo	USINT	-	Index of tool • 0: Flange (default) • 1..254: Tool frames	M
FrameNo	USINT	-	Index of frame • 0: WCS (default) • 1..254: User frames	M
BlendingMode	BlendingMode	-	Transition behavior to the next command Exact stop or blend types	M
BlendingParameter	ARRAY [0..1] OF REAL	[10, 0]	Defines blending radius or velocity limit	M
MoveTime	TIME	-	Defines movement duration if > 0 Overrides velocity settings	M
OriMode	OriMode	-	Orientation interpolation (RX, RY, RZ)	M
ConfigMode	ArmConfigParameter	-	Use of config byte in the position	M
TurnMode	TurnMode	-	Use of TurnNumber byte in the position	M
Index	USINT	-	Desired byte address for the digital output write	M
OutputBitmask	BYTE	-	Defines which outputs may be written	M
Value	BYTE	-	Value to write to the output	M
RelativePosition	BOOL	-	Reference for the trigger point • 0: Start position (default) • 1: End position	M
TriggerDelay	UINT	-	Delay in milliseconds before trigger point becomes active	M
TriggerDistance	REAL	-	Offset [%] from the reference position to trigger point	M
Manipulation	BOOL	-	TRUE = allows manipulation via superimposing	M

MoveCircularCamOutCmd

Parameter	Data Type	Default Value	Description	Required
Progress	REAL	-	Percentage of already traversed distance of current job. If not supported: • -1	M
RemainingDistance	REAL	-	Distance-to-go of the current job. • -1: Not active or unsupported • >0: Distance between current and target • 0: Target position reached	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;
  /// Move circular cam
  MoveCircularCam : MC_MoveCircularCamFB;
END_VAR

Call

// Call functionblock
MoveCircularCam
(
  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  : MoveCircularCamParCmd;
END_VAR

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

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

FunctionBlocks AdvancedMove MC_MoveCircularCamFB - ThorstenBrach/SRCI GitHub Wiki

MC_MoveCircularCamFB

📝 Description:

⚙️ FB Variables:

⚙️ FB Structures:

⏳ Timing Diagram:

📋 Examples:

💡 Additional Information:

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

⚠️ GitHub.com Fallback ⚠️

FunctionBlocks AdvancedMove MC_MoveCircularCamFB - ThorstenBrach/SRCI GitHub Wiki

MC_MoveCircularCamFB

📝 Description:

⚙️ FB Variables:

⚙️ FB Structures:

⏳ Timing Diagram:

📋 Examples:

💡 Additional Information:

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

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

⚠️ GitHub.com Fallback ⚠️