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