Element Coordination/Global Coordinates
Contents
Global Coordinates Concept
For working with robots of different point type's global coordinates concept has been defined. This allows giving robot position in one common unique format for independently how many axes the robot has. The key property used here is the robot's base transformation as described in:Robot_Working_Frames
BASE
There are two cartesian coordinate system associated with a robot: World Frame and Base Frame
World Frame
Having a robot in a pose defined by q = (q1,q2,q3, .... , qn) where n is the NDOF of the robot. The world frame coordinates are defined by:
where p can be: p = (x,y,z, yaw, pitch,roll) depending on robot kinematics.
NOTE | |
For the sake of simplicity of this discussion we assume the tool is included in Direct Kinematics calculation. Frames of WorkPiece and MachineTable are omitted here. |
Base Frame
Base Frame is the World Frame moved by the robot.base propert:
pbase = base:pworld
where : is the compound operator.
Global Coordinates
All user inputs (target points of motion commands , moving frame coordinates, etc.) are given in base coordinate system. However thse systems can differe from robot to robot (e.g. R1 has XYZR and R2 has XYZYPR). Therefore we assume one common (global) base coordinate system that will transform all robots into one system by:
p1global = R1.glbalbase:R1.base:R1.DirectKinemaitcs(R1.pcmd)
p2global = R2.glbalbase:R2.base:R2.DirectKinemaitcs(R2.pcmd)
p3global = R3.glbalbase:R3.base:R3.DirectKinemaitcs(R3.pcmd)
...
pmglobal = Rm.glbalbase:Rm.base:Rm.DirectKinemaitcs(Rm.pcmd)
Assuming system of m-robots.
This is achieved by adding <robot>.globalbase location that is always, indepandetly from the actual robot point type, given in XYZYPR system.
To make possible usage of global frame the motion commands (MOVE, MOVES, MOVESKD, CIRCLE, ...) are widen in such a way that locations of XYZYPR point type are accepted in addition to the currently only allowed location of the robot point type.
In a line with that there are also two new properties:
- <robot>.globalsetpoint analogous to the regular <robot>.setpoint
- <robot>.globalhere analogous to the regular <robot>.here
Example
Given SCARA and PUMA robots in same production cell one on a top of another: