-
Notifications
You must be signed in to change notification settings - Fork 0
/
BAXTER_BOX.txt
executable file
·30 lines (30 loc) · 1.07 KB
/
BAXTER_BOX.txt
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
Torque_limits_max = [50;50;50;50;15;15;15];
Torque_limits_min = [-50;-50;-50;-50;-15;-15;-15];
q1 = [0.056;0.000;0.011];
q2 = [0.125;0.000;0.281];
q3 = [0.227;0.000;0.281];
q4 = [0.489;0.000;0.213];
q5 = [0.593;-0.001;0.213];
q6 = [0.863;-0.001;0.195];
q7 = [0.979;-0.002;0.195];
w1 = [0;0;1];
w2 = [0;1;0];
w3 = [1;0;0];
g_st0_right = [0,0,1,1.213;0,1,0,-0.002;-1,0,0,0.190;0,0,0,1.0000];
g_st0_left = [0,0,1,1.213;0,1,0,-0.002;-1,0,0,0.190;0,0,0,1.0000];
g_base_right = [0.7071,0.7071,0.0,0.025;-0.7071,0.7071,0.0,-0.220;0.0,0.0,1.0,0.109;0,0,0,1.0];
g_base_left = [0.7071,-0.7071,0.0,0.025;0.7071,0.7071,0.0,0.220;0.0,0.0,1.0,0.109;0,0,0,1.0];
p_OE1 = [0.15;-0.1;-0.055];
p_OE2 = [0.15;0.1;-0.055];
p_OC1 = [-0.05;-0.1;0.005];
p_OC2 = [-0.05;0.1;0.005];
R_OC2 = [-0.1736,0.9848,0;0,0,-1.0000;-0.9848,-0.1736,0];
R_OC1 = [0.9848,-0.1736,0;0,0,1.0000;-0.1736,-0.9848,0];
m = 6;
n = 1;
mu1 = 0.1;
mu2 = 0.1;
sigma = 0.1;
alpha = 65;
theta_l = [-0.086464,0.472692,-0.927253,0.8861183,-0.236633,1.3150734,1.244130];
theta_r = [0.1518831,-0.0620134,0.0094957,0.839837,1.086684,1.993999,-2.892308];