|
@@ -304,14 +304,14 @@ export class Quaternion
|
304
|
304
|
|
305
|
305
|
*/
|
306
|
306
|
|
307
|
|
- const x2 = x*x, y2 = y*y, z2 = z*z;//, w2 = w*w;
|
|
307
|
+ const x2 = 2*x*x, y2 = 2*y*y, z2 = 2*z*z;
|
308
|
308
|
const xy = 2*x*y, xz = 2*x*z, yz = 2*y*z;
|
309
|
309
|
const wx = 2*w*x, wy = 2*w*y, wz = 2*w*z;
|
310
|
310
|
|
311
|
311
|
return Speedy.Matrix(3, 3, [
|
312
|
|
- 1-2*(y2+z2), xy+wz, xz-wy,
|
313
|
|
- xy-wz, 1-2*(x2+z2), yz+wx,
|
314
|
|
- xz+wy, yz-wx, 1-2*(x2+y2)
|
|
312
|
+ 1-(y2+z2), xy+wz, xz-wy,
|
|
313
|
+ xy-wz, 1-(x2+z2), yz+wx,
|
|
314
|
+ xz+wy, yz-wx, 1-(x2+y2)
|
315
|
315
|
]);
|
316
|
316
|
}
|
317
|
317
|
|