1ec3ed6a5ebf6f2c406d7bcf94b6bc34fcaeb976eepoger@google.com/* 2ec3ed6a5ebf6f2c406d7bcf94b6bc34fcaeb976eepoger@google.com * Copyright 2011 Google Inc. 3ec3ed6a5ebf6f2c406d7bcf94b6bc34fcaeb976eepoger@google.com * 4ec3ed6a5ebf6f2c406d7bcf94b6bc34fcaeb976eepoger@google.com * Use of this source code is governed by a BSD-style license that can be 5ec3ed6a5ebf6f2c406d7bcf94b6bc34fcaeb976eepoger@google.com * found in the LICENSE file. 68260a895869beaa4cab9f8b915e457728f41e561reed@google.com */ 78260a895869beaa4cab9f8b915e457728f41e561reed@google.com 88260a895869beaa4cab9f8b915e457728f41e561reed@google.com#include "SkMatrix44.h" 98260a895869beaa4cab9f8b915e457728f41e561reed@google.com 107d68335eb427547606497eb4edea81acce7891f9reed@google.comstatic inline bool eq4(const SkMScalar* SK_RESTRICT a, 117d68335eb427547606497eb4edea81acce7891f9reed@google.com const SkMScalar* SK_RESTRICT b) { 127d68335eb427547606497eb4edea81acce7891f9reed@google.com return (a[0] == b[0]) & (a[1] == b[1]) & (a[2] == b[2]) & (a[3] == b[3]); 137d68335eb427547606497eb4edea81acce7891f9reed@google.com} 147d68335eb427547606497eb4edea81acce7891f9reed@google.com 15631940c8c44e92939fc95d305b87be64eb9b886ereed@google.combool SkMatrix44::operator==(const SkMatrix44& other) const { 167d68335eb427547606497eb4edea81acce7891f9reed@google.com if (this == &other) { 177d68335eb427547606497eb4edea81acce7891f9reed@google.com return true; 187d68335eb427547606497eb4edea81acce7891f9reed@google.com } 197d68335eb427547606497eb4edea81acce7891f9reed@google.com 207d68335eb427547606497eb4edea81acce7891f9reed@google.com if (this->isTriviallyIdentity() && other.isTriviallyIdentity()) { 21deb4c169690c777acb27ee8ce67d70d3f6eb2a2cjamesr@chromium.org return true; 227d68335eb427547606497eb4edea81acce7891f9reed@google.com } 237d68335eb427547606497eb4edea81acce7891f9reed@google.com 247d68335eb427547606497eb4edea81acce7891f9reed@google.com const SkMScalar* SK_RESTRICT a = &fMat[0][0]; 257d68335eb427547606497eb4edea81acce7891f9reed@google.com const SkMScalar* SK_RESTRICT b = &other.fMat[0][0]; 26deb4c169690c777acb27ee8ce67d70d3f6eb2a2cjamesr@chromium.org 277d68335eb427547606497eb4edea81acce7891f9reed@google.com#if 0 28631940c8c44e92939fc95d305b87be64eb9b886ereed@google.com for (int i = 0; i < 16; ++i) { 29631940c8c44e92939fc95d305b87be64eb9b886ereed@google.com if (a[i] != b[i]) { 30631940c8c44e92939fc95d305b87be64eb9b886ereed@google.com return false; 31631940c8c44e92939fc95d305b87be64eb9b886ereed@google.com } 32631940c8c44e92939fc95d305b87be64eb9b886ereed@google.com } 33631940c8c44e92939fc95d305b87be64eb9b886ereed@google.com return true; 347d68335eb427547606497eb4edea81acce7891f9reed@google.com#else 357d68335eb427547606497eb4edea81acce7891f9reed@google.com // to reduce branch instructions, we compare 4 at a time. 367d68335eb427547606497eb4edea81acce7891f9reed@google.com // see bench/Matrix44Bench.cpp for test. 377d68335eb427547606497eb4edea81acce7891f9reed@google.com if (!eq4(&a[0], &b[0])) { 387d68335eb427547606497eb4edea81acce7891f9reed@google.com return false; 397d68335eb427547606497eb4edea81acce7891f9reed@google.com } 407d68335eb427547606497eb4edea81acce7891f9reed@google.com if (!eq4(&a[4], &b[4])) { 417d68335eb427547606497eb4edea81acce7891f9reed@google.com return false; 427d68335eb427547606497eb4edea81acce7891f9reed@google.com } 437d68335eb427547606497eb4edea81acce7891f9reed@google.com if (!eq4(&a[8], &b[8])) { 447d68335eb427547606497eb4edea81acce7891f9reed@google.com return false; 457d68335eb427547606497eb4edea81acce7891f9reed@google.com } 467d68335eb427547606497eb4edea81acce7891f9reed@google.com return eq4(&a[12], &b[12]); 477d68335eb427547606497eb4edea81acce7891f9reed@google.com#endif 487d68335eb427547606497eb4edea81acce7891f9reed@google.com} 497d68335eb427547606497eb4edea81acce7891f9reed@google.com 507d68335eb427547606497eb4edea81acce7891f9reed@google.com/////////////////////////////////////////////////////////////////////////////// 517d68335eb427547606497eb4edea81acce7891f9reed@google.com 527d68335eb427547606497eb4edea81acce7891f9reed@google.comint SkMatrix44::computeTypeMask() const { 537d68335eb427547606497eb4edea81acce7891f9reed@google.com unsigned mask = 0; 540264fb4543b0d8cebe00f1ee32433784f4ceb074skia.committer@gmail.com 557d68335eb427547606497eb4edea81acce7891f9reed@google.com if (0 != perspX() || 0 != perspY() || 0 != perspZ() || 1 != fMat[3][3]) { 567d68335eb427547606497eb4edea81acce7891f9reed@google.com return kTranslate_Mask | kScale_Mask | kAffine_Mask | kPerspective_Mask; 577d68335eb427547606497eb4edea81acce7891f9reed@google.com } 587d68335eb427547606497eb4edea81acce7891f9reed@google.com 597d68335eb427547606497eb4edea81acce7891f9reed@google.com if (0 != transX() || 0 != transY() || 0 != transZ()) { 607d68335eb427547606497eb4edea81acce7891f9reed@google.com mask |= kTranslate_Mask; 617d68335eb427547606497eb4edea81acce7891f9reed@google.com } 627d68335eb427547606497eb4edea81acce7891f9reed@google.com 637d68335eb427547606497eb4edea81acce7891f9reed@google.com if (1 != scaleX() || 1 != scaleY() || 1 != scaleZ()) { 647d68335eb427547606497eb4edea81acce7891f9reed@google.com mask |= kScale_Mask; 657d68335eb427547606497eb4edea81acce7891f9reed@google.com } 667d68335eb427547606497eb4edea81acce7891f9reed@google.com 677d68335eb427547606497eb4edea81acce7891f9reed@google.com if (0 != fMat[1][0] || 0 != fMat[0][1] || 0 != fMat[0][2] || 687d68335eb427547606497eb4edea81acce7891f9reed@google.com 0 != fMat[2][0] || 0 != fMat[1][2] || 0 != fMat[2][1]) { 697d68335eb427547606497eb4edea81acce7891f9reed@google.com mask |= kAffine_Mask; 707d68335eb427547606497eb4edea81acce7891f9reed@google.com } 717d68335eb427547606497eb4edea81acce7891f9reed@google.com 727d68335eb427547606497eb4edea81acce7891f9reed@google.com return mask; 738260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 748260a895869beaa4cab9f8b915e457728f41e561reed@google.com 758260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 768260a895869beaa4cab9f8b915e457728f41e561reed@google.com 77da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.comvoid SkMatrix44::asColMajorf(float dst[]) const { 78da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com const SkMScalar* src = &fMat[0][0]; 79da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com#ifdef SK_MSCALAR_IS_DOUBLE 80da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com for (int i = 0; i < 16; ++i) { 81da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com dst[i] = SkMScalarToFloat(src[i]); 82da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com } 835596a69e9f7884e3042bceba071c468dee52aa7fvollick@chromium.org#elif defined SK_MSCALAR_IS_FLOAT 84da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com memcpy(dst, src, 16 * sizeof(float)); 85da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com#endif 86da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com} 87da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com 88de68d6c4616d86621373d88100002ddfdb9c08e3brianosmanvoid SkMatrix44::as3x4RowMajorf(float dst[]) const { 89de68d6c4616d86621373d88100002ddfdb9c08e3brianosman dst[0] = fMat[0][0]; dst[1] = fMat[1][0]; dst[2] = fMat[2][0]; dst[3] = fMat[3][0]; 90de68d6c4616d86621373d88100002ddfdb9c08e3brianosman dst[4] = fMat[0][1]; dst[5] = fMat[1][1]; dst[6] = fMat[2][1]; dst[7] = fMat[3][1]; 91de68d6c4616d86621373d88100002ddfdb9c08e3brianosman dst[8] = fMat[0][2]; dst[9] = fMat[1][2]; dst[10] = fMat[2][2]; dst[11] = fMat[3][2]; 92111a42d9cebf0bb8844c5d24f67fac57cc619d29msarett} 93111a42d9cebf0bb8844c5d24f67fac57cc619d29msarett 94da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.comvoid SkMatrix44::asColMajord(double dst[]) const { 95da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com const SkMScalar* src = &fMat[0][0]; 96da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com#ifdef SK_MSCALAR_IS_DOUBLE 97da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com memcpy(dst, src, 16 * sizeof(double)); 985596a69e9f7884e3042bceba071c468dee52aa7fvollick@chromium.org#elif defined SK_MSCALAR_IS_FLOAT 99da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com for (int i = 0; i < 16; ++i) { 100da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com dst[i] = SkMScalarToDouble(src[i]); 101da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com } 102da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com#endif 103da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com} 104da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com 105da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.comvoid SkMatrix44::asRowMajorf(float dst[]) const { 106da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com const SkMScalar* src = &fMat[0][0]; 107da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com for (int i = 0; i < 4; ++i) { 108da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com dst[0] = SkMScalarToFloat(src[0]); 109da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com dst[4] = SkMScalarToFloat(src[1]); 110da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com dst[8] = SkMScalarToFloat(src[2]); 111da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com dst[12] = SkMScalarToFloat(src[3]); 112da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com src += 4; 113da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com dst += 1; 114da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com } 115da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com} 116da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com 117da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.comvoid SkMatrix44::asRowMajord(double dst[]) const { 118da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com const SkMScalar* src = &fMat[0][0]; 119da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com for (int i = 0; i < 4; ++i) { 120da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com dst[0] = SkMScalarToDouble(src[0]); 121da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com dst[4] = SkMScalarToDouble(src[1]); 122f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org dst[8] = SkMScalarToDouble(src[2]); 123f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org dst[12] = SkMScalarToDouble(src[3]); 124f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org src += 4; 125f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org dst += 1; 126f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org } 127f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org} 128f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org 129f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.orgvoid SkMatrix44::setColMajorf(const float src[]) { 130f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org SkMScalar* dst = &fMat[0][0]; 131f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org#ifdef SK_MSCALAR_IS_DOUBLE 132f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org for (int i = 0; i < 16; ++i) { 133f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org dst[i] = SkMScalarToFloat(src[i]); 134f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org } 135f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org#elif defined SK_MSCALAR_IS_FLOAT 136f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org memcpy(dst, src, 16 * sizeof(float)); 137f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org#endif 1387d68335eb427547606497eb4edea81acce7891f9reed@google.com 1397d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 140f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org} 141f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org 142f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.orgvoid SkMatrix44::setColMajord(const double src[]) { 143f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org SkMScalar* dst = &fMat[0][0]; 144f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org#ifdef SK_MSCALAR_IS_DOUBLE 145f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org memcpy(dst, src, 16 * sizeof(double)); 146f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org#elif defined SK_MSCALAR_IS_FLOAT 147f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org for (int i = 0; i < 16; ++i) { 14893f03324189f211db95c312b3cb08b435cc5ac34robertphillips@google.com dst[i] = SkDoubleToMScalar(src[i]); 149f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org } 150f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org#endif 1517d68335eb427547606497eb4edea81acce7891f9reed@google.com 1527d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 153f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org} 154f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org 155f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.orgvoid SkMatrix44::setRowMajorf(const float src[]) { 156f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org SkMScalar* dst = &fMat[0][0]; 157f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org for (int i = 0; i < 4; ++i) { 158f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org dst[0] = SkMScalarToFloat(src[0]); 159f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org dst[4] = SkMScalarToFloat(src[1]); 160f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org dst[8] = SkMScalarToFloat(src[2]); 161f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org dst[12] = SkMScalarToFloat(src[3]); 162f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org src += 4; 163f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org dst += 1; 164f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org } 1657d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 166f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org} 167f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org 168f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.orgvoid SkMatrix44::setRowMajord(const double src[]) { 169f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org SkMScalar* dst = &fMat[0][0]; 170f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org for (int i = 0; i < 4; ++i) { 17193f03324189f211db95c312b3cb08b435cc5ac34robertphillips@google.com dst[0] = SkDoubleToMScalar(src[0]); 17293f03324189f211db95c312b3cb08b435cc5ac34robertphillips@google.com dst[4] = SkDoubleToMScalar(src[1]); 17393f03324189f211db95c312b3cb08b435cc5ac34robertphillips@google.com dst[8] = SkDoubleToMScalar(src[2]); 17493f03324189f211db95c312b3cb08b435cc5ac34robertphillips@google.com dst[12] = SkDoubleToMScalar(src[3]); 175da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com src += 4; 176da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com dst += 1; 177da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com } 1787d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 179da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com} 180da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com 181da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com/////////////////////////////////////////////////////////////////////////////// 182da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com 1837d68335eb427547606497eb4edea81acce7891f9reed@google.comconst SkMatrix44& SkMatrix44::I() { 184c1a3e24918f99fc0b975111afb39dca38c50eb5cmsarett static constexpr SkMatrix44 gIdentity44(kIdentity_Constructor); 1851adad343b9ee010a5adc07a369bd98cb25062e5dreed@google.com return gIdentity44; 1868260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 1878260a895869beaa4cab9f8b915e457728f41e561reed@google.com 1888260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::setIdentity() { 1895a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[0][0] = 1; 1905a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[0][1] = 0; 1915a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[0][2] = 0; 1925a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[0][3] = 0; 1935a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[1][0] = 0; 1945a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[1][1] = 1; 1955a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[1][2] = 0; 1965a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[1][3] = 0; 1975a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[2][0] = 0; 1985a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[2][1] = 0; 1995a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[2][2] = 1; 2005a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[2][3] = 0; 2015a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[3][0] = 0; 2025a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[3][1] = 0; 2035a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[3][2] = 0; 2045a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[3][3] = 1; 2057d68335eb427547606497eb4edea81acce7891f9reed@google.com this->setTypeMask(kIdentity_Mask); 2068260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 2078260a895869beaa4cab9f8b915e457728f41e561reed@google.com 2088260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::set3x3(SkMScalar m00, SkMScalar m01, SkMScalar m02, 2098260a895869beaa4cab9f8b915e457728f41e561reed@google.com SkMScalar m10, SkMScalar m11, SkMScalar m12, 2108260a895869beaa4cab9f8b915e457728f41e561reed@google.com SkMScalar m20, SkMScalar m21, SkMScalar m22) { 2118260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[0][0] = m00; fMat[0][1] = m01; fMat[0][2] = m02; fMat[0][3] = 0; 2128260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[1][0] = m10; fMat[1][1] = m11; fMat[1][2] = m12; fMat[1][3] = 0; 2138260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[2][0] = m20; fMat[2][1] = m21; fMat[2][2] = m22; fMat[2][3] = 0; 2148260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[3][0] = 0; fMat[3][1] = 0; fMat[3][2] = 0; fMat[3][3] = 1; 2157d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 2168260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 2178260a895869beaa4cab9f8b915e457728f41e561reed@google.com 218c1a3e24918f99fc0b975111afb39dca38c50eb5cmsarettvoid SkMatrix44::set3x3RowMajorf(const float src[]) { 21950d3b57c8aaa0f026b981101c45ea30361382940reed fMat[0][0] = src[0]; fMat[0][1] = src[3]; fMat[0][2] = src[6]; fMat[0][3] = 0; 22050d3b57c8aaa0f026b981101c45ea30361382940reed fMat[1][0] = src[1]; fMat[1][1] = src[4]; fMat[1][2] = src[7]; fMat[1][3] = 0; 22150d3b57c8aaa0f026b981101c45ea30361382940reed fMat[2][0] = src[2]; fMat[2][1] = src[5]; fMat[2][2] = src[8]; fMat[2][3] = 0; 22250d3b57c8aaa0f026b981101c45ea30361382940reed fMat[3][0] = 0; fMat[3][1] = 0; fMat[3][2] = 0; fMat[3][3] = 1; 22350d3b57c8aaa0f026b981101c45ea30361382940reed this->dirtyTypeMask(); 22450d3b57c8aaa0f026b981101c45ea30361382940reed} 22550d3b57c8aaa0f026b981101c45ea30361382940reed 226de68d6c4616d86621373d88100002ddfdb9c08e3brianosmanvoid SkMatrix44::set3x4RowMajorf(const float src[]) { 227de68d6c4616d86621373d88100002ddfdb9c08e3brianosman fMat[0][0] = src[0]; fMat[1][0] = src[1]; fMat[2][0] = src[2]; fMat[3][0] = src[3]; 228de68d6c4616d86621373d88100002ddfdb9c08e3brianosman fMat[0][1] = src[4]; fMat[1][1] = src[5]; fMat[2][1] = src[6]; fMat[3][1] = src[7]; 229de68d6c4616d86621373d88100002ddfdb9c08e3brianosman fMat[0][2] = src[8]; fMat[1][2] = src[9]; fMat[2][2] = src[10]; fMat[3][2] = src[11]; 230de68d6c4616d86621373d88100002ddfdb9c08e3brianosman fMat[0][3] = 0; fMat[1][3] = 0; fMat[2][3] = 0; fMat[3][3] = 1; 231111a42d9cebf0bb8844c5d24f67fac57cc619d29msarett this->dirtyTypeMask(); 232111a42d9cebf0bb8844c5d24f67fac57cc619d29msarett} 233111a42d9cebf0bb8844c5d24f67fac57cc619d29msarett 2348260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 2358260a895869beaa4cab9f8b915e457728f41e561reed@google.com 23699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comvoid SkMatrix44::setTranslate(SkMScalar dx, SkMScalar dy, SkMScalar dz) { 2378260a895869beaa4cab9f8b915e457728f41e561reed@google.com this->setIdentity(); 238e659c2e820de0b8d12d81247ed4430022ded0a90skia.committer@gmail.com 23999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (!dx && !dy && !dz) { 24099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return; 2417d68335eb427547606497eb4edea81acce7891f9reed@google.com } 2420264fb4543b0d8cebe00f1ee32433784f4ceb074skia.committer@gmail.com 24399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com fMat[3][0] = dx; 24499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com fMat[3][1] = dy; 24599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com fMat[3][2] = dz; 24699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com this->setTypeMask(kTranslate_Mask); 2478260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 2488260a895869beaa4cab9f8b915e457728f41e561reed@google.com 2498260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::preTranslate(SkMScalar dx, SkMScalar dy, SkMScalar dz) { 25099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (!dx && !dy && !dz) { 25199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return; 25299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 25399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 25499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int i = 0; i < 4; ++i) { 255658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org fMat[3][i] = fMat[0][i] * dx + fMat[1][i] * dy + fMat[2][i] * dz + fMat[3][i]; 25699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 25799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com this->dirtyTypeMask(); 2588260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 2598260a895869beaa4cab9f8b915e457728f41e561reed@google.com 2608260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::postTranslate(SkMScalar dx, SkMScalar dy, SkMScalar dz) { 26199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (!dx && !dy && !dz) { 26299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return; 26399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 26499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 26599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (this->getType() & kPerspective_Mask) { 26699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int i = 0; i < 4; ++i) { 26799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com fMat[i][0] += fMat[i][3] * dx; 26899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com fMat[i][1] += fMat[i][3] * dy; 26999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com fMat[i][2] += fMat[i][3] * dz; 27099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 27199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } else { 27299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com fMat[3][0] += dx; 27399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com fMat[3][1] += dy; 27499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com fMat[3][2] += dz; 27599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com this->dirtyTypeMask(); 27699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 2778260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 2788260a895869beaa4cab9f8b915e457728f41e561reed@google.com 2798260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 2808260a895869beaa4cab9f8b915e457728f41e561reed@google.com 2818260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::setScale(SkMScalar sx, SkMScalar sy, SkMScalar sz) { 28299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com this->setIdentity(); 28399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 28499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (1 == sx && 1 == sy && 1 == sz) { 28599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return; 28699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 28799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 2888260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[0][0] = sx; 2898260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[1][1] = sy; 2908260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[2][2] = sz; 29199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com this->setTypeMask(kScale_Mask); 2928260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 2938260a895869beaa4cab9f8b915e457728f41e561reed@google.com 2948260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::preScale(SkMScalar sx, SkMScalar sy, SkMScalar sz) { 29599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (1 == sx && 1 == sy && 1 == sz) { 29699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return; 29799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 2980264fb4543b0d8cebe00f1ee32433784f4ceb074skia.committer@gmail.com 299f81f97e75bed9e407952c9be629f5479c65f9865shawnsingh@chromium.org // The implementation matrix * pureScale can be shortcut 300f81f97e75bed9e407952c9be629f5479c65f9865shawnsingh@chromium.org // by knowing that pureScale components effectively scale 301f81f97e75bed9e407952c9be629f5479c65f9865shawnsingh@chromium.org // the columns of the original matrix. 302f81f97e75bed9e407952c9be629f5479c65f9865shawnsingh@chromium.org for (int i = 0; i < 4; i++) { 303f81f97e75bed9e407952c9be629f5479c65f9865shawnsingh@chromium.org fMat[0][i] *= sx; 304f81f97e75bed9e407952c9be629f5479c65f9865shawnsingh@chromium.org fMat[1][i] *= sy; 305f81f97e75bed9e407952c9be629f5479c65f9865shawnsingh@chromium.org fMat[2][i] *= sz; 306f81f97e75bed9e407952c9be629f5479c65f9865shawnsingh@chromium.org } 307f81f97e75bed9e407952c9be629f5479c65f9865shawnsingh@chromium.org this->dirtyTypeMask(); 3088260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 3098260a895869beaa4cab9f8b915e457728f41e561reed@google.com 3108260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::postScale(SkMScalar sx, SkMScalar sy, SkMScalar sz) { 31199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (1 == sx && 1 == sy && 1 == sz) { 31299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return; 31399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 3140264fb4543b0d8cebe00f1ee32433784f4ceb074skia.committer@gmail.com 3158260a895869beaa4cab9f8b915e457728f41e561reed@google.com for (int i = 0; i < 4; i++) { 3168260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[i][0] *= sx; 3178260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[i][1] *= sy; 3188260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[i][2] *= sz; 3198260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 3207d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 3218260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 3228260a895869beaa4cab9f8b915e457728f41e561reed@google.com 3238260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 3248260a895869beaa4cab9f8b915e457728f41e561reed@google.com 3258260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::setRotateAbout(SkMScalar x, SkMScalar y, SkMScalar z, 3268260a895869beaa4cab9f8b915e457728f41e561reed@google.com SkMScalar radians) { 3277d68335eb427547606497eb4edea81acce7891f9reed@google.com double len2 = (double)x * x + (double)y * y + (double)z * z; 3287d68335eb427547606497eb4edea81acce7891f9reed@google.com if (1 != len2) { 3297d68335eb427547606497eb4edea81acce7891f9reed@google.com if (0 == len2) { 3308260a895869beaa4cab9f8b915e457728f41e561reed@google.com this->setIdentity(); 3318260a895869beaa4cab9f8b915e457728f41e561reed@google.com return; 3328260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 3338260a895869beaa4cab9f8b915e457728f41e561reed@google.com double scale = 1 / sqrt(len2); 3349d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com x = SkDoubleToMScalar(x * scale); 3359d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com y = SkDoubleToMScalar(y * scale); 3369d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com z = SkDoubleToMScalar(z * scale); 3378260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 3388260a895869beaa4cab9f8b915e457728f41e561reed@google.com this->setRotateAboutUnit(x, y, z, radians); 3398260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 3408260a895869beaa4cab9f8b915e457728f41e561reed@google.com 3418260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::setRotateAboutUnit(SkMScalar x, SkMScalar y, SkMScalar z, 3428260a895869beaa4cab9f8b915e457728f41e561reed@google.com SkMScalar radians) { 3438260a895869beaa4cab9f8b915e457728f41e561reed@google.com double c = cos(radians); 3448260a895869beaa4cab9f8b915e457728f41e561reed@google.com double s = sin(radians); 3458260a895869beaa4cab9f8b915e457728f41e561reed@google.com double C = 1 - c; 3468260a895869beaa4cab9f8b915e457728f41e561reed@google.com double xs = x * s; 3478260a895869beaa4cab9f8b915e457728f41e561reed@google.com double ys = y * s; 3488260a895869beaa4cab9f8b915e457728f41e561reed@google.com double zs = z * s; 3498260a895869beaa4cab9f8b915e457728f41e561reed@google.com double xC = x * C; 3508260a895869beaa4cab9f8b915e457728f41e561reed@google.com double yC = y * C; 3518260a895869beaa4cab9f8b915e457728f41e561reed@google.com double zC = z * C; 3528260a895869beaa4cab9f8b915e457728f41e561reed@google.com double xyC = x * yC; 3538260a895869beaa4cab9f8b915e457728f41e561reed@google.com double yzC = y * zC; 3548260a895869beaa4cab9f8b915e457728f41e561reed@google.com double zxC = z * xC; 3558260a895869beaa4cab9f8b915e457728f41e561reed@google.com 3568260a895869beaa4cab9f8b915e457728f41e561reed@google.com // if you're looking at wikipedia, remember that we're column major. 3579d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com this->set3x3(SkDoubleToMScalar(x * xC + c), // scale x 3589d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com SkDoubleToMScalar(xyC + zs), // skew x 3599d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com SkDoubleToMScalar(zxC - ys), // trans x 3609d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com 3619d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com SkDoubleToMScalar(xyC - zs), // skew y 3629d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com SkDoubleToMScalar(y * yC + c), // scale y 3639d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com SkDoubleToMScalar(yzC + xs), // trans y 3649d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com 3659d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com SkDoubleToMScalar(zxC + ys), // persp x 3669d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com SkDoubleToMScalar(yzC - xs), // persp y 3679d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com SkDoubleToMScalar(z * zC + c)); // persp 2 3688260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 3698260a895869beaa4cab9f8b915e457728f41e561reed@google.com 3708260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 3718260a895869beaa4cab9f8b915e457728f41e561reed@google.com 37299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic bool bits_isonly(int value, int mask) { 37399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return 0 == (value & ~mask); 37499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 37599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 3768260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::setConcat(const SkMatrix44& a, const SkMatrix44& b) { 37799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com const SkMatrix44::TypeMask a_mask = a.getType(); 37899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com const SkMatrix44::TypeMask b_mask = b.getType(); 37999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 38099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (kIdentity_Mask == a_mask) { 3817d68335eb427547606497eb4edea81acce7891f9reed@google.com *this = b; 3827d68335eb427547606497eb4edea81acce7891f9reed@google.com return; 3837d68335eb427547606497eb4edea81acce7891f9reed@google.com } 38499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (kIdentity_Mask == b_mask) { 3857d68335eb427547606497eb4edea81acce7891f9reed@google.com *this = a; 3867d68335eb427547606497eb4edea81acce7891f9reed@google.com return; 3877d68335eb427547606497eb4edea81acce7891f9reed@google.com } 3887d68335eb427547606497eb4edea81acce7891f9reed@google.com 3897d68335eb427547606497eb4edea81acce7891f9reed@google.com bool useStorage = (this == &a || this == &b); 3907d68335eb427547606497eb4edea81acce7891f9reed@google.com SkMScalar storage[16]; 3917d68335eb427547606497eb4edea81acce7891f9reed@google.com SkMScalar* result = useStorage ? storage : &fMat[0][0]; 3927d68335eb427547606497eb4edea81acce7891f9reed@google.com 3932b16570bda716725e08ad2e92a852f043179c13creed@google.com // Both matrices are at most scale+translate 39499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (bits_isonly(a_mask | b_mask, kScale_Mask | kTranslate_Mask)) { 39599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com result[0] = a.fMat[0][0] * b.fMat[0][0]; 3962b16570bda716725e08ad2e92a852f043179c13creed@google.com result[1] = result[2] = result[3] = result[4] = 0; 39799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com result[5] = a.fMat[1][1] * b.fMat[1][1]; 3982b16570bda716725e08ad2e92a852f043179c13creed@google.com result[6] = result[7] = result[8] = result[9] = 0; 39999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com result[10] = a.fMat[2][2] * b.fMat[2][2]; 4002b16570bda716725e08ad2e92a852f043179c13creed@google.com result[11] = 0; 40199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com result[12] = a.fMat[0][0] * b.fMat[3][0] + a.fMat[3][0]; 40299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com result[13] = a.fMat[1][1] * b.fMat[3][1] + a.fMat[3][1]; 40399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com result[14] = a.fMat[2][2] * b.fMat[3][2] + a.fMat[3][2]; 40499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com result[15] = 1; 40599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } else { 40699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int j = 0; j < 4; j++) { 40799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int i = 0; i < 4; i++) { 408bde4ba2ce6994a57f1b4e820ac83e9d27caf75decommit-bot@chromium.org double value = 0; 40999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int k = 0; k < 4; k++) { 410bde4ba2ce6994a57f1b4e820ac83e9d27caf75decommit-bot@chromium.org value += SkMScalarToDouble(a.fMat[k][i]) * b.fMat[j][k]; 41199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 412bde4ba2ce6994a57f1b4e820ac83e9d27caf75decommit-bot@chromium.org *result++ = SkDoubleToMScalar(value); 4138260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 4148260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 4158260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 41699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 4177d68335eb427547606497eb4edea81acce7891f9reed@google.com if (useStorage) { 4187cfb9c7b6186bf1e42b7d13466eab94470587e7etomhudson@google.com memcpy(fMat, storage, sizeof(storage)); 4197d68335eb427547606497eb4edea81acce7891f9reed@google.com } 4207d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 4218260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 4228260a895869beaa4cab9f8b915e457728f41e561reed@google.com 4238260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 4248260a895869beaa4cab9f8b915e457728f41e561reed@google.com 4258260a895869beaa4cab9f8b915e457728f41e561reed@google.com/** We always perform the calculation in doubles, to avoid prematurely losing 4268260a895869beaa4cab9f8b915e457728f41e561reed@google.com precision along the way. This relies on the compiler automatically 4278260a895869beaa4cab9f8b915e457728f41e561reed@google.com promoting our SkMScalar values to double (if needed). 4288260a895869beaa4cab9f8b915e457728f41e561reed@google.com */ 4298260a895869beaa4cab9f8b915e457728f41e561reed@google.comdouble SkMatrix44::determinant() const { 430f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org if (this->isIdentity()) { 431f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org return 1; 432f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org } 433f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org if (this->isScaleTranslate()) { 434f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org return fMat[0][0] * fMat[1][1] * fMat[2][2] * fMat[3][3]; 435f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org } 436f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org 4379973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a00 = fMat[0][0]; 4389973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a01 = fMat[0][1]; 4399973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a02 = fMat[0][2]; 4409973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a03 = fMat[0][3]; 4419973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a10 = fMat[1][0]; 4429973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a11 = fMat[1][1]; 4439973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a12 = fMat[1][2]; 4449973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a13 = fMat[1][3]; 4459973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a20 = fMat[2][0]; 4469973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a21 = fMat[2][1]; 4479973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a22 = fMat[2][2]; 4489973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a23 = fMat[2][3]; 4499973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a30 = fMat[3][0]; 4509973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a31 = fMat[3][1]; 4519973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a32 = fMat[3][2]; 4529973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a33 = fMat[3][3]; 4539973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com 4549973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b00 = a00 * a11 - a01 * a10; 4559973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b01 = a00 * a12 - a02 * a10; 4569973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b02 = a00 * a13 - a03 * a10; 4579973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b03 = a01 * a12 - a02 * a11; 4589973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b04 = a01 * a13 - a03 * a11; 4599973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b05 = a02 * a13 - a03 * a12; 4609973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b06 = a20 * a31 - a21 * a30; 4619973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b07 = a20 * a32 - a22 * a30; 4629973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b08 = a20 * a33 - a23 * a30; 4639973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b09 = a21 * a32 - a22 * a31; 4649973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b10 = a21 * a33 - a23 * a31; 4659973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b11 = a22 * a33 - a23 * a32; 4669973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com 4679973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com // Calculate the determinant 4689973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com return b00 * b11 - b01 * b10 + b02 * b09 + b03 * b08 - b04 * b07 + b05 * b06; 4698260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 4708260a895869beaa4cab9f8b915e457728f41e561reed@google.com 4718260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 4728260a895869beaa4cab9f8b915e457728f41e561reed@google.com 473a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstrstatic bool is_matrix_finite(const SkMatrix44& matrix) { 474a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr SkMScalar accumulator = 0; 475a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr for (int row = 0; row < 4; ++row) { 476a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr for (int col = 0; col < 4; ++col) { 477a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr accumulator *= matrix.get(row, col); 478a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr } 479a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr } 480a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr return accumulator == 0; 481a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr} 482a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr 483a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstrbool SkMatrix44::invert(SkMatrix44* storage) const { 484f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org if (this->isIdentity()) { 485a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr if (storage) { 486a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr storage->setIdentity(); 4877d68335eb427547606497eb4edea81acce7891f9reed@google.com } 488178acd25b0053908ffcdf1b07a9f93d797408b13commit-bot@chromium.org return true; 4897d68335eb427547606497eb4edea81acce7891f9reed@google.com } 490178acd25b0053908ffcdf1b07a9f93d797408b13commit-bot@chromium.org 491f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org if (this->isTranslate()) { 492a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr if (storage) { 493a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr storage->setTranslate(-fMat[3][0], -fMat[3][1], -fMat[3][2]); 49499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 49599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return true; 49699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 497178acd25b0053908ffcdf1b07a9f93d797408b13commit-bot@chromium.org 498a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr SkMatrix44 tmp(kUninitialized_Constructor); 499a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr // Use storage if it's available and distinct from this matrix. 500a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr SkMatrix44* inverse = (storage && storage != this) ? storage : &tmp; 501f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org if (this->isScaleTranslate()) { 50299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (0 == fMat[0][0] * fMat[1][1] * fMat[2][2]) { 50399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return false; 50499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 50599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 506a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr double invXScale = 1 / fMat[0][0]; 507a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr double invYScale = 1 / fMat[1][1]; 508a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr double invZScale = 1 / fMat[2][2]; 509772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com 510a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[0][0] = SkDoubleToMScalar(invXScale); 511a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[0][1] = 0; 512a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[0][2] = 0; 513a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[0][3] = 0; 514772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com 515a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[1][0] = 0; 516a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[1][1] = SkDoubleToMScalar(invYScale); 517a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[1][2] = 0; 518a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[1][3] = 0; 519772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com 520a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[2][0] = 0; 521a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[2][1] = 0; 522a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[2][2] = SkDoubleToMScalar(invZScale); 523a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[2][3] = 0; 524772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com 525a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[3][0] = SkDoubleToMScalar(-fMat[3][0] * invXScale); 526a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[3][1] = SkDoubleToMScalar(-fMat[3][1] * invYScale); 527a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[3][2] = SkDoubleToMScalar(-fMat[3][2] * invZScale); 528a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[3][3] = 1; 529c33d6218f06520f577c16c4d1914d031a29396efcommit-bot@chromium.org 530a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->setTypeMask(this->getType()); 5315a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org 532a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr if (!is_matrix_finite(*inverse)) { 533a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr return false; 534a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr } 535a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr if (storage && inverse != storage) { 536a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr *storage = *inverse; 537a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr } 53899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return true; 53999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 54099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 5419973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a00 = fMat[0][0]; 5429973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a01 = fMat[0][1]; 5439973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a02 = fMat[0][2]; 5449973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a03 = fMat[0][3]; 5459973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a10 = fMat[1][0]; 5469973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a11 = fMat[1][1]; 5479973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a12 = fMat[1][2]; 5489973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a13 = fMat[1][3]; 5499973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a20 = fMat[2][0]; 5509973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a21 = fMat[2][1]; 5519973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a22 = fMat[2][2]; 5529973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a23 = fMat[2][3]; 5539973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a30 = fMat[3][0]; 5549973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a31 = fMat[3][1]; 5559973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a32 = fMat[3][2]; 5569973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a33 = fMat[3][3]; 5579973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com 558b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org if (!(this->getType() & kPerspective_Mask)) { 559b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // If we know the matrix has no perspective, then the perspective 560b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // component is (0, 0, 0, 1). We can use this information to save a lot 561b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // of arithmetic that would otherwise be spent to compute the inverse 562b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // of a general matrix. 563b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 564b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org SkASSERT(a03 == 0); 565b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org SkASSERT(a13 == 0); 566b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org SkASSERT(a23 == 0); 567b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org SkASSERT(a33 == 1); 568b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 569b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b00 = a00 * a11 - a01 * a10; 570b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b01 = a00 * a12 - a02 * a10; 571b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b03 = a01 * a12 - a02 * a11; 572b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b06 = a20 * a31 - a21 * a30; 573b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b07 = a20 * a32 - a22 * a30; 574b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b08 = a20; 575b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b09 = a21 * a32 - a22 * a31; 576b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b10 = a21; 577b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b11 = a22; 578b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 579b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // Calculate the determinant 580b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double det = b00 * b11 - b01 * b10 + b03 * b08; 581b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 582b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double invdet = 1.0 / det; 583b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // If det is zero, we want to return false. However, we also want to return false 584b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // if 1/det overflows to infinity (i.e. det is denormalized). Both of these are 585b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // handled by checking that 1/det is finite. 586b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org if (!sk_float_isfinite(invdet)) { 587b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org return false; 588b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org } 589b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 590b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b00 *= invdet; 591b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b01 *= invdet; 592b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b03 *= invdet; 593b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b06 *= invdet; 594b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b07 *= invdet; 595b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b08 *= invdet; 596b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b09 *= invdet; 597b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b10 *= invdet; 598b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b11 *= invdet; 599b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 600b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[0][0] = SkDoubleToMScalar(a11 * b11 - a12 * b10); 601b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[0][1] = SkDoubleToMScalar(a02 * b10 - a01 * b11); 602b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[0][2] = SkDoubleToMScalar(b03); 603b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[0][3] = 0; 604b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[1][0] = SkDoubleToMScalar(a12 * b08 - a10 * b11); 605b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[1][1] = SkDoubleToMScalar(a00 * b11 - a02 * b08); 606b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[1][2] = SkDoubleToMScalar(-b01); 607b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[1][3] = 0; 608b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[2][0] = SkDoubleToMScalar(a10 * b10 - a11 * b08); 609b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[2][1] = SkDoubleToMScalar(a01 * b08 - a00 * b10); 610b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[2][2] = SkDoubleToMScalar(b00); 611b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[2][3] = 0; 612b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[3][0] = SkDoubleToMScalar(a11 * b07 - a10 * b09 - a12 * b06); 613b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[3][1] = SkDoubleToMScalar(a00 * b09 - a01 * b07 + a02 * b06); 614b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[3][2] = SkDoubleToMScalar(a31 * b01 - a30 * b03 - a32 * b00); 615b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[3][3] = 1; 616b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 617b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->setTypeMask(this->getType()); 618a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr if (!is_matrix_finite(*inverse)) { 619a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr return false; 620a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr } 621a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr if (storage && inverse != storage) { 622a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr *storage = *inverse; 623a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr } 624b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org return true; 625b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org } 626b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 6279973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b00 = a00 * a11 - a01 * a10; 6289973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b01 = a00 * a12 - a02 * a10; 6299973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b02 = a00 * a13 - a03 * a10; 6309973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b03 = a01 * a12 - a02 * a11; 6319973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b04 = a01 * a13 - a03 * a11; 6329973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b05 = a02 * a13 - a03 * a12; 6339973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b06 = a20 * a31 - a21 * a30; 6349973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b07 = a20 * a32 - a22 * a30; 6359973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b08 = a20 * a33 - a23 * a30; 6369973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b09 = a21 * a32 - a22 * a31; 6379973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b10 = a21 * a33 - a23 * a31; 6389973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b11 = a22 * a33 - a23 * a32; 6399973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com 6409973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com // Calculate the determinant 6419973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double det = b00 * b11 - b01 * b10 + b02 * b09 + b03 * b08 - b04 * b07 + b05 * b06; 6429973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com 643f02f07835e417a5baff27dc8ef0b0e773ab7be00commit-bot@chromium.org double invdet = 1.0 / det; 644f02f07835e417a5baff27dc8ef0b0e773ab7be00commit-bot@chromium.org // If det is zero, we want to return false. However, we also want to return false 645f02f07835e417a5baff27dc8ef0b0e773ab7be00commit-bot@chromium.org // if 1/det overflows to infinity (i.e. det is denormalized). Both of these are 646f02f07835e417a5baff27dc8ef0b0e773ab7be00commit-bot@chromium.org // handled by checking that 1/det is finite. 647f02f07835e417a5baff27dc8ef0b0e773ab7be00commit-bot@chromium.org if (!sk_float_isfinite(invdet)) { 6488260a895869beaa4cab9f8b915e457728f41e561reed@google.com return false; 6498260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 6509973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com 6519973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b00 *= invdet; 6529973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b01 *= invdet; 6539973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b02 *= invdet; 6549973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b03 *= invdet; 6559973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b04 *= invdet; 6569973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b05 *= invdet; 6579973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b06 *= invdet; 6589973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b07 *= invdet; 6599973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b08 *= invdet; 6609973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b09 *= invdet; 6619973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b10 *= invdet; 6629973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b11 *= invdet; 6639973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com 6649973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[0][0] = SkDoubleToMScalar(a11 * b11 - a12 * b10 + a13 * b09); 6659973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[0][1] = SkDoubleToMScalar(a02 * b10 - a01 * b11 - a03 * b09); 6669973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[0][2] = SkDoubleToMScalar(a31 * b05 - a32 * b04 + a33 * b03); 6679973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[0][3] = SkDoubleToMScalar(a22 * b04 - a21 * b05 - a23 * b03); 6689973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[1][0] = SkDoubleToMScalar(a12 * b08 - a10 * b11 - a13 * b07); 6699973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[1][1] = SkDoubleToMScalar(a00 * b11 - a02 * b08 + a03 * b07); 6709973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[1][2] = SkDoubleToMScalar(a32 * b02 - a30 * b05 - a33 * b01); 6719973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[1][3] = SkDoubleToMScalar(a20 * b05 - a22 * b02 + a23 * b01); 6729973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[2][0] = SkDoubleToMScalar(a10 * b10 - a11 * b08 + a13 * b06); 6739973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[2][1] = SkDoubleToMScalar(a01 * b08 - a00 * b10 - a03 * b06); 6749973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[2][2] = SkDoubleToMScalar(a30 * b04 - a31 * b02 + a33 * b00); 6759973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[2][3] = SkDoubleToMScalar(a21 * b02 - a20 * b04 - a23 * b00); 6769973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[3][0] = SkDoubleToMScalar(a11 * b07 - a10 * b09 - a12 * b06); 6779973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[3][1] = SkDoubleToMScalar(a00 * b09 - a01 * b07 + a02 * b06); 6789973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[3][2] = SkDoubleToMScalar(a31 * b01 - a30 * b03 - a32 * b00); 6799973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[3][3] = SkDoubleToMScalar(a20 * b03 - a21 * b01 + a22 * b00); 6809973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->dirtyTypeMask(); 6818260a895869beaa4cab9f8b915e457728f41e561reed@google.com 682a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->setTypeMask(this->getType()); 683a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr if (!is_matrix_finite(*inverse)) { 684a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr return false; 685a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr } 686a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr if (storage && inverse != storage) { 687a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr *storage = *inverse; 688a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr } 6898260a895869beaa4cab9f8b915e457728f41e561reed@google.com return true; 6908260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 6918260a895869beaa4cab9f8b915e457728f41e561reed@google.com 6928260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 6938260a895869beaa4cab9f8b915e457728f41e561reed@google.com 6949b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.orgvoid SkMatrix44::transpose() { 6959b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org SkTSwap(fMat[0][1], fMat[1][0]); 6969b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org SkTSwap(fMat[0][2], fMat[2][0]); 6979b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org SkTSwap(fMat[0][3], fMat[3][0]); 6989b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org SkTSwap(fMat[1][2], fMat[2][1]); 6999b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org SkTSwap(fMat[1][3], fMat[3][1]); 7009b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org SkTSwap(fMat[2][3], fMat[3][2]); 7017d68335eb427547606497eb4edea81acce7891f9reed@google.com 7027d68335eb427547606497eb4edea81acce7891f9reed@google.com if (!this->isTriviallyIdentity()) { 7037d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 7047d68335eb427547606497eb4edea81acce7891f9reed@google.com } 7059b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org} 7069b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org 7079b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org/////////////////////////////////////////////////////////////////////////////// 7089b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org 7091ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.comvoid SkMatrix44::mapScalars(const SkScalar src[4], SkScalar dst[4]) const { 7107d68335eb427547606497eb4edea81acce7891f9reed@google.com SkScalar storage[4]; 7117d68335eb427547606497eb4edea81acce7891f9reed@google.com SkScalar* result = (src == dst) ? storage : dst; 7127d68335eb427547606497eb4edea81acce7891f9reed@google.com 7138260a895869beaa4cab9f8b915e457728f41e561reed@google.com for (int i = 0; i < 4; i++) { 7148260a895869beaa4cab9f8b915e457728f41e561reed@google.com SkMScalar value = 0; 7158260a895869beaa4cab9f8b915e457728f41e561reed@google.com for (int j = 0; j < 4; j++) { 7168260a895869beaa4cab9f8b915e457728f41e561reed@google.com value += fMat[j][i] * src[j]; 7178260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 71872e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com result[i] = SkMScalarToScalar(value); 7198260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 7200264fb4543b0d8cebe00f1ee32433784f4ceb074skia.committer@gmail.com 7217d68335eb427547606497eb4edea81acce7891f9reed@google.com if (storage == result) { 7227d68335eb427547606497eb4edea81acce7891f9reed@google.com memcpy(dst, storage, sizeof(storage)); 7237d68335eb427547606497eb4edea81acce7891f9reed@google.com } 7248260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 7258260a895869beaa4cab9f8b915e457728f41e561reed@google.com 7261ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com#ifdef SK_MSCALAR_IS_DOUBLE 7277d68335eb427547606497eb4edea81acce7891f9reed@google.com 7281ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.comvoid SkMatrix44::mapMScalars(const SkMScalar src[4], SkMScalar dst[4]) const { 7297d68335eb427547606497eb4edea81acce7891f9reed@google.com SkMScalar storage[4]; 7307d68335eb427547606497eb4edea81acce7891f9reed@google.com SkMScalar* result = (src == dst) ? storage : dst; 7310264fb4543b0d8cebe00f1ee32433784f4ceb074skia.committer@gmail.com 7321ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com for (int i = 0; i < 4; i++) { 7331ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com SkMScalar value = 0; 7341ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com for (int j = 0; j < 4; j++) { 7351ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com value += fMat[j][i] * src[j]; 7361ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com } 7377d68335eb427547606497eb4edea81acce7891f9reed@google.com result[i] = value; 7387d68335eb427547606497eb4edea81acce7891f9reed@google.com } 7390264fb4543b0d8cebe00f1ee32433784f4ceb074skia.committer@gmail.com 7407d68335eb427547606497eb4edea81acce7891f9reed@google.com if (storage == result) { 7417d68335eb427547606497eb4edea81acce7891f9reed@google.com memcpy(dst, storage, sizeof(storage)); 7421ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com } 7431ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com} 7447d68335eb427547606497eb4edea81acce7891f9reed@google.com 7451ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com#endif 7461ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com 74799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comtypedef void (*Map2Procf)(const SkMScalar mat[][4], const float src2[], int count, float dst4[]); 74899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comtypedef void (*Map2Procd)(const SkMScalar mat[][4], const double src2[], int count, double dst4[]); 74999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 75099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_if(const SkMScalar mat[][4], const float* SK_RESTRICT src2, 75199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, float* SK_RESTRICT dst4) { 75299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int i = 0; i < count; ++i) { 75399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = src2[0]; 75499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = src2[1]; 75599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = 0; 75699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 75799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 75899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 75999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 76099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 76199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 76299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_id(const SkMScalar mat[][4], const double* SK_RESTRICT src2, 76399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, double* SK_RESTRICT dst4) { 76499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int i = 0; i < count; ++i) { 76599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = src2[0]; 76699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = src2[1]; 76799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = 0; 76899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 76999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 77099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 77199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 77299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 77399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 77499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_tf(const SkMScalar mat[][4], const float* SK_RESTRICT src2, 77599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, float* SK_RESTRICT dst4) { 77699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com const float mat30 = SkMScalarToFloat(mat[3][0]); 77799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com const float mat31 = SkMScalarToFloat(mat[3][1]); 77899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com const float mat32 = SkMScalarToFloat(mat[3][2]); 77999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 78099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = src2[0] + mat30; 78199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = src2[1] + mat31; 78299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = mat32; 78399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 78499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 78599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 78699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 78799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 78899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 78999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_td(const SkMScalar mat[][4], const double* SK_RESTRICT src2, 79099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, double* SK_RESTRICT dst4) { 79199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 79299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = src2[0] + mat[3][0]; 79399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = src2[1] + mat[3][1]; 79499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = mat[3][2]; 79599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 79699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 79799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 79899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 79999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 80099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 80199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_sf(const SkMScalar mat[][4], const float* SK_RESTRICT src2, 80299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, float* SK_RESTRICT dst4) { 80399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com const float mat32 = SkMScalarToFloat(mat[3][2]); 80499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 80599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = SkMScalarToFloat(mat[0][0] * src2[0] + mat[3][0]); 80699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = SkMScalarToFloat(mat[1][1] * src2[1] + mat[3][1]); 80799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = mat32; 80899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 80999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 81099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 81199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 81299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 81399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 81499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_sd(const SkMScalar mat[][4], const double* SK_RESTRICT src2, 81599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, double* SK_RESTRICT dst4) { 81699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 81799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = mat[0][0] * src2[0] + mat[3][0]; 81899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = mat[1][1] * src2[1] + mat[3][1]; 81999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = mat[3][2]; 82099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 82199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 82299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 82399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 82499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 82599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 82699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_af(const SkMScalar mat[][4], const float* SK_RESTRICT src2, 82799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, float* SK_RESTRICT dst4) { 828658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org SkMScalar r; 82999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 830658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org SkMScalar sx = SkFloatToMScalar(src2[0]); 831658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org SkMScalar sy = SkFloatToMScalar(src2[1]); 83299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com r = mat[0][0] * sx + mat[1][0] * sy + mat[3][0]; 83399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = SkMScalarToFloat(r); 83499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com r = mat[0][1] * sx + mat[1][1] * sy + mat[3][1]; 83599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = SkMScalarToFloat(r); 83699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com r = mat[0][2] * sx + mat[1][2] * sy + mat[3][2]; 83799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = SkMScalarToFloat(r); 83899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 83999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 84099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 84199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 84299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 84399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 84499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_ad(const SkMScalar mat[][4], const double* SK_RESTRICT src2, 84599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, double* SK_RESTRICT dst4) { 84699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 84799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com double sx = src2[0]; 84899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com double sy = src2[1]; 84999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = mat[0][0] * sx + mat[1][0] * sy + mat[3][0]; 85099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = mat[0][1] * sx + mat[1][1] * sy + mat[3][1]; 85199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = mat[0][2] * sx + mat[1][2] * sy + mat[3][2]; 85299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 85399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 85499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 85599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 85699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 85799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 85899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_pf(const SkMScalar mat[][4], const float* SK_RESTRICT src2, 85999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, float* SK_RESTRICT dst4) { 860658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org SkMScalar r; 86199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 862658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org SkMScalar sx = SkFloatToMScalar(src2[0]); 863658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org SkMScalar sy = SkFloatToMScalar(src2[1]); 86499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int i = 0; i < 4; i++) { 865658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org r = mat[0][i] * sx + mat[1][i] * sy + mat[3][i]; 866658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org dst4[i] = SkMScalarToFloat(r); 86799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 86899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 86999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 87099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 87199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 87299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 87399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_pd(const SkMScalar mat[][4], const double* SK_RESTRICT src2, 87499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, double* SK_RESTRICT dst4) { 87599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 87699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com double sx = src2[0]; 87799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com double sy = src2[1]; 87899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int i = 0; i < 4; i++) { 87999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[i] = mat[0][i] * sx + mat[1][i] * sy + mat[3][i]; 88099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 88199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 88299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 88399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 88499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 88599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 88699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comvoid SkMatrix44::map2(const float src2[], int count, float dst4[]) const { 88799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com static const Map2Procf gProc[] = { 88899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com map2_if, map2_tf, map2_sf, map2_sf, map2_af, map2_af, map2_af, map2_af 88999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com }; 89099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 89199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com TypeMask mask = this->getType(); 89299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com Map2Procf proc = (mask & kPerspective_Mask) ? map2_pf : gProc[mask]; 89399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com proc(fMat, src2, count, dst4); 89499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 89599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 89699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comvoid SkMatrix44::map2(const double src2[], int count, double dst4[]) const { 89799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com static const Map2Procd gProc[] = { 89899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com map2_id, map2_td, map2_sd, map2_sd, map2_ad, map2_ad, map2_ad, map2_ad 89999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com }; 9000264fb4543b0d8cebe00f1ee32433784f4ceb074skia.committer@gmail.com 90199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com TypeMask mask = this->getType(); 90299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com Map2Procd proc = (mask & kPerspective_Mask) ? map2_pd : gProc[mask]; 90399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com proc(fMat, src2, count, dst4); 90499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 90599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 906faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudsonbool SkMatrix44::preserves2dAxisAlignment (SkMScalar epsilon) const { 907faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson 908faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson // Can't check (mask & kPerspective_Mask) because Z isn't relevant here. 909faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson if (0 != perspX() || 0 != perspY()) return false; 910faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson 911faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson // A matrix with two non-zeroish values in any of the upper right 912faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson // rows or columns will skew. If only one value in each row or 913faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson // column is non-zeroish, we get a scale plus perhaps a 90-degree 914faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson // rotation. 915faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson int col0 = 0; 916faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson int col1 = 0; 917faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson int row0 = 0; 918faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson int row1 = 0; 919faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson 920faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson // Must test against epsilon, not 0, because we can get values 921faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson // around 6e-17 in the matrix that "should" be 0. 922faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson 923faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson if (SkMScalarAbs(fMat[0][0]) > epsilon) { 924faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson col0++; 925faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson row0++; 926faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson } 927faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson if (SkMScalarAbs(fMat[0][1]) > epsilon) { 928faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson col1++; 929faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson row0++; 930faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson } 931faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson if (SkMScalarAbs(fMat[1][0]) > epsilon) { 932faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson col0++; 933faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson row1++; 934faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson } 935faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson if (SkMScalarAbs(fMat[1][1]) > epsilon) { 936faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson col1++; 937faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson row1++; 938faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson } 939faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson if (col0 > 1 || col1 > 1 || row0 > 1 || row1 > 1) { 940faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson return false; 941faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson } 942faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson 943faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson return true; 944faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson} 945faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson 9468260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 9478260a895869beaa4cab9f8b915e457728f41e561reed@google.com 9488260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::dump() const { 949271dabaeb246ffbad88c87072432a6670751c7a8Mike Klein static const char* format = "|%g %g %g %g|\n" 950271dabaeb246ffbad88c87072432a6670751c7a8Mike Klein "|%g %g %g %g|\n" 951271dabaeb246ffbad88c87072432a6670751c7a8Mike Klein "|%g %g %g %g|\n" 952271dabaeb246ffbad88c87072432a6670751c7a8Mike Klein "|%g %g %g %g|\n"; 9539ac4a89d35df3d581886a84df421161418707fd6tomhudson@google.com SkDebugf(format, 9548260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[0][0], fMat[1][0], fMat[2][0], fMat[3][0], 9558260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[0][1], fMat[1][1], fMat[2][1], fMat[3][1], 9568260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[0][2], fMat[1][2], fMat[2][2], fMat[3][2], 9578260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[0][3], fMat[1][3], fMat[2][3], fMat[3][3]); 9588260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 9598260a895869beaa4cab9f8b915e457728f41e561reed@google.com 9608260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 9618260a895869beaa4cab9f8b915e457728f41e561reed@google.com 9628260a895869beaa4cab9f8b915e457728f41e561reed@google.comstatic void initFromMatrix(SkMScalar dst[4][4], const SkMatrix& src) { 96372e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[0][0] = SkScalarToMScalar(src[SkMatrix::kMScaleX]); 96472e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[1][0] = SkScalarToMScalar(src[SkMatrix::kMSkewX]); 9655a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[2][0] = 0; 96672e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[3][0] = SkScalarToMScalar(src[SkMatrix::kMTransX]); 96772e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[0][1] = SkScalarToMScalar(src[SkMatrix::kMSkewY]); 96872e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[1][1] = SkScalarToMScalar(src[SkMatrix::kMScaleY]); 9695a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[2][1] = 0; 97072e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[3][1] = SkScalarToMScalar(src[SkMatrix::kMTransY]); 9715a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[0][2] = 0; 9725a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[1][2] = 0; 9735a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[2][2] = 1; 9745a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[3][2] = 0; 975722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org dst[0][3] = SkScalarToMScalar(src[SkMatrix::kMPersp0]); 976722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org dst[1][3] = SkScalarToMScalar(src[SkMatrix::kMPersp1]); 9775a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[2][3] = 0; 978722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org dst[3][3] = SkScalarToMScalar(src[SkMatrix::kMPersp2]); 9798260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 9808260a895869beaa4cab9f8b915e457728f41e561reed@google.com 9818260a895869beaa4cab9f8b915e457728f41e561reed@google.comSkMatrix44::SkMatrix44(const SkMatrix& src) { 98288640cf363ac15761784902706296b7a611a42d4fs this->operator=(src); 9838260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 9848260a895869beaa4cab9f8b915e457728f41e561reed@google.com 9858260a895869beaa4cab9f8b915e457728f41e561reed@google.comSkMatrix44& SkMatrix44::operator=(const SkMatrix& src) { 9868260a895869beaa4cab9f8b915e457728f41e561reed@google.com initFromMatrix(fMat, src); 9877d68335eb427547606497eb4edea81acce7891f9reed@google.com 9887d68335eb427547606497eb4edea81acce7891f9reed@google.com if (src.isIdentity()) { 9897d68335eb427547606497eb4edea81acce7891f9reed@google.com this->setTypeMask(kIdentity_Mask); 9907d68335eb427547606497eb4edea81acce7891f9reed@google.com } else { 9917d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 9927d68335eb427547606497eb4edea81acce7891f9reed@google.com } 9938260a895869beaa4cab9f8b915e457728f41e561reed@google.com return *this; 9948260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 9958260a895869beaa4cab9f8b915e457728f41e561reed@google.com 9968260a895869beaa4cab9f8b915e457728f41e561reed@google.comSkMatrix44::operator SkMatrix() const { 9978260a895869beaa4cab9f8b915e457728f41e561reed@google.com SkMatrix dst; 9988260a895869beaa4cab9f8b915e457728f41e561reed@google.com 99972e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[SkMatrix::kMScaleX] = SkMScalarToScalar(fMat[0][0]); 100072e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[SkMatrix::kMSkewX] = SkMScalarToScalar(fMat[1][0]); 100172e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[SkMatrix::kMTransX] = SkMScalarToScalar(fMat[3][0]); 10028260a895869beaa4cab9f8b915e457728f41e561reed@google.com 100372e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[SkMatrix::kMSkewY] = SkMScalarToScalar(fMat[0][1]); 100472e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[SkMatrix::kMScaleY] = SkMScalarToScalar(fMat[1][1]); 100572e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[SkMatrix::kMTransY] = SkMScalarToScalar(fMat[3][1]); 10068260a895869beaa4cab9f8b915e457728f41e561reed@google.com 1007722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org dst[SkMatrix::kMPersp0] = SkMScalarToScalar(fMat[0][3]); 1008722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org dst[SkMatrix::kMPersp1] = SkMScalarToScalar(fMat[1][3]); 1009722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org dst[SkMatrix::kMPersp2] = SkMScalarToScalar(fMat[3][3]); 1010722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org 10118260a895869beaa4cab9f8b915e457728f41e561reed@google.com return dst; 10128260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 1013