grasp
All Data Structures Namespaces Functions Modules
DHiCub.m
1 function DH=DHiCub(finger,hand)
2 
3  if finger==1
4  DH{1}.A=0.0; DH{1}.D=0; DH{1}.alpha=-pi/2; DH{1}.offset=0;
5  if (hand=='l')
6  DH{1}.alpha=pi/2;
7  end
8  DH{2}.A=0.021; DH{2}.D=0.0056; DH{2}.alpha=0; DH{2}.offset=0;
9  if (hand=='l')
10  DH{2}.D=-0.0056;
11  end
12  DH{3}.A=0.026; DH{3}.D=0; DH{3}.alpha=0; DH{3}.offset=0;
13  DH{4}.A=0.022; DH{4}.D=0; DH{4}.alpha=0; DH{4}.offset=0;
14  DH{5}.A=0.0168; DH{5}.D=0; DH{5}.alpha=-pi/2; DH{5}.offset=0;
15  elseif finger==2
16  DH{1}.A=0.0148; DH{1}.D=0; DH{1}.alpha=pi/2; DH{1}.offset=0;
17  if (hand=='l')
18  DH{1}.alpha=-pi/2;
19  end
20  DH{2}.A=0.0259; DH{2}.D=0; DH{2}.alpha=0; DH{2}.offset=0;
21  DH{3}.A=0.022; DH{3}.D=0; DH{3}.alpha=0; DH{3}.offset=0;
22  DH{4}.A=0.0168; DH{4}.D=0; DH{4}.alpha=-pi/2; DH{4}.offset=0;
23  elseif finger==3
24  DH{1}.A=0.0285; DH{1}.D=0; DH{1}.alpha=0; DH{1}.offset=0;
25  DH{2}.A=0.0240; DH{2}.D=0; DH{2}.alpha=0; DH{2}.offset=0;
26  DH{3}.A=0.0168; DH{3}.D=0; DH{3}.alpha=-pi/2; DH{3}.offset=0;
27  end
28 
29 end