Institut de Robòtica i Informàtica Industrial
KRD Group

The CuikSuite Project

Trisector.world

Go to the documentation of this file.
00001 /* Angle trisector */
00002 
00004 [CONSTANTS]
00005 
00006 OA:=2.3
00007 OB:=OA
00008 OC:=OA
00009 OD:=OA
00010 
00011 AS:=2.3
00012 DS:=AS
00013 BSp:=AS
00014 CSp:=AS
00015 
00016 % bar width
00017 w:=0.05
00018 
00019 % spheres (placed at the end of bars) size
00020 r:=0.1
00021 
00022 [LINKS]
00023 
00024 l_OA: body "bodies/triangle1.off" cyan  
00025       sphere 0.3 (0,0,0) red
00026 
00027 l_OB: body "bodies/triangle1.off" cyan
00028 
00029 l_OC: red+green 
00030       body "bodies/triangle2.off"
00031       body "bodies/box.off"
00032       cylinder w (OD,0,0)(OD+AS,0,0) 0.5*red+0.25*green 
00033       sphere r (OD+AS,0,0)           0.5*red+0.25*green 
00034 
00035 l_OD: red+green
00036       body "bodies/triangle2.off"
00037       body "bodies/box.off"
00038       cylinder w (OD,0,0)(OD+BSp,0,0) 0.5*red+0.25*green
00039       sphere r (OD+BSp,0,0)           0.5*red+0.25*green
00040 
00041 % To links with no bodies used in to define the sliding on
00042 % the right parts of 'l_OC' and 'l_OD'
00043 l_S
00044 
00045 l_Sp
00046 
00047 % 4 bars
00048 l_AS: cylinder w (0,0,0) (AS,0,0) blue
00049       sphere r ( 0,0,0) red
00050       sphere r (AS,0,0) red 
00051 
00052 l_DS: cylinder w (0,0,0) (DS,0,0) blue
00053       sphere r ( 0,0,0) red
00054       sphere r (DS,0,0) red 
00055 
00056 l_BSp: cylinder w (0,0,0) (BSp,0,0) green  
00057        sphere r (  0,0,0) red
00058        sphere r (BSp,0,0) red 
00059 
00060 l_CSp: cylinder w (0,0,0) (CSp,0,0) green  
00061        sphere r (  0,0,0) red
00062        sphere r (CSp,0,0) red 
00063 
00064 [JOINTS]
00065 
00066 revolute: l_OA   (0,0,0)+(0,1,0)
00067           l_OB   (0,0,0)+(0,1,0)
00068 
00069 revolute: l_OA   (0,0,0)+(0,1,0)
00070           l_OC   (0,0,0)+(0,1,0)
00071 
00072 revolute: l_OC   (0,0,0)+(0,1,0)
00073           l_OD   (0,0,0)+(0,1,0)
00074 
00075 revolute: l_OC   (OC,0,0)+(0,1,0)
00076           l_CSp  0+(0,1,0)
00077 
00078 revolute: l_CSp  1+(0,1,0)
00079           l_Sp   (0,0,0)+(0,1,0)
00080 
00081 prismatic: l_OD  (OD,0,0)+(1,0,0)
00082            l_Sp  (0,0,0)+(1,0,0)
00083            range [0,BSp]
00084 
00085 revolute: l_OD   (OD,0,0)+(0,1,0)
00086           l_DS   0+(0,1,0)
00087 
00088 revolute: l_DS   1+(0,1,0)
00089           l_S    (0,0,0)+(0,1,0)
00090 
00091 prismatic: l_OC  (OC,0,0)+(1,0,0)
00092            l_S   (0,0,0)+(1,0,0)
00093            range [0,AS]
00094 
00095 revolute: l_OA   (OA,0,0)+(0,1,0)
00096           l_AS   0+(0,1,0)
00097 
00098 revolute: l_AS   1+(0,1,0)
00099           l_S    (0,0,0)+(0,1,0)                  
00100 
00101 revolute: l_OB   (OB,0,0)+(0,1,0)
00102           l_BSp  0+(0,1,0)
00103 
00104 revolute: l_BSp  1+(0,1,0)
00105           l_Sp   (0,0,0)+(0,1,0)  
00106