|
a |
|
b/Application/Examples/ArmCurl/Model/EnvironmentOptimized.any |
|
|
1 |
|
|
|
2 |
AnyFolder EnvironmentModel = { |
|
|
3 |
AnyComponentDefinition obj = { |
|
|
4 |
}; |
|
|
5 |
AnyVec3 HandleRGB={0.3,0.3,0.3}; |
|
|
6 |
AnyVec3 MadressRGB={0.3,0.3,0.3}; |
|
|
7 |
|
|
|
8 |
/* ********************************************************** |
|
|
9 |
This folder contains the definition of the Environment |
|
|
10 |
- GlobalRefFrame |
|
|
11 |
|
|
|
12 |
********************************************************** */ |
|
|
13 |
|
|
|
14 |
AnyFixedRefFrame GlobalRef = { |
|
|
15 |
Origin ={0.0,0,0.0}; |
|
|
16 |
|
|
|
17 |
AnyRefNode FloorNode ={ |
|
|
18 |
sRel={0,0.16,0}; |
|
|
19 |
AnyVec3 Color= {0.6,0.6,0.6}; //box color |
|
|
20 |
AnyVar Opacity=1; //box Opacity |
|
|
21 |
AnyVec3 Size={2,0.02,1}; |
|
|
22 |
#include "<ANYBODY_PATH_MODELUTILS>/DrawObjects/Box.any" //include file which will draw a box |
|
|
23 |
|
|
|
24 |
AnyRefNode Right ={ |
|
|
25 |
sRel={0.7,0,0.3}; |
|
|
26 |
// AnyDrawRefFrame drw={}; |
|
|
27 |
}; |
|
|
28 |
AnyRefNode Left ={ |
|
|
29 |
sRel={0.7,0,-0.3}; |
|
|
30 |
// AnyDrawRefFrame drw={}; |
|
|
31 |
}; |
|
|
32 |
|
|
|
33 |
}; |
|
|
34 |
|
|
|
35 |
|
|
|
36 |
#include "drawcoorsystem.any" |
|
|
37 |
//AnyDrawRefFrame drw={}; |
|
|
38 |
AnyRefNode PelvisNode ={ |
|
|
39 |
sRel={0.45,1,0}; |
|
|
40 |
}; |
|
|
41 |
AnyRefNode RightWheelNode2 ={ |
|
|
42 |
sRel={0,1,0.23}; |
|
|
43 |
}; |
|
|
44 |
|
|
|
45 |
AnyRefNode LeftWheelNode2 ={ |
|
|
46 |
sRel={0,1,-0.27}; |
|
|
47 |
}; |
|
|
48 |
AnyRefNode RightMassNode ={ |
|
|
49 |
sRel={-0.1,1,0.25}; |
|
|
50 |
}; |
|
|
51 |
AnyRefNode LeftMassNode ={ |
|
|
52 |
sRel={-0.1,1,-0.25}; |
|
|
53 |
}; |
|
|
54 |
|
|
|
55 |
};//GlobalRef |
|
|
56 |
|
|
|
57 |
|
|
|
58 |
AnyFixedRefFrame Bench ={ |
|
|
59 |
Origin={0,0.8,0}; |
|
|
60 |
AnyVec3 Color= .MadressRGB; //box color |
|
|
61 |
AnyVar Opacity=1; //box Opacity |
|
|
62 |
AnyVec3 Size={1,.05,0.25}; |
|
|
63 |
#include "<ANYBODY_PATH_MODELUTILS>/DrawObjects/Box.any" //include file which will draw a box |
|
|
64 |
|
|
|
65 |
AnyRefNode Frame ={ |
|
|
66 |
sRel={0.1,-0.35,0}; |
|
|
67 |
AnyVec3 Color= 0.8*..MadressRGB; //box color |
|
|
68 |
AnyVar Opacity=1; //box Opacity |
|
|
69 |
AnyVec3 Size={1,.5,0.25}; |
|
|
70 |
#include "<ANYBODY_PATH_MODELUTILS>/DrawObjects/Box.any" //include file which will draw a box |
|
|
71 |
}; |
|
|
72 |
|
|
|
73 |
AnyRefNode Node1 ={sRel={.Size[0]*0.5,0,0}; |
|
|
74 |
//AnyDrawRefFrame drw={RGB={0,0,1};}; |
|
|
75 |
}; |
|
|
76 |
}; |
|
|
77 |
|
|
|
78 |
AnySeg ThoraxRest ={ |
|
|
79 |
Mass=10; |
|
|
80 |
Jii={0,0,0}; |
|
|
81 |
r0 ={0.692836, 1.029813, 0.000000}; |
|
|
82 |
Axes0 = {{-0.642788, 0.766044, 0.000000}, {-0.766044, -0.642788, 0.000000}, {0.000000, 0.000000, 1.000000}}; |
|
|
83 |
|
|
|
84 |
AnyVec3 Color= .MadressRGB; |
|
|
85 |
AnyVar Opacity=1; //box Opacity |
|
|
86 |
AnyVec3 Size={0.35,.05,0.25}; |
|
|
87 |
#include "<ANYBODY_PATH_MODELUTILS>/DrawObjects/Box.any" //include file which will draw a box |
|
|
88 |
//AnyDrawRefFrame drw={}; |
|
|
89 |
|
|
|
90 |
AnyRefNode Node1 ={ |
|
|
91 |
sRel={.Size[0]*0.5,0,0}; |
|
|
92 |
//AnyDrawRefFrame drw={}; |
|
|
93 |
}; |
|
|
94 |
|
|
|
95 |
AnyRefNode Node2 = { |
|
|
96 |
sRel={-.Size[0]*0.5,0,0}; |
|
|
97 |
//AnyDrawRefFrame drw={}; |
|
|
98 |
}; |
|
|
99 |
}; |
|
|
100 |
|
|
|
101 |
AnyKinEqSimpleDriver drv={ |
|
|
102 |
|
|
|
103 |
AnyRevoluteJoint jnt={ |
|
|
104 |
AnyRefNode &ref1=..Bench.Node1; |
|
|
105 |
AnyRefNode &ref2=..ThoraxRest.Node1; |
|
|
106 |
Axis=z; |
|
|
107 |
}; |
|
|
108 |
DriverPos={-130*pi/180}; |
|
|
109 |
DriverVel={0}; |
|
|
110 |
}; |
|
|
111 |
|
|
|
112 |
|
|
|
113 |
AnySeg ArmRest ={ |
|
|
114 |
Axes0 = {{-0.173648, -0.984808, 0.000000}, {0.984808, -0.173648, 0.000000}, {0.000000, 0.000000, 1.000000}}; |
|
|
115 |
Mass=10; |
|
|
116 |
Jii={0,0,0}; |
|
|
117 |
r0 ={0.856123, 0.986061, 0.000000}; |
|
|
118 |
// Axes0 = {{-0.642788, 0.766044, 0.000000}, {-0.766044, -0.642788, 0.000000}, {0.000000, 0.000000, 1.000000}}; |
|
|
119 |
|
|
|
120 |
AnyVec3 Color= .MadressRGB; |
|
|
121 |
AnyVar Opacity=1; //box Opacity |
|
|
122 |
AnyVec3 Size={0.4,.05,0.5}; |
|
|
123 |
#include "<ANYBODY_PATH_MODELUTILS>/DrawObjects/Box.any" //include file which will draw a box |
|
|
124 |
//AnyDrawRefFrame drw={}; |
|
|
125 |
AnyRefNode Node1 ={sRel={.Size[0]*0.5,0,0}; |
|
|
126 |
//AnyDrawRefFrame drw={}; |
|
|
127 |
}; |
|
|
128 |
|
|
|
129 |
AnyRefNode Node2 ={sRel={-.Size[0]*0.5,0,0}; |
|
|
130 |
//AnyDrawRefFrame drw={}; |
|
|
131 |
}; |
|
|
132 |
|
|
|
133 |
AnyRefNode RightWheelNode1 ={sRel={0.08,-0.05,.Size[2]*0.5}; |
|
|
134 |
//AnyDrawRefFrame drw={RGB={0,1,0};}; |
|
|
135 |
}; |
|
|
136 |
|
|
|
137 |
AnyRefNode LeftWheelNode1 ={sRel={0.08,-0.05,-.Size[2]*0.5}; |
|
|
138 |
//AnyDrawRefFrame drw={RGB={0,1,0};}; |
|
|
139 |
}; |
|
|
140 |
|
|
|
141 |
}; |
|
|
142 |
|
|
|
143 |
AnyKinEqSimpleDriver ArmRestDrv={ |
|
|
144 |
|
|
|
145 |
AnyRevoluteJoint jnt={ |
|
|
146 |
AnyRefNode &ref1=..ThoraxRest.Node2; |
|
|
147 |
AnyRefNode &ref2=..ArmRest.Node1; |
|
|
148 |
Axis=z; |
|
|
149 |
}; |
|
|
150 |
DriverPos={-130*pi/180}; |
|
|
151 |
DriverVel={0}; |
|
|
152 |
}; |
|
|
153 |
|
|
|
154 |
|
|
|
155 |
|
|
|
156 |
AnyFolder Right ={ |
|
|
157 |
AnyComponentDefinition obj = { |
|
|
158 |
SubGroupRegexSearch = "([_[:alnum:]]+?)\.([_[:alnum:]]+?)"; |
|
|
159 |
SubGroupRegexReplace = "$1"; |
|
|
160 |
}; |
|
|
161 |
AnySeg Wheel1 ={ |
|
|
162 |
Mass=0; |
|
|
163 |
Jii={0,0,0}; |
|
|
164 |
r0 ={0.873488, 0.887580, 0.250000}; |
|
|
165 |
Axes0 = {{-0.984808, 0.173648, 0.000000}, {-0.173648, -0.984808, 0.000000}, {0.000000, 0.000000, 1.000000}}; |
|
|
166 |
//AnyDrawRefFrame drw={}; |
|
|
167 |
AnyRefNode CylNode1={ |
|
|
168 |
sRel={-0.065,-0.065,-0.0}; |
|
|
169 |
AnySurfCylinder Cyl1={ |
|
|
170 |
Radius=0.1; |
|
|
171 |
Length=0.04; |
|
|
172 |
AnyDrawParamSurf drw={ |
|
|
173 |
Opacity=1; |
|
|
174 |
RGB= {0.4,0.4,0.4}; |
|
|
175 |
}; |
|
|
176 |
}; |
|
|
177 |
|
|
|
178 |
AnyRefNode WireNode={ |
|
|
179 |
sRel={0.0,0.102,0.02}; |
|
|
180 |
//AnyDrawRefFrame drw={}; |
|
|
181 |
|
|
|
182 |
}; |
|
|
183 |
|
|
|
184 |
}; |
|
|
185 |
/*AnyRefNode CylNode2={ |
|
|
186 |
sRel={0,0,0.03}; |
|
|
187 |
AnySurfCylinder Cyl2={ |
|
|
188 |
Radius=0.1; |
|
|
189 |
Length=0.02; |
|
|
190 |
AnyDrawParamSurf drw={}; |
|
|
191 |
}; |
|
|
192 |
};*/ |
|
|
193 |
|
|
|
194 |
AnyRefNode Node0={ |
|
|
195 |
//AnyDrawRefFrame drw={}; |
|
|
196 |
sRel={0,0.0,0}; |
|
|
197 |
}; |
|
|
198 |
|
|
|
199 |
AnyRefNode Node1={ |
|
|
200 |
//AnyDrawRefFrame drw={}; |
|
|
201 |
sRel={0,0.34,0}; |
|
|
202 |
}; |
|
|
203 |
|
|
|
204 |
AnyRefNode Node2={ |
|
|
205 |
//AnyDrawRefFrame drw={}; |
|
|
206 |
sRel={0,0.34,-0.2}; |
|
|
207 |
|
|
|
208 |
}; |
|
|
209 |
|
|
|
210 |
//Draw a visual line between the points |
|
|
211 |
AnyFolder Line ={ |
|
|
212 |
AnyRefFrame &node1=.Node0; |
|
|
213 |
AnyRefFrame &node2=.Node1; |
|
|
214 |
AnyRefFrame &node3=.Node2; |
|
|
215 |
|
|
|
216 |
AnyDrawPLine line ={ |
|
|
217 |
Thickness=0.02; |
|
|
218 |
RGB=....HandleRGB; |
|
|
219 |
}; |
|
|
220 |
}; |
|
|
221 |
|
|
|
222 |
}; |
|
|
223 |
|
|
|
224 |
|
|
|
225 |
AnyKinEqSimpleDriver Drv={ |
|
|
226 |
|
|
|
227 |
AnyRevoluteJoint Wheel1Jnt={ |
|
|
228 |
AnyRefNode &ref1=...ArmRest.RightWheelNode1; |
|
|
229 |
AnySeg &ref2 =..Wheel1; |
|
|
230 |
}; |
|
|
231 |
DriverPos={1.4}; |
|
|
232 |
DriverVel={0.7*pi}/Main.Study.tEnd; |
|
|
233 |
Reaction.Type={Off}; |
|
|
234 |
}; |
|
|
235 |
|
|
|
236 |
|
|
|
237 |
AnySeg Handle ={ |
|
|
238 |
Mass=0; |
|
|
239 |
Jii={0,0,0}; |
|
|
240 |
|
|
|
241 |
r0 ={0.925583, 0.592138, 0.050000}; |
|
|
242 |
Axes0 = {{0.173648, 0.984808, 0.000000}, {-0.984808, 0.173648, 0.000000}, {0.000000, 0.000000, 1.000000}}; |
|
|
243 |
|
|
|
244 |
AnyRefNode Node0={ |
|
|
245 |
//AnyDrawRefFrame drw={}; |
|
|
246 |
sRel={0,0.0,0}; |
|
|
247 |
|
|
|
248 |
}; |
|
|
249 |
|
|
|
250 |
|
|
|
251 |
AnyRefNode Node1={ |
|
|
252 |
//AnyDrawRefFrame drw={}; |
|
|
253 |
sRel={0,0.14,0.0}; |
|
|
254 |
|
|
|
255 |
}; |
|
|
256 |
|
|
|
257 |
AnyRefNode Node2={ |
|
|
258 |
//AnyDrawRefFrame drw={}; |
|
|
259 |
sRel={0,0.14,0.16}; |
|
|
260 |
|
|
|
261 |
}; |
|
|
262 |
|
|
|
263 |
AnyRefNode Node3={ |
|
|
264 |
//AnyDrawRefFrame drw={}; |
|
|
265 |
sRel={0,0.14,0.20}; |
|
|
266 |
|
|
|
267 |
}; |
|
|
268 |
//Draw a visual line between the points |
|
|
269 |
AnyFolder Line ={ |
|
|
270 |
AnyRefFrame &node1=.Node0; |
|
|
271 |
AnyRefFrame &node2=.Node1; |
|
|
272 |
AnyRefFrame &node3=.Node2; |
|
|
273 |
AnyRefFrame &node4=.Node3; |
|
|
274 |
|
|
|
275 |
AnyDrawPLine line ={ |
|
|
276 |
Thickness=0.02; |
|
|
277 |
RGB=....HandleRGB; |
|
|
278 |
}; |
|
|
279 |
}; |
|
|
280 |
|
|
|
281 |
}; |
|
|
282 |
|
|
|
283 |
|
|
|
284 |
//AnyKinEqSimpleDriver HandleDrv={ |
|
|
285 |
|
|
|
286 |
AnyRevoluteJoint jnt={ |
|
|
287 |
AnyRefNode &ref1=.Wheel1.Node2; |
|
|
288 |
AnyRefNode &ref2=.Handle.Node0; |
|
|
289 |
Axis=z; |
|
|
290 |
}; |
|
|
291 |
// DriverPos={90*pi/180}; |
|
|
292 |
// DriverVel={0}; |
|
|
293 |
//}; |
|
|
294 |
|
|
|
295 |
|
|
|
296 |
|
|
|
297 |
AnySeg Wheel2 ={ |
|
|
298 |
Mass=0; |
|
|
299 |
Jii={0,0,0}; |
|
|
300 |
r0={-0.5,0.5,0}; |
|
|
301 |
AnyRefNode CylNode1={ |
|
|
302 |
sRel={0,0,0.0}; |
|
|
303 |
AnySurfCylinder Cyl1={ |
|
|
304 |
|
|
|
305 |
Radius=0.1; |
|
|
306 |
Length=0.04; |
|
|
307 |
AnyDrawParamSurf drw={ |
|
|
308 |
Opacity=1; |
|
|
309 |
RGB= {0.4,0.4,0.4}; |
|
|
310 |
}; |
|
|
311 |
|
|
|
312 |
}; |
|
|
313 |
}; |
|
|
314 |
|
|
|
315 |
}; |
|
|
316 |
|
|
|
317 |
|
|
|
318 |
AnyKinEqSimpleDriver Wheel2Drv={ |
|
|
319 |
AnyRevoluteJoint JntWheel2={ |
|
|
320 |
AnySeg &ref1=..Wheel2; |
|
|
321 |
AnyRefNode &ref2=...GlobalRef.RightWheelNode2; |
|
|
322 |
Axis=z; |
|
|
323 |
}; |
|
|
324 |
DriverPos={0}; |
|
|
325 |
DriverVel={0}; |
|
|
326 |
}; |
|
|
327 |
|
|
|
328 |
|
|
|
329 |
|
|
|
330 |
AnySeg Mass={ |
|
|
331 |
|
|
|
332 |
Mass=5; |
|
|
333 |
Jii={0,0,0}; |
|
|
334 |
|
|
|
335 |
AnyRefNode CylNode ={ |
|
|
336 |
sRel={0,0,0.0}; |
|
|
337 |
|
|
|
338 |
AnyVec3 Color= {0.4,0.4,0.4}; //box color |
|
|
339 |
AnyVar Opacity=1; //box Opacity |
|
|
340 |
AnyVec3 Size={0.2,0.2,0.2}; |
|
|
341 |
#include "<ANYBODY_PATH_MODELUTILS>/DrawObjects/Box.any" //include file which will draw a box |
|
|
342 |
|
|
|
343 |
}; |
|
|
344 |
|
|
|
345 |
AnyRefNode Logo={ |
|
|
346 |
sRel={0,0.0,0.1}; |
|
|
347 |
|
|
|
348 |
AnyDrawSTL Body = { |
|
|
349 |
FileName = ANYBODY_PATH_MODELUTILS+"DrawObjects/Body-grey.stl"; |
|
|
350 |
RGB = Main.DrawSettings.Colors.AnyBodyGrey; |
|
|
351 |
|
|
|
352 |
Opacity = 1; |
|
|
353 |
ScaleXYZ={0.005,0.005,0.005}; |
|
|
354 |
}; |
|
|
355 |
|
|
|
356 |
AnyDrawSTL AnyTechnology = { |
|
|
357 |
FileName = ANYBODY_PATH_MODELUTILS+"DrawObjects/AnyTechnology-red.stl"; |
|
|
358 |
RGB = Main.DrawSettings.Colors.AnyBodyRed; |
|
|
359 |
|
|
|
360 |
Opacity = 1; |
|
|
361 |
ScaleXYZ={0.005,0.005,0.005}; |
|
|
362 |
}; |
|
|
363 |
|
|
|
364 |
}; |
|
|
365 |
}; |
|
|
366 |
|
|
|
367 |
|
|
|
368 |
|
|
|
369 |
AnyPrismaticJoint MassJnt = { |
|
|
370 |
Axis = y; |
|
|
371 |
Ref = 0; |
|
|
372 |
AnyRefFrame &ref1=..GlobalRef.RightMassNode; |
|
|
373 |
AnyRefFrame &ref2=.Mass; |
|
|
374 |
}; |
|
|
375 |
/* |
|
|
376 |
AnyKinEqSimpleDriver MassDrv={ |
|
|
377 |
AnyPrismaticJoint &ref1=.MassJnt; |
|
|
378 |
DriverPos={-0.6}; |
|
|
379 |
DriverVel={0.0}/Main.Study.tEnd; |
|
|
380 |
Reaction.Type={0}; |
|
|
381 |
}; |
|
|
382 |
*/ |
|
|
383 |
|
|
|
384 |
//{{1.502216}, {1.497936}, {1.494521}, {1.492025}, {1.490487}, {1.489931}, {1.490365}, {1.491780}, {1.494153}, {1.497445}, {1.501613}, {1.506589}, {1.512299}, {1.518659}, {1.525580}, {1.532955}, {1.541041}, {1.550040}, {1.559904}, {1.570773}, {1.582540}}; |
|
|
385 |
AnyKinEqInterPolDriver MassDrv={ |
|
|
386 |
AnyPrismaticJoint &ref1=.MassJnt; |
|
|
387 |
Type=Bspline; |
|
|
388 |
BsplineOrder = 4; |
|
|
389 |
T = {0,0.25,0.33,0.5,0.75,1}*Main.Study.tEnd; |
|
|
390 |
// Data={{-0.6,-0.6,-0.60,-0.585,-0.57,-0.53}}; |
|
|
391 |
//Data={{-0.6,-0.595,-0.59,-0.57,-0.53,-0.47}}; |
|
|
392 |
Data={{-0.52,-0.515,-0.51,-0.505,-0.49,-0.43}}; |
|
|
393 |
Reaction.Type={Off}; |
|
|
394 |
}; |
|
|
395 |
AnyKinSPLine Wire={ |
|
|
396 |
AnyRefNode &ref1=.Wheel1.CylNode1.WireNode; |
|
|
397 |
AnySeg &ref2=.Mass; |
|
|
398 |
|
|
|
399 |
AnySurfCylinder &ref3=.Wheel1.CylNode1.Cyl1; |
|
|
400 |
AnySurfCylinder &ref5=.Wheel2.CylNode1.Cyl1; |
|
|
401 |
AnyDrawPLine drw={Thickness=0.005; RGB={0.1,0.1,0.1};}; |
|
|
402 |
InitWrapPosVectors ={{0,0.5,0},{-1,2,0}}; |
|
|
403 |
StringMesh=70; |
|
|
404 |
//RelTol=1e-4; |
|
|
405 |
}; |
|
|
406 |
|
|
|
407 |
AnyReacForce WireReaction={ |
|
|
408 |
AnyKinSPLine &ref=.Wire; |
|
|
409 |
|
|
|
410 |
|
|
|
411 |
}; |
|
|
412 |
|
|
|
413 |
|
|
|
414 |
}; //right |
|
|
415 |
|
|
|
416 |
|
|
|
417 |
|
|
|
418 |
AnyFolder Left ={ |
|
|
419 |
AnyComponentDefinition obj = { |
|
|
420 |
SubGroupRegexSearch = "([_[:alnum:]]+?)\.([_[:alnum:]]+?)"; |
|
|
421 |
SubGroupRegexReplace = "$1"; |
|
|
422 |
}; |
|
|
423 |
AnySeg Wheel1 ={ |
|
|
424 |
Mass=0; |
|
|
425 |
Jii={0,0,0}; |
|
|
426 |
r0 ={0.873488, 0.887580, 0.250000}; |
|
|
427 |
Axes0 = {{-0.984808, 0.173648, 0.000000}, {-0.173648, -0.984808, 0.000000}, {0.000000, 0.000000, 1.000000}}; |
|
|
428 |
//AnyDrawRefFrame drw={}; |
|
|
429 |
AnyRefNode CylNode1={ |
|
|
430 |
sRel={-0.065,-0.065,-0.0}; |
|
|
431 |
AnySurfCylinder Cyl1={ |
|
|
432 |
Radius=0.1; |
|
|
433 |
Length=0.04; |
|
|
434 |
AnyDrawParamSurf drw={ |
|
|
435 |
Opacity=1; |
|
|
436 |
RGB= {0.4,0.4,0.4}; |
|
|
437 |
}; |
|
|
438 |
}; |
|
|
439 |
|
|
|
440 |
AnyRefNode WireNode={ |
|
|
441 |
sRel={0.0,0.102,0.02}; |
|
|
442 |
//AnyDrawRefFrame drw={}; |
|
|
443 |
|
|
|
444 |
}; |
|
|
445 |
|
|
|
446 |
}; |
|
|
447 |
|
|
|
448 |
AnyRefNode Node0={ |
|
|
449 |
//AnyDrawRefFrame drw={}; |
|
|
450 |
sRel={0,0.0,0}; |
|
|
451 |
}; |
|
|
452 |
|
|
|
453 |
AnyRefNode Node1={ |
|
|
454 |
//AnyDrawRefFrame drw={}; |
|
|
455 |
sRel={0,0.34,0}; |
|
|
456 |
}; |
|
|
457 |
|
|
|
458 |
AnyRefNode Node2={ |
|
|
459 |
//AnyDrawRefFrame drw={}; |
|
|
460 |
sRel={0,0.34,0.2}; |
|
|
461 |
|
|
|
462 |
}; |
|
|
463 |
|
|
|
464 |
//Draw a visual line between the points |
|
|
465 |
AnyFolder Line ={ |
|
|
466 |
AnyRefFrame &node1=.Node0; |
|
|
467 |
AnyRefFrame &node2=.Node1; |
|
|
468 |
AnyRefFrame &node3=.Node2; |
|
|
469 |
|
|
|
470 |
AnyDrawPLine line ={ |
|
|
471 |
Thickness=0.02; |
|
|
472 |
RGB=....HandleRGB; |
|
|
473 |
}; |
|
|
474 |
}; |
|
|
475 |
|
|
|
476 |
}; |
|
|
477 |
|
|
|
478 |
|
|
|
479 |
AnyKinEqSimpleDriver Drv={ |
|
|
480 |
|
|
|
481 |
AnyRevoluteJoint Wheel1Jnt={ |
|
|
482 |
AnyRefNode &ref1=...ArmRest.LeftWheelNode1; |
|
|
483 |
AnySeg &ref2 =..Wheel1; |
|
|
484 |
}; |
|
|
485 |
DriverPos={1.4}; |
|
|
486 |
DriverVel={0.7*pi}/Main.Study.tEnd; |
|
|
487 |
Reaction.Type={Off}; |
|
|
488 |
}; |
|
|
489 |
|
|
|
490 |
|
|
|
491 |
AnySeg Handle ={ |
|
|
492 |
Mass=0; |
|
|
493 |
Jii={0,0,0}; |
|
|
494 |
|
|
|
495 |
r0 ={0.925583, 0.592138, 0.050000}; |
|
|
496 |
Axes0 = {{0.173648, 0.984808, 0.000000}, {-0.984808, 0.173648, 0.000000}, {0.000000, 0.000000, 1.000000}}; |
|
|
497 |
|
|
|
498 |
AnyRefNode Node0={ |
|
|
499 |
//AnyDrawRefFrame drw={}; |
|
|
500 |
sRel={0,0.0,0}; |
|
|
501 |
|
|
|
502 |
}; |
|
|
503 |
|
|
|
504 |
|
|
|
505 |
AnyRefNode Node1={ |
|
|
506 |
//AnyDrawRefFrame drw={}; |
|
|
507 |
sRel={0,0.14,0.0}; |
|
|
508 |
|
|
|
509 |
}; |
|
|
510 |
|
|
|
511 |
AnyRefNode Node2={ |
|
|
512 |
//AnyDrawRefFrame drw={}; |
|
|
513 |
sRel={0,0.14,-0.16}; |
|
|
514 |
|
|
|
515 |
}; |
|
|
516 |
|
|
|
517 |
AnyRefNode Node3={ |
|
|
518 |
//AnyDrawRefFrame drw={}; |
|
|
519 |
sRel={0,0.14,-0.20}; |
|
|
520 |
|
|
|
521 |
}; |
|
|
522 |
//Draw a visual line between the points |
|
|
523 |
AnyFolder Line ={ |
|
|
524 |
AnyRefFrame &node1=.Node0; |
|
|
525 |
AnyRefFrame &node2=.Node1; |
|
|
526 |
AnyRefFrame &node3=.Node2; |
|
|
527 |
AnyRefFrame &node4=.Node3; |
|
|
528 |
|
|
|
529 |
AnyDrawPLine line ={ |
|
|
530 |
Thickness=0.02; |
|
|
531 |
RGB=....HandleRGB; |
|
|
532 |
}; |
|
|
533 |
}; |
|
|
534 |
|
|
|
535 |
}; |
|
|
536 |
|
|
|
537 |
|
|
|
538 |
//AnyKinEqSimpleDriver HandleDrv={ |
|
|
539 |
|
|
|
540 |
AnyRevoluteJoint jnt={ |
|
|
541 |
AnyRefNode &ref1=.Wheel1.Node2; |
|
|
542 |
AnyRefNode &ref2=.Handle.Node0; |
|
|
543 |
Axis=z; |
|
|
544 |
}; |
|
|
545 |
// DriverPos={90*pi/180}; |
|
|
546 |
// DriverVel={0}; |
|
|
547 |
//}; |
|
|
548 |
|
|
|
549 |
|
|
|
550 |
|
|
|
551 |
AnySeg Wheel2 ={ |
|
|
552 |
Mass=0; |
|
|
553 |
Jii={0,0,0}; |
|
|
554 |
r0={-0.5,0.5,-0.5}; |
|
|
555 |
|
|
|
556 |
AnyRefNode CylNode1={ |
|
|
557 |
sRel={0,0,0.0}; |
|
|
558 |
AnySurfCylinder Cyl1={ |
|
|
559 |
|
|
|
560 |
Radius=0.1; |
|
|
561 |
Length=0.04; |
|
|
562 |
AnyDrawParamSurf drw={ |
|
|
563 |
Opacity=1; |
|
|
564 |
RGB= {0.4,0.4,0.4}; |
|
|
565 |
}; |
|
|
566 |
|
|
|
567 |
}; |
|
|
568 |
}; |
|
|
569 |
|
|
|
570 |
}; |
|
|
571 |
|
|
|
572 |
|
|
|
573 |
AnyKinEqSimpleDriver Wheel2Drv={ |
|
|
574 |
AnyRevoluteJoint JntWheel2={ |
|
|
575 |
AnySeg &ref1=..Wheel2; |
|
|
576 |
AnyRefNode &ref2=...GlobalRef.LeftWheelNode2; |
|
|
577 |
Axis=z; |
|
|
578 |
}; |
|
|
579 |
DriverPos={0}; |
|
|
580 |
DriverVel={0}; |
|
|
581 |
}; |
|
|
582 |
|
|
|
583 |
|
|
|
584 |
|
|
|
585 |
AnySeg Mass={ |
|
|
586 |
|
|
|
587 |
Mass=5; |
|
|
588 |
Jii={0,0,0}; |
|
|
589 |
AnyRefNode CylNode ={ |
|
|
590 |
sRel={0,0,0.0}; |
|
|
591 |
|
|
|
592 |
AnyVec3 Color= {0.4,0.4,0.4}; //box color |
|
|
593 |
AnyVar Opacity=1; //box Opacity |
|
|
594 |
AnyVec3 Size={0.2,0.2,0.2}; |
|
|
595 |
#include "<ANYBODY_PATH_MODELUTILS>/DrawObjects/Box.any" //include file which will draw a box |
|
|
596 |
|
|
|
597 |
}; |
|
|
598 |
|
|
|
599 |
AnyRefNode Logo={ |
|
|
600 |
sRel={0,0.0,-0.1}; |
|
|
601 |
ARel = RotMat(pi, y); |
|
|
602 |
AnyDrawSTL Body = { |
|
|
603 |
FileName = ANYBODY_PATH_MODELUTILS+"DrawObjects/Body-grey.stl"; |
|
|
604 |
RGB = Main.DrawSettings.Colors.AnyBodyGrey; |
|
|
605 |
|
|
|
606 |
Opacity = 1; |
|
|
607 |
ScaleXYZ={0.005,0.005,0.005}; |
|
|
608 |
}; |
|
|
609 |
|
|
|
610 |
AnyDrawSTL AnyTechnology = { |
|
|
611 |
FileName = ANYBODY_PATH_MODELUTILS+"DrawObjects/AnyTechnology-red.stl"; |
|
|
612 |
RGB = Main.DrawSettings.Colors.AnyBodyRed; |
|
|
613 |
|
|
|
614 |
Opacity = 1; |
|
|
615 |
ScaleXYZ={0.005,0.005,0.005}; |
|
|
616 |
}; |
|
|
617 |
|
|
|
618 |
}; |
|
|
619 |
}; |
|
|
620 |
|
|
|
621 |
|
|
|
622 |
|
|
|
623 |
AnyPrismaticJoint MassJnt = { |
|
|
624 |
Axis = y; |
|
|
625 |
Ref = 0; |
|
|
626 |
AnyRefFrame &ref1=..GlobalRef.LeftMassNode; |
|
|
627 |
AnyRefFrame &ref2=.Mass; |
|
|
628 |
}; |
|
|
629 |
/* |
|
|
630 |
AnyKinEqSimpleDriver MassDrv={ |
|
|
631 |
AnyPrismaticJoint &ref1=.MassJnt; |
|
|
632 |
DriverPos={-0.6}; |
|
|
633 |
DriverVel={0.0}/Main.Study.tEnd; |
|
|
634 |
Reaction.Type={0}; |
|
|
635 |
}; |
|
|
636 |
*/ |
|
|
637 |
|
|
|
638 |
//{{1.502216}, {1.497936}, {1.494521}, {1.492025}, {1.490487}, {1.489931}, {1.490365}, {1.491780}, {1.494153}, {1.497445}, {1.501613}, {1.506589}, {1.512299}, {1.518659}, {1.525580}, {1.532955}, {1.541041}, {1.550040}, {1.559904}, {1.570773}, {1.582540}}; |
|
|
639 |
AnyKinEqInterPolDriver MassDrv={ |
|
|
640 |
AnyPrismaticJoint &ref1=.MassJnt; |
|
|
641 |
Type=Bspline; |
|
|
642 |
BsplineOrder = 4; |
|
|
643 |
// T = {0,0.25,0.33,0.5,0.75,1}*Main.Study.tEnd; |
|
|
644 |
// Data={{-0.6,-0.6,-0.60,-0.585,-0.57,-0.53}}; |
|
|
645 |
T = {0,0.25,0.33,0.5,0.75,1}*Main.Study.tEnd; |
|
|
646 |
//Data={{-0.6,-0.595,-0.59,-0.57,-0.53,-0.47}}; |
|
|
647 |
Data={{-0.52,-0.515,-0.51,-0.505,-0.49,-0.43}}; |
|
|
648 |
Reaction.Type={Off}; |
|
|
649 |
}; |
|
|
650 |
AnyKinSPLine Wire={ |
|
|
651 |
AnyRefNode &ref1=.Wheel1.CylNode1.WireNode; |
|
|
652 |
AnySeg &ref2=.Mass; |
|
|
653 |
|
|
|
654 |
AnySurfCylinder &ref3=.Wheel1.CylNode1.Cyl1; |
|
|
655 |
AnySurfCylinder &ref5=.Wheel2.CylNode1.Cyl1; |
|
|
656 |
AnyDrawPLine drw={Thickness=0.005; RGB={0.1,0.1,0.1};}; |
|
|
657 |
InitWrapPosVectors ={{0,0.5,0},{-1,2,0}}; |
|
|
658 |
StringMesh=70; |
|
|
659 |
//RelTol=1e-4; |
|
|
660 |
}; |
|
|
661 |
|
|
|
662 |
AnyReacForce WireReaction={ |
|
|
663 |
AnyKinSPLine &ref=.Wire; |
|
|
664 |
}; |
|
|
665 |
|
|
|
666 |
};//left |
|
|
667 |
|
|
|
668 |
|
|
|
669 |
|
|
|
670 |
|
|
|
671 |
|
|
|
672 |
|
|
|
673 |
}; |
|
|
674 |
|
|
|
675 |
|
|
|
676 |
|
|
|
677 |
|
|
|
678 |
|
|
|
679 |
|