sot-talos-balance  2.0.5
Collection of dynamic-graph entities aimed at implementing balance control on talos.
parameter_server_conf.py
Go to the documentation of this file.
1 # -*- coding: utf-8 -*-
2 """
3 Created on Mon Feb 9 13:55:16 2015
4 @author: adelpret
5 """
6 
7 from os.path import join
8 
9 from example_robot_data.path import EXAMPLE_ROBOT_DATA_MODEL_DIR
10 
11 NJ = 32
12 model_path = [EXAMPLE_ROBOT_DATA_MODEL_DIR]
13 urdfFileName = join(
14  EXAMPLE_ROBOT_DATA_MODEL_DIR, "talos_data/robots/talos_reduced.urdf"
15 )
16 ImuJointName = "imu_joint"
17 
18 mapJointNameToID = {
19  "lhy": 0,
20  "lhr": 1,
21  "lhp": 2,
22  "lk": 3,
23  "lap": 4,
24  "lar": 5,
25  "rhy": 6,
26  "rhr": 7,
27  "rhp": 8,
28  "rk": 9,
29  "rap": 10,
30  "rar": 11,
31  "ty": 12,
32  "tp": 13,
33  "lsy": 14,
34  "lsr": 15,
35  "lay": 16,
36  "le": 17,
37  "lwy": 18,
38  "lwp": 19,
39  "lwr": 20,
40  "lh": 21,
41  "rsy": 22,
42  "rsr": 23,
43  "ray": 24,
44  "re": 25,
45  "rwy": 26,
46  "rwp": 27,
47  "rwr": 28,
48  "rh": 29,
49  "hp": 30,
50  "hy": 31,
51 }
52 
53 mapJointLimits = {
54  0: [-0.349065850399, 1.57079632679],
55  1: [-0.5236, 0.5236],
56  2: [-2.095, 0.7],
57  3: [0.0, 2.618],
58  4: [-1.309, 0.768],
59  5: [-0.5236, 0.5236],
60  6: [-1.57079632679, 0.349065850399],
61  7: [-0.5236, 0.5236],
62  8: [-2.095, 0.7],
63  9: [0.0, 2.618],
64  10: [-1.309, 0.768],
65  11: [-0.5236, 0.5236],
66  12: [-1.308996939, 1.308996939],
67  13: [-0.261799387799, 0.785398163397],
68  14: [-1.57079632679, 0.523598775598],
69  15: [0.0, 2.87979326579],
70  16: [-2.44346095279, 2.44346095279],
71  17: [-2.35619449019, 0.0],
72  18: [-2.53072741539, 2.53072741539],
73  19: [-1.3962634016, 1.3962634016],
74  20: [-0.698131700798, 0.698131700798],
75  21: [-1.0471975512, 0.0],
76  22: [-0.523598775598, 1.57079632679],
77  23: [-2.87979326579, 0.0],
78  24: [-2.44346095279, 2.44346095279],
79  25: [-2.35619449019, 0.0],
80  26: [-2.53072741539, 2.53072741539],
81  27: [-1.3962634016, 1.3962634016],
82  28: [-0.698131700798, 0.698131700798],
83  29: [-1.0471975512, 0.0],
84  30: [-0.261799387799, 0.785398163397],
85  31: [-1.308996939, 1.308996939],
86 }
87 
88 vfMax = [100.0, 100.0, 300.0, 80.0, 80.0, 30.0]
89 vfMin = [-100.0, -100.0, -300.0, -80.0, -80.0, -30.0]
90 
91 mapForceIdToForceLimits = {
92  0: [vfMin, vfMax],
93  1: [vfMin, vfMax],
94  2: [vfMin, vfMax],
95  3: [vfMin, vfMax],
96 }
97 
98 mapNameToForceId = {"rf": 0, "lf": 1, "rh": 2, "lh": 3}
99 
100 indexOfForceSensors = ()
101 
102 footFrameNames = {"Right": "leg_right_6_joint", "Left": "leg_left_6_joint"}
103 
104 rightFootSensorXYZ = (0.0, 0.0, -0.085)
105 rightFootSoleXYZ = (0.0, 0.0, -0.105)
106 
107 urdftosot = (
108  0,
109  1,
110  2,
111  3,
112  4,
113  5,
114  6,
115  7,
116  8,
117  9,
118  10,
119  11,
120  12,
121  13,
122  14,
123  15,
124  16,
125  17,
126  18,
127  19,
128  20,
129  21,
130  22,
131  23,
132  24,
133  25,
134  26,
135  27,
136  28,
137  29,
138  30,
139  31,
140 )