| 50 | } |
| 51 | |
| 52 | Point3D Motor3D::GetPosition(void) const |
| 53 | { |
| 54 | float A03 = v.y * m.z - v.z * m.y; |
| 55 | float A13 = v.z * m.x - v.x * m.z; |
| 56 | float A23 = v.x * m.y - v.y * m.x; |
| 57 | float B03 = m.x * v.w - v.x * m.w; |
| 58 | float B13 = m.y * v.w - v.y * m.w; |
| 59 | float B23 = m.z * v.w - v.z * m.w; |
| 60 | |
| 61 | return (Point3D((A03 + B03) * 2.0F, (A13 + B13) * 2.0F, (A23 + B23) * 2.0F)); |
| 62 | } |
| 63 | |
| 64 | Transform3D Motor3D::GetTransformMatrix(void) const |
| 65 | { |