| 44 | } |
| 45 | |
| 46 | void Motor2D::GetTransformMatrices(Transform2D *M, Transform2D *Minv) const |
| 47 | { |
| 48 | float xz = x * z * 2.0F; |
| 49 | float yz = y * z * 2.0F; |
| 50 | float xw = x * w * 2.0F; |
| 51 | float yw = y * w * 2.0F; |
| 52 | float zw = z * w * 2.0F; |
| 53 | float z2 = 1.0F - z * z * 2.0F; |
| 54 | |
| 55 | M->Set(z2, -zw, xz + yw, zw, z2, yz - xw); |
| 56 | Minv->Set(z2, zw, xz - yw, -zw, z2, yz + xw); |
| 57 | } |
| 58 | |
| 59 | Motor2D& Motor2D::SetTransformMatrix(const Transform2D& M) |
| 60 | { |