| OLD | NEW |
| 1 /* | 1 /* |
| 2 * Copyright 2011 Google Inc. | 2 * Copyright 2011 Google Inc. |
| 3 * | 3 * |
| 4 * Use of this source code is governed by a BSD-style license that can be | 4 * Use of this source code is governed by a BSD-style license that can be |
| 5 * found in the LICENSE file. | 5 * found in the LICENSE file. |
| 6 */ | 6 */ |
| 7 | 7 |
| 8 #include "SkMatrix44.h" | 8 #include "SkMatrix44.h" |
| 9 | 9 |
| 10 static inline bool eq4(const SkMScalar* SK_RESTRICT a, | 10 static inline bool eq4(const SkMScalar* SK_RESTRICT a, |
| (...skipping 464 matching lines...) Expand 10 before | Expand all | Expand 10 after Loading... |
| 475 } | 475 } |
| 476 return true; | 476 return true; |
| 477 } | 477 } |
| 478 if (this->isScaleTranslate()) { | 478 if (this->isScaleTranslate()) { |
| 479 if (0 == fMat[0][0] * fMat[1][1] * fMat[2][2]) { | 479 if (0 == fMat[0][0] * fMat[1][1] * fMat[2][2]) { |
| 480 return false; | 480 return false; |
| 481 } | 481 } |
| 482 if (inverse) { | 482 if (inverse) { |
| 483 sk_bzero(inverse->fMat, sizeof(inverse->fMat)); | 483 sk_bzero(inverse->fMat, sizeof(inverse->fMat)); |
| 484 | 484 |
| 485 inverse->fMat[3][0] = -fMat[3][0] / fMat[0][0]; | 485 double invXScale = 1 / fMat[0][0]; |
| 486 inverse->fMat[3][1] = -fMat[3][1] / fMat[1][1]; | 486 double invYScale = 1 / fMat[1][1]; |
| 487 inverse->fMat[3][2] = -fMat[3][2] / fMat[2][2]; | 487 double invZScale = 1 / fMat[2][2]; |
| 488 | 488 |
| 489 inverse->fMat[0][0] = 1 / fMat[0][0]; | 489 inverse->fMat[3][0] = -fMat[3][0] * invXScale; |
| 490 inverse->fMat[1][1] = 1 / fMat[1][1]; | 490 inverse->fMat[3][1] = -fMat[3][1] * invYScale; |
| 491 inverse->fMat[2][2] = 1 / fMat[2][2]; | 491 inverse->fMat[3][2] = -fMat[3][2] * invZScale; |
| 492 |
| 493 inverse->fMat[0][0] = invXScale; |
| 494 inverse->fMat[1][1] = invYScale; |
| 495 inverse->fMat[2][2] = invZScale; |
| 492 inverse->fMat[3][3] = 1; | 496 inverse->fMat[3][3] = 1; |
| 493 | 497 |
| 494 inverse->setTypeMask(this->getType()); | 498 inverse->setTypeMask(this->getType()); |
| 495 } | 499 } |
| 496 return true; | 500 return true; |
| 497 } | 501 } |
| 498 | 502 |
| 499 double a00 = fMat[0][0]; | 503 double a00 = fMat[0][0]; |
| 500 double a01 = fMat[0][1]; | 504 double a01 = fMat[0][1]; |
| 501 double a02 = fMat[0][2]; | 505 double a02 = fMat[0][2]; |
| 502 double a03 = fMat[0][3]; | 506 double a03 = fMat[0][3]; |
| 503 double a10 = fMat[1][0]; | 507 double a10 = fMat[1][0]; |
| 504 double a11 = fMat[1][1]; | 508 double a11 = fMat[1][1]; |
| 505 double a12 = fMat[1][2]; | 509 double a12 = fMat[1][2]; |
| 506 double a13 = fMat[1][3]; | 510 double a13 = fMat[1][3]; |
| 507 double a20 = fMat[2][0]; | 511 double a20 = fMat[2][0]; |
| 508 double a21 = fMat[2][1]; | 512 double a21 = fMat[2][1]; |
| 509 double a22 = fMat[2][2]; | 513 double a22 = fMat[2][2]; |
| 510 double a23 = fMat[2][3]; | 514 double a23 = fMat[2][3]; |
| 511 double a30 = fMat[3][0]; | 515 double a30 = fMat[3][0]; |
| 512 double a31 = fMat[3][1]; | 516 double a31 = fMat[3][1]; |
| 513 double a32 = fMat[3][2]; | 517 double a32 = fMat[3][2]; |
| 514 double a33 = fMat[3][3]; | 518 double a33 = fMat[3][3]; |
| 515 | 519 |
| 520 if (!(this->getType() & kPerspective_Mask)) { |
| 521 // If we know the matrix has no perspective, then the perspective |
| 522 // component is (0, 0, 0, 1). We can use this information to save a lot |
| 523 // of arithmetic that would otherwise be spent to compute the inverse |
| 524 // of a general matrix. |
| 525 |
| 526 SkASSERT(a03 == 0); |
| 527 SkASSERT(a13 == 0); |
| 528 SkASSERT(a23 == 0); |
| 529 SkASSERT(a33 == 1); |
| 530 |
| 531 double b00 = a00 * a11 - a01 * a10; |
| 532 double b01 = a00 * a12 - a02 * a10; |
| 533 double b03 = a01 * a12 - a02 * a11; |
| 534 double b06 = a20 * a31 - a21 * a30; |
| 535 double b07 = a20 * a32 - a22 * a30; |
| 536 double b08 = a20; |
| 537 double b09 = a21 * a32 - a22 * a31; |
| 538 double b10 = a21; |
| 539 double b11 = a22; |
| 540 |
| 541 // Calculate the determinant |
| 542 double det = b00 * b11 - b01 * b10 + b03 * b08; |
| 543 |
| 544 double invdet = 1.0 / det; |
| 545 // If det is zero, we want to return false. However, we also want to ret
urn false |
| 546 // if 1/det overflows to infinity (i.e. det is denormalized). Both of th
ese are |
| 547 // handled by checking that 1/det is finite. |
| 548 if (!sk_float_isfinite(invdet)) { |
| 549 return false; |
| 550 } |
| 551 if (NULL == inverse) { |
| 552 return true; |
| 553 } |
| 554 |
| 555 b00 *= invdet; |
| 556 b01 *= invdet; |
| 557 b03 *= invdet; |
| 558 b06 *= invdet; |
| 559 b07 *= invdet; |
| 560 b08 *= invdet; |
| 561 b09 *= invdet; |
| 562 b10 *= invdet; |
| 563 b11 *= invdet; |
| 564 |
| 565 inverse->fMat[0][0] = SkDoubleToMScalar(a11 * b11 - a12 * b10); |
| 566 inverse->fMat[0][1] = SkDoubleToMScalar(a02 * b10 - a01 * b11); |
| 567 inverse->fMat[0][2] = SkDoubleToMScalar(b03); |
| 568 inverse->fMat[0][3] = 0; |
| 569 inverse->fMat[1][0] = SkDoubleToMScalar(a12 * b08 - a10 * b11); |
| 570 inverse->fMat[1][1] = SkDoubleToMScalar(a00 * b11 - a02 * b08); |
| 571 inverse->fMat[1][2] = SkDoubleToMScalar(-b01); |
| 572 inverse->fMat[1][3] = 0; |
| 573 inverse->fMat[2][0] = SkDoubleToMScalar(a10 * b10 - a11 * b08); |
| 574 inverse->fMat[2][1] = SkDoubleToMScalar(a01 * b08 - a00 * b10); |
| 575 inverse->fMat[2][2] = SkDoubleToMScalar(b00); |
| 576 inverse->fMat[2][3] = 0; |
| 577 inverse->fMat[3][0] = SkDoubleToMScalar(a11 * b07 - a10 * b09 - a12 * b0
6); |
| 578 inverse->fMat[3][1] = SkDoubleToMScalar(a00 * b09 - a01 * b07 + a02 * b0
6); |
| 579 inverse->fMat[3][2] = SkDoubleToMScalar(a31 * b01 - a30 * b03 - a32 * b0
0); |
| 580 inverse->fMat[3][3] = 1; |
| 581 |
| 582 inverse->setTypeMask(this->getType()); |
| 583 return true; |
| 584 } |
| 585 |
| 516 double b00 = a00 * a11 - a01 * a10; | 586 double b00 = a00 * a11 - a01 * a10; |
| 517 double b01 = a00 * a12 - a02 * a10; | 587 double b01 = a00 * a12 - a02 * a10; |
| 518 double b02 = a00 * a13 - a03 * a10; | 588 double b02 = a00 * a13 - a03 * a10; |
| 519 double b03 = a01 * a12 - a02 * a11; | 589 double b03 = a01 * a12 - a02 * a11; |
| 520 double b04 = a01 * a13 - a03 * a11; | 590 double b04 = a01 * a13 - a03 * a11; |
| 521 double b05 = a02 * a13 - a03 * a12; | 591 double b05 = a02 * a13 - a03 * a12; |
| 522 double b06 = a20 * a31 - a21 * a30; | 592 double b06 = a20 * a31 - a21 * a30; |
| 523 double b07 = a20 * a32 - a22 * a30; | 593 double b07 = a20 * a32 - a22 * a30; |
| 524 double b08 = a20 * a33 - a23 * a30; | 594 double b08 = a20 * a33 - a23 * a30; |
| 525 double b09 = a21 * a32 - a22 * a31; | 595 double b09 = a21 * a32 - a22 * a31; |
| (...skipping 321 matching lines...) Expand 10 before | Expand all | Expand 10 after Loading... |
| 847 dst[SkMatrix::kMScaleX] = SkMScalarToScalar(fMat[0][0]); | 917 dst[SkMatrix::kMScaleX] = SkMScalarToScalar(fMat[0][0]); |
| 848 dst[SkMatrix::kMSkewX] = SkMScalarToScalar(fMat[1][0]); | 918 dst[SkMatrix::kMSkewX] = SkMScalarToScalar(fMat[1][0]); |
| 849 dst[SkMatrix::kMTransX] = SkMScalarToScalar(fMat[3][0]); | 919 dst[SkMatrix::kMTransX] = SkMScalarToScalar(fMat[3][0]); |
| 850 | 920 |
| 851 dst[SkMatrix::kMSkewY] = SkMScalarToScalar(fMat[0][1]); | 921 dst[SkMatrix::kMSkewY] = SkMScalarToScalar(fMat[0][1]); |
| 852 dst[SkMatrix::kMScaleY] = SkMScalarToScalar(fMat[1][1]); | 922 dst[SkMatrix::kMScaleY] = SkMScalarToScalar(fMat[1][1]); |
| 853 dst[SkMatrix::kMTransY] = SkMScalarToScalar(fMat[3][1]); | 923 dst[SkMatrix::kMTransY] = SkMScalarToScalar(fMat[3][1]); |
| 854 | 924 |
| 855 return dst; | 925 return dst; |
| 856 } | 926 } |
| OLD | NEW |