25 |
|
|
26 |
|
*/ |
27 |
|
|
28 |
+ |
StuntDouble::~StuntDouble(){ |
29 |
+ |
map<string, GenericData*>::iterator iter; |
30 |
+ |
|
31 |
+ |
for(iter = properties.begin(); iter != properties.end(); ){ |
32 |
+ |
delete iter->second; |
33 |
+ |
iter = properties.erase(iter); |
34 |
+ |
} |
35 |
+ |
|
36 |
+ |
} |
37 |
+ |
|
38 |
|
int StuntDouble::getObjType(){ |
39 |
|
return objType; |
40 |
|
} |
283 |
|
} |
284 |
|
} |
285 |
|
|
286 |
+ |
void StuntDouble::getQ(double q[4] ){ |
287 |
+ |
switch (objType) |
288 |
+ |
{ |
289 |
+ |
case OT_ATOM: |
290 |
+ |
sprintf( painCave.errMsg, |
291 |
+ |
"StuntDouble::getJ was called for a regular atom.\n" |
292 |
+ |
"\tRegular Atoms don't have angular momentum. Be smarter.\n"); |
293 |
+ |
painCave.isFatal = 0; |
294 |
+ |
simError(); |
295 |
+ |
// Return zeros. |
296 |
+ |
q[0] = 0; |
297 |
+ |
q[1] = 0; |
298 |
+ |
q[2] = 0; |
299 |
+ |
q[3] = 0; |
300 |
+ |
break; |
301 |
+ |
case OT_DATOM: |
302 |
+ |
((DirectionalAtom*)this)->getQ(q); |
303 |
+ |
break; |
304 |
+ |
case OT_RIGIDBODY: |
305 |
+ |
((RigidBody*)this)->getQ(q); |
306 |
+ |
break; |
307 |
+ |
default: |
308 |
+ |
sprintf( painCave.errMsg, |
309 |
+ |
"Unrecognized ObjType (%d) in StuntDouble::getJ.\n", |
310 |
+ |
objType ); |
311 |
+ |
painCave.isFatal = 1; |
312 |
+ |
simError(); |
313 |
+ |
} |
314 |
+ |
} |
315 |
+ |
|
316 |
+ |
void StuntDouble::setQ(double q[4] ){ |
317 |
+ |
switch (objType) |
318 |
+ |
{ |
319 |
+ |
case OT_ATOM: |
320 |
+ |
sprintf( painCave.errMsg, |
321 |
+ |
"StuntDouble::setJ was called for a regular atom.\n" |
322 |
+ |
"\tRegular Atoms don't have angular momentum. Be smarter.\n"); |
323 |
+ |
painCave.isFatal = 1; |
324 |
+ |
simError(); |
325 |
+ |
break; |
326 |
+ |
case OT_DATOM: |
327 |
+ |
((DirectionalAtom*)this)->setJ(q); |
328 |
+ |
break; |
329 |
+ |
case OT_RIGIDBODY: |
330 |
+ |
((RigidBody*)this)->setJ(q); |
331 |
+ |
break; |
332 |
+ |
default: |
333 |
+ |
sprintf( painCave.errMsg, |
334 |
+ |
"Unrecognized ObjType (%d) in StuntDouble::setJ.\n", |
335 |
+ |
objType ); |
336 |
+ |
painCave.isFatal = 1; |
337 |
+ |
simError(); |
338 |
+ |
} |
339 |
+ |
} |
340 |
|
void StuntDouble::getTrq(double trq[3]){ |
341 |
|
switch (objType) |
342 |
|
{ |
527 |
|
default: |
528 |
|
sprintf( painCave.errMsg, |
529 |
|
"Unrecognized ObjType (%d) in StuntDouble::getEulerAngles.\n", |
530 |
+ |
objType ); |
531 |
+ |
painCave.isFatal = 1; |
532 |
+ |
simError(); |
533 |
+ |
} |
534 |
+ |
} |
535 |
+ |
|
536 |
+ |
double StuntDouble::getZangle(){ |
537 |
+ |
switch (objType) |
538 |
+ |
{ |
539 |
+ |
case OT_ATOM: |
540 |
+ |
sprintf( painCave.errMsg, |
541 |
+ |
"StuntDouble::getZangle was called for a regular atom.\n" |
542 |
+ |
"\tRegular Atoms don't have zAngles. Be smarter.\n"); |
543 |
+ |
painCave.isFatal = 0; |
544 |
+ |
simError(); |
545 |
+ |
// Return zeros. |
546 |
+ |
return 0; |
547 |
+ |
break; |
548 |
+ |
case OT_DATOM: |
549 |
+ |
return ((DirectionalAtom*)this)->getZangle(); |
550 |
+ |
break; |
551 |
+ |
case OT_RIGIDBODY: |
552 |
+ |
return ((RigidBody*)this)->getZangle(); |
553 |
+ |
break; |
554 |
+ |
default: |
555 |
+ |
sprintf( painCave.errMsg, |
556 |
+ |
"Unrecognized ObjType (%d) in StuntDouble::getZangle.\n", |
557 |
+ |
objType ); |
558 |
+ |
painCave.isFatal = 1; |
559 |
+ |
simError(); |
560 |
+ |
return 0; |
561 |
+ |
} |
562 |
+ |
} |
563 |
+ |
|
564 |
+ |
void StuntDouble::setZangle(double zAngle){ |
565 |
+ |
switch (objType) |
566 |
+ |
{ |
567 |
+ |
case OT_ATOM: |
568 |
+ |
sprintf( painCave.errMsg, |
569 |
+ |
"StuntDouble::setZangle was called for a regular atom.\n" |
570 |
+ |
"\tRegular Atoms don't have zAngles. Be smarter.\n"); |
571 |
+ |
painCave.isFatal = 1; |
572 |
+ |
simError(); |
573 |
+ |
break; |
574 |
+ |
case OT_DATOM: |
575 |
+ |
((DirectionalAtom*)this)->setZangle(zAngle); |
576 |
+ |
break; |
577 |
+ |
case OT_RIGIDBODY: |
578 |
+ |
((RigidBody*)this)->setZangle(zAngle); |
579 |
+ |
break; |
580 |
+ |
default: |
581 |
+ |
sprintf( painCave.errMsg, |
582 |
+ |
"Unrecognized ObjType (%d) in StuntDouble::setZangle.\n", |
583 |
|
objType ); |
584 |
|
painCave.isFatal = 1; |
585 |
|
simError(); |
586 |
+ |
} |
587 |
+ |
} |
588 |
+ |
|
589 |
+ |
void StuntDouble::addZangle(double zAngle){ |
590 |
+ |
switch (objType) |
591 |
+ |
{ |
592 |
+ |
case OT_ATOM: |
593 |
+ |
sprintf( painCave.errMsg, |
594 |
+ |
"StuntDouble::addZangle was called for a regular atom.\n" |
595 |
+ |
"\tRegular Atoms don't have zAngles. Be smarter.\n"); |
596 |
+ |
painCave.isFatal = 1; |
597 |
+ |
simError(); |
598 |
+ |
break; |
599 |
+ |
case OT_DATOM: |
600 |
+ |
((DirectionalAtom*)this)->addZangle(zAngle); |
601 |
+ |
break; |
602 |
+ |
case OT_RIGIDBODY: |
603 |
+ |
((RigidBody*)this)->addZangle(zAngle); |
604 |
+ |
break; |
605 |
+ |
default: |
606 |
+ |
sprintf( painCave.errMsg, |
607 |
+ |
"Unrecognized ObjType (%d) in StuntDouble::addZangle.\n", |
608 |
+ |
objType ); |
609 |
+ |
painCave.isFatal = 1; |
610 |
+ |
simError(); |
611 |
+ |
} |
612 |
+ |
} |
613 |
+ |
|
614 |
+ |
void StuntDouble::addProperty(GenericData* data){ |
615 |
+ |
map<string, GenericData*>::iterator result; |
616 |
+ |
result = properties.find(data->getID()); |
617 |
+ |
|
618 |
+ |
//we can't simply use properties[prop->getID()] = prop, |
619 |
+ |
//it will cause memory leak if we already contain a propery which has the same name of prop |
620 |
+ |
|
621 |
+ |
if(result != properties.end()){ |
622 |
+ |
delete (*result).second; |
623 |
+ |
(*result).second = data; |
624 |
|
} |
625 |
+ |
else |
626 |
+ |
properties[data->getID()] = data; |
627 |
+ |
|
628 |
+ |
|
629 |
|
} |
630 |
+ |
void StuntDouble::removeProperty(const string& propName){ |
631 |
+ |
map<string, GenericData*>::iterator result; |
632 |
+ |
|
633 |
+ |
result = properties.find(propName); |
634 |
+ |
|
635 |
+ |
if(result != properties.end()){ |
636 |
+ |
delete result->second; |
637 |
+ |
properties.erase(result); |
638 |
+ |
|
639 |
+ |
} |
640 |
+ |
|
641 |
+ |
} |
642 |
+ |
GenericData* StuntDouble::getProperty(const string& propName){ |
643 |
+ |
map<string, GenericData*>::iterator result; |
644 |
+ |
|
645 |
+ |
|
646 |
+ |
result = properties.find(propName); |
647 |
+ |
|
648 |
+ |
if(result != properties.end()) |
649 |
+ |
return (*result).second; |
650 |
+ |
else |
651 |
+ |
return NULL; |
652 |
+ |
} |