| 14 | } |
| 15 | |
| 16 | void CPHInterpolation::SetBody(dBodyID body) |
| 17 | { |
| 18 | if (!body) |
| 19 | return; |
| 20 | m_body = body; |
| 21 | qPositions.fill_in(*((Fvector*)dBodyGetPosition(m_body))); |
| 22 | const dReal* dQ = dBodyGetQuaternion(m_body); |
| 23 | Fquaternion fQ; |
| 24 | fQ.set(-dQ[0], dQ[1], dQ[2], dQ[3]); |
| 25 | qRotations.fill_in(fQ); |
| 26 | } |
| 27 | |
| 28 | void CPHInterpolation::UpdatePositions() |
| 29 | { |
no test coverage detected