Programming a Pick&Place Robot
The sample projects Robotics_PickAndPlace.project and Robotics_PickAndPlace_without_Depictor.project are located in the installation directory at ...\\CODESYS\\Projects\\SoftMotion\\<Version>\\Examples. The project Robotics_PickAndPlace.project requires the CODESYS Depictor package to be installed. This project visualizes the kinematics in a 3D animation. The project Robotics_PickAndPlace_without_Depictor.project shows a simplified form of the sequence in a visualization screen.
In this section, only the objects are covered that are relevant for SoftMotion.
|
This example consists of a tripod, a rotary table, and a conveyor. The kinematics pick up a ring that is located on the rotary table. When picking up, the tool plate of the kinematics move synchronously with the rotary table. Then the ring is placed on a cone that is located on a conveyor belt. When placing, the kinematics move synchronously with the conveyor belt. Two buttons are located on the visualization screen for controlling the sequence. When you press the Auto button, the rings are set down automatically. Otherwise, the Play button appears for you to place the ring. |
|
See also
Controller CODESYS SoftMotion
Axis group Tripod: This axis group defines the kinematics and the mapping to the individual axes Tripod1, Tripod2, and Tripod3.
DepictorCalculations (PRG), Environment (PRG), Ring (FB): Programs for controlling the complete sequence and visualization. These POUs are not relevant for understanding PLCopen blocks, except the definition of the product coordinate system (PCS_1 and PCS_2).
Robot (PRG): Program for controlling the motion sequences. A detailed description is located in the next paragraph.
Visualization: Animated visualization for clarifying the sequence.
Tripod1, Tripod2, Tripode3: Linear axes of the tripod.
DriveRotaryTable: Axis for the rotary table.
DriveConveyorBelt: Axis for the conveyor belt.
Structure of the sequential program 'Robot (PRG)'
The program Robot (PRG) is run in cycles. At this time, the individual steps are performed depending on the state. At the end of a program, the calls of all used function blocks are ready for motion commanding.
The single axes of the tripod are activated (function blocks pwA1, pwA2 and pwA3 of type MC_Power).
CASE 0: Wait for the participating axes to be available.
CASE 10: Sets homing positions; in physical applications, homing is performed at this position (function blocks spA1, spA2, and spA3 of type MC_SetPosition).
CASE 20: Placement of the machine coordinate system in the world coordinate system (function block setCoord of type MC_SetCoordinateTransform).
CASE 30: Release of the axis group (function block enable of type MC_GroupEnable.
Wait for a response that the axis group has applied all values.
CASE 40 to CASE 130: Pick & place application: All movements are commanded possibly with a multiple instances MC_MoveDirectAbsolute, MC_MoveDirectRelative, and MC_MoveLinear which are called in cycles. A rising edge at the Execute input of these POUs in each status leads to issuing a new motion command in which the output bCommandAccepted indicates the success of the process. A typical chain of commands results from interrogating this output before the next motion command.
Function blocks 'MC_TrackConveyorBelt' and 'MC_TrackRotaryTable'
The function block MC_TrackRotaryTable, which is called in the Ring function block, is used for determining the partial coordinate system PCS_1. This coordinate system is set when a ring is placed on the rotary table.
The origin of the rotary table coordinate system RotaryTableOrigin is the midpoint of the rotary table. The z-axis is the rotary axis of the rotary table. The PCS_1 is rotated about the z-axis of the rotary table coordinate system as a function of the input variable RotaryTable. Because the axis group moves in PCS_1, it follows the rotation of the table.
The behavior is similar to function block MC_TrackConveyorBelt, which is called in the Cone function block. In this case, the PCS (PCS_2) follows the x-axis of the coordinate system ConveyorBeltOrigin.
