Difference between revisions of "TARM robot"

From SoftMC-Wiki
Jump to: navigation, search
(Robot Configuration)
(Setup file)
Line 42: Line 42:
 
The only geometric parameter – segment length L1 is kept in '''<robot>.link[1][1]'''
 
The only geometric parameter – segment length L1 is kept in '''<robot>.link[1][1]'''
  
{|
+
{|border="1" width="80%"
 +
!width="100"|
 +
!width="100" |
 +
|-
 
Standard
 
Standard
 
Z-Roll
 
Z-Roll
Line 51: Line 54:
 
OCP)  
 
OCP)  
 
|
 
|
cplg[1][1] = 1
+
cplg[1][1] = 1<br>
cplg[1][2] = 0
+
cplg[1][2] = 0<br>
cplg[1][3] = 0
+
cplg[1][3] = 0<br>
cplg[1][4] = 0
+
cplg[1][4] = 0<br>
cplg[2][1] = 0
+
cplg[2][1] = 0<br>
cplg[2][2] = 1
+
cplg[2][2] = 1<br>
cplg[2][3] = 0
+
cplg[2][3] = 0<br>
cplg[2][4] = 0
+
cplg[2][4] = 0<br>
cplg[3][1] = 0
+
cplg[3][1] = 0<br>
cplg[3][2] = 0
+
cplg[3][2] = 0<br>
cplg[3][3] = 1
+
cplg[3][3] = 1<br>
cplg[3][4] = 40/360 ' 40mm/per revolution
+
cplg[3][4] = 40/360 ' 40mm/per revolution<br>
cplg[4][1] = 0
+
cplg[4][1] = 0<br>
cplg[4][2] = 0
+
cplg[4][2] = 0<br>
cplg[4][3] = 0
+
cplg[4][3] = 0<br>
cplg[4][4] = 1
+
cplg[4][4] = 1<br>
coupled = 1
+
coupled = 1<br>
 
|-
 
|-
 
Definition of L1 = 500 mm and positive
 
Definition of L1 = 500 mm and positive
 
vertical direction of Z axis.
 
vertical direction of Z axis.
 
|
 
|
axis[1][1] = 0
+
axis[1][1] = 0<br>
axis[1][2] = 0
+
axis[1][2] = 0<br>
axis[1][3] = 1
+
axis[1][3] = 1<br>
link[1][1] = 500
+
link[1][1] = 500<br>
link[1][2] = 0
+
link[1][2] = 0<br>
link[1][3] = 0
+
link[1][3] = 0<br>
 
|}
 
|}

Revision as of 13:51, 8 July 2014

TARM (Traverse Arm) robot

General setup

  • J1 is the linear traverse axis
  • J2 is angular axis of the Z-Roll couple.
  • J3 linear (Z) axis of the Z-Roll couple.
  • J4 additional rotational axis of the end-effector.

Kinematics

Inverse dynamic model for Traverse Arm kinematics - Definitions.png

Main Kinematics Equations

Direct Kinematics:

Inverse Kinematics:

NOTE-Info.svgNOTE
Singularity J2 at 90 degrees!

Additionally there is standard coupling between motor axes A2, A3 and J2, J3 (the SCARA/OCP gear box).


Robot Configuration

TARMCONFIG.PNG


Reference positions

Cartesian Location Joint (LEFTY) Joint (Righty)

#{L1 , 0 , 0 , 0} {0 , 0 , 0 , 0} {2L1 , 180 , 0 , -180}
#{0 , L1 , 0 , 0}1 {0 , 90 , 0 , -90} {0 , 90 , 0 , -90}
#{-L1 , 0 , 0 , 0} {-2*L1 , 0 , 0 , 0} {0 , 180 , 0 , -180}
#{0 , 0 , 0 , 0} {-L1 , 0 , 0 , 0} {L1 , 180 , 0 , -180}


Setup file

This kinematics type is defined using “model = 7” identifier. Traverse Arm Kinematics group definition:

common shared Tarm as group axnm = a5 axnm = a6 axnm = a7 axnm = a8 model = 7

The only geometric parameter – segment length L1 is kept in <robot>.link[1][1]

Standard Z-Roll coupling definition (same as SCARA or OCP) Definition of L1 = 500 mm and positive vertical direction of Z axis.

cplg[1][1] = 1
cplg[1][2] = 0
cplg[1][3] = 0
cplg[1][4] = 0
cplg[2][1] = 0
cplg[2][2] = 1
cplg[2][3] = 0
cplg[2][4] = 0
cplg[3][1] = 0
cplg[3][2] = 0
cplg[3][3] = 1
cplg[3][4] = 40/360 ' 40mm/per revolution
cplg[4][1] = 0
cplg[4][2] = 0
cplg[4][3] = 0
cplg[4][4] = 1
coupled = 1

axis[1][1] = 0
axis[1][2] = 0
axis[1][3] = 1
link[1][1] = 500
link[1][2] = 0
link[1][3] = 0