| 640 | |
| 641 | |
| 642 | void dBodyGetPointVel (dBodyID b, dReal px, dReal py, dReal pz, |
| 643 | dVector3 result) |
| 644 | { |
| 645 | dAASSERT (b); |
| 646 | dVector3 p; |
| 647 | p[0] = px - b->pos[0]; |
| 648 | p[1] = py - b->pos[1]; |
| 649 | p[2] = pz - b->pos[2]; |
| 650 | p[3] = 0; |
| 651 | result[0] = b->lvel[0]; |
| 652 | result[1] = b->lvel[1]; |
| 653 | result[2] = b->lvel[2]; |
| 654 | dCROSS (result,+=,b->avel,p); |
| 655 | } |
| 656 | |
| 657 | |
| 658 | void dBodyGetPosRelPoint (dBodyID b, dReal px, dReal py, dReal pz, |
no outgoing calls
no test coverage detected