R2::module updated

francescoriccio · Dec 12, 2013 · a17ec3d · a17ec3d
1 parent cdd57e1
commit a17ec3d
Show file tree

Hide file tree

Showing 26 changed files with 1,642 additions and 382 deletions.
diff --git a/naoqi/modules/R2module/config/CoM_head.cfg b/naoqi/modules/R2module/config/CoM_head.cfg
@@ -0,0 +1,4 @@
+[ T ] = 
+{
+T 0 0 126.5
+}
diff --git a/naoqi/modules/R2module/config/CoM_leftArm.cfg b/naoqi/modules/R2module/config/CoM_leftArm.cfg
@@ -0,0 +1,5 @@
+[ T ] = 
+{
+T 0 98 100
+R 1 0 0 -M_PI/2
+}
diff --git a/naoqi/modules/R2module/config/CoM_leftLeg.cfg b/naoqi/modules/R2module/config/CoM_leftLeg.cfg
@@ -0,0 +1,9 @@
+[ T ] = 
+{
+T 0 50 -85
+R 1 0 0 M_PI/4
+R 1 0 0 M_PI
+}
+H 0 0 0 q1 : LHipYawPitch
+R 1 0 0 -M_PI/4
+R 0 1 0 -M_PI/2
diff --git a/naoqi/modules/R2module/config/CoM_rightArm.cfg b/naoqi/modules/R2module/config/CoM_rightArm.cfg
@@ -0,0 +1,5 @@
+[ T ] = 
+{
+T 0 -98 100
+R 1 0 0 -M_PI/2
+}
diff --git a/naoqi/modules/R2module/config/CoM_rightLeg.cfg b/naoqi/modules/R2module/config/CoM_rightLeg.cfg
@@ -0,0 +1,9 @@
+[ T ] = 
+{
+T 0 -50 -85
+R 1 0 0 -M_PI/4
+}
+H 0 0 0 q1 : RHipYawPitch
+R 1 0 0 -M_PI/4
+R 1 0 0 -M_PI/2
+R 0 1 0 M_PI/2
diff --git a/naoqi/modules/R2module/config/dh_LAbase.cfg b/naoqi/modules/R2module/config/dh_LAbase.cfg
@@ -0,0 +1,8 @@
+[ chain ] = 
+{
+: LWristYaw
+: LElbowRoll
+: LElbowYaw
+: LShoulderRoll
+: LShoulderPitch
+}
diff --git a/naoqi/modules/R2module/config/dh_LLbase.cfg b/naoqi/modules/R2module/config/dh_LLbase.cfg
@@ -0,0 +1,17 @@
+[ chain ] = 
+{
+H 0 M_PI/2 0 q1 : LAnkleRoll
+H 102.9 0 0 q2 : LAnklePitch
+H 100 0 0 q3 : LKneePitch
+H 0 -M_PI/2 0 q4 : LHipPitch
+H 0 0 0 q5 : LHipRoll
+R 1 0 0 M_PI/2
+R 0 1 0 M_PI/4
+H 0 0 0 q6 : LHipYawPitch
+R 0 1 0 M_PI/4
+R 0 0 1 M_PI/2
+T 0 -50 85
+}
+
+
+
diff --git a/naoqi/modules/R2module/config/dh_RAbase.cfg b/naoqi/modules/R2module/config/dh_RAbase.cfg
@@ -0,0 +1,8 @@
+[ chain ] = 
+{
+: RWristYaw
+: RElbowRoll
+: RElbowYaw
+: RShoulderRoll
+: RShoulderPitch
+}
diff --git a/naoqi/modules/R2module/config/dh_RLbase.cfg b/naoqi/modules/R2module/config/dh_RLbase.cfg
@@ -0,0 +1,15 @@
+[ chain ] = 
+{
+H 0 M_PI/2 0 q1 : RAnkleRoll
+H 102.9 0 0 q2 : RAnklePitch
+H 100 0 0 q3 : RKneePitch
+H 0 -M_PI/2 0 q4 : RHipPitch
+H 0 0 0 q5 : RHipRoll
+R 1 0 0 M_PI/2
+H 0 0 0 q6 : RHipYawPitch
+R 0 1 0 M_PI/4
+R 0 1 0 M_PI/4
+R 0 0 1 M_PI/2
+T 0 50 85
+}
+
diff --git a/naoqi/modules/R2module/config/dh_head.cfg b/naoqi/modules/R2module/config/dh_head.cfg
@@ -1,8 +1,6 @@
 [ chain ] = 
 {
-H 0 -M_PI/2 0 q1
-H 0 M_PI/2 0 q2
-T 53.9 0 67.9
+H 0 -M_PI/2 0 q1 : HeadYaw
+H 0 M_PI/2 0 q2 : HeadPitch
 }
-# CoM-head shift
-T 0 0 126.5
+
diff --git a/naoqi/modules/R2module/config/dh_leftArm.cfg b/naoqi/modules/R2module/config/dh_leftArm.cfg
@@ -1,14 +1,14 @@
 [ chain ] = 
 {
-H 0 M_PI/2 0 q1
-H 0 0 0 q2
+H 0 M_PI/2 0 q1 : LShoulderPitch
+H 0 0 0 q2 : LShoulderRoll
 R 0 0 1 -M_PI/2
 R 1 0 0 -M_PI/2
-H -15 M_PI/2 105 q3
+H -15 M_PI/2 105 q3 : LElbowYaw
 R 0 0 1 M_PI/2
-H 0 0 0 q4
+H 0 0 0 q4 : LElbowRoll
 T 113.7 0 12.31
 R 0 0 1 -M_PI/2
 R 1 0 0 -M_PI/2
-H 0 0 0 q5
+H 0 0 0 q5 : LWristYaw
 }
diff --git a/naoqi/modules/R2module/config/dh_leftLeg.cfg b/naoqi/modules/R2module/config/dh_leftLeg.cfg
@@ -1,18 +1,23 @@
 [ chain ] = 
 {
+H 0 0 0 q1 : LHipYawPitch
+R 1 0 0 -M_PI/4
 R 0 1 0 M_PI/2
-R 0 0 1 M_PI
-T 45.19 0 0 
-H 0 M_PI/2 0 q1
-H 102.9 0 0 q2
-H 100 -M_PI/2 0 q3
-H 0 M_PI/2 0 q4
-H 0 0 0 q5
-R 0 1 0 -M_PI/4
-H 0 0 0 q6
-R 0 1 0 M_PI/4
+
+H 0 0 0 q1 : LHipRoll
+R 1 0 0 M_PI/2
+R 0 0 1 M_PI/2
+H 0 0 0 q2 : LHipPitch
+T 0 100 0
+H 0 0 0 q3 : LKneePitch
+T 0 102.9 0
+H 0 0 0 q4 : LAnklePitch
+R 1 0 0 M_PI/2
 R 0 0 1 M_PI/2
-T 0 0 -50
 R 1 0 0 M_PI/2
-T 0 0 85
+H 0 0 0 q5 : LAnkleRoll
+T 0 -45.19 0
+R 0 0 1 M_PI/2
 }
+
+
diff --git a/naoqi/modules/R2module/config/dh_rightArm.cfg b/naoqi/modules/R2module/config/dh_rightArm.cfg
@@ -1,14 +1,14 @@
 [ chain ] = 
 {
-H 0 M_PI/2 0 q1
-H 0 0 0 q2
+H 0 M_PI/2 0 q1 : RShoulderPitch
+H 0 0 0 q2 : RShoulderRoll
 R 0 0 1 -M_PI/2
 R 1 0 0 -M_PI/2
-H 15 M_PI/2 105 q3
+H 15 M_PI/2 105 q3 : RElbowYaw
 R 0 0 1 M_PI/2
-H 0 0 0 q4
+H 0 0 0 q4 : RElbowRoll
 T 113.7 0 12.31
 R 0 0 1 -M_PI/2
 R 1 0 0 -M_PI/2
-H 0 0 0 q5
+H 0 0 0 q5 : RWristYaw
 }
diff --git a/naoqi/modules/R2module/config/dh_rightLeg.cfg b/naoqi/modules/R2module/config/dh_rightLeg.cfg
@@ -1,14 +1,23 @@
 [ chain ] = 
 {
-T 0 -50 -85
+H 0 0 0 q1 : RHipYawPitch
 R 1 0 0 -M_PI/4
-H 0 0 0 q1
-R 1 0 0 -M_PI/4
-H 0 -M_PI/2 0 q2
-H -100 M_PI/2 0 q3
-H -102.9 0 0 q4
-H 0 -M_PI/2 0 q5
-H -45.19 0 0 q6
-R 0 0 1 -M_PI
-R 0 1 0 -M_PI/2
+R 1 0 0 -M_PI/2
+R 0 1 0 M_PI/2
+
+H 0 0 0 q1 : RHipRoll
+R 1 0 0 M_PI/2
+R 0 0 1 M_PI/2
+H 0 0 0 q2 : RHipPitch
+T 0 100 0
+H 0 0 0 q3 : RKneePitch
+T 0 102.9 0
+H 0 0 0 q4 : RAnklePitch
+R 1 0 0 M_PI/2
+R 0 0 1 M_PI/2
+R 1 0 0 M_PI/2
+H 0 0 0 q5 : RAnkleRoll
+T 0 -45.19 0
+R 0 0 1 M_PI/2
 }
+
diff --git a/naoqi/modules/R2module/config/joints_params.cfg b/naoqi/modules/R2module/config/joints_params.cfg
@@ -25,3 +25,4 @@
 0.0 -1.189516	0.922747 LAnklePitch
 0.0 -0.397880	0.769001 LAnkleRoll
 }
+
Original file line number	Diff line number	Diff line change
Expand Up		@@ -25,3 +25,4 @@
		0.0 -1.189516 0.922747 LAnklePitch
		0.0 -0.397880 0.769001 LAnkleRoll
		}