SkMatrix44.cpp revision 658e28b0810d01dc03f8c48b93f6659d41f25b09
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 88da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.comvoid SkMatrix44::asColMajord(double dst[]) const { 89da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com const SkMScalar* src = &fMat[0][0]; 90da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com#ifdef SK_MSCALAR_IS_DOUBLE 91da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com memcpy(dst, src, 16 * sizeof(double)); 925596a69e9f7884e3042bceba071c468dee52aa7fvollick@chromium.org#elif defined SK_MSCALAR_IS_FLOAT 93da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com for (int i = 0; i < 16; ++i) { 94da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com dst[i] = SkMScalarToDouble(src[i]); 95da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com } 96da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com#endif 97da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com} 98da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com 99da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.comvoid SkMatrix44::asRowMajorf(float dst[]) const { 100da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com const SkMScalar* src = &fMat[0][0]; 101da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com for (int i = 0; i < 4; ++i) { 102da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com dst[0] = SkMScalarToFloat(src[0]); 103da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com dst[4] = SkMScalarToFloat(src[1]); 104da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com dst[8] = SkMScalarToFloat(src[2]); 105da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com dst[12] = SkMScalarToFloat(src[3]); 106da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com src += 4; 107da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com dst += 1; 108da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com } 109da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com} 110da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com 111da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.comvoid SkMatrix44::asRowMajord(double dst[]) const { 112da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com const SkMScalar* src = &fMat[0][0]; 113da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com for (int i = 0; i < 4; ++i) { 114da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com dst[0] = SkMScalarToDouble(src[0]); 115da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com dst[4] = SkMScalarToDouble(src[1]); 116f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org dst[8] = SkMScalarToDouble(src[2]); 117f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org dst[12] = SkMScalarToDouble(src[3]); 118f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org src += 4; 119f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org dst += 1; 120f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org } 121f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org} 122f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org 123f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.orgvoid SkMatrix44::setColMajorf(const float src[]) { 124f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org SkMScalar* dst = &fMat[0][0]; 125f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org#ifdef SK_MSCALAR_IS_DOUBLE 126f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org for (int i = 0; i < 16; ++i) { 127f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org dst[i] = SkMScalarToFloat(src[i]); 128f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org } 129f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org#elif defined SK_MSCALAR_IS_FLOAT 130f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org memcpy(dst, src, 16 * sizeof(float)); 131f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org#endif 1327d68335eb427547606497eb4edea81acce7891f9reed@google.com 1337d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 134f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org} 135f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org 136f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.orgvoid SkMatrix44::setColMajord(const double src[]) { 137f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org SkMScalar* dst = &fMat[0][0]; 138f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org#ifdef SK_MSCALAR_IS_DOUBLE 139f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org memcpy(dst, src, 16 * sizeof(double)); 140f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org#elif defined SK_MSCALAR_IS_FLOAT 141f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org for (int i = 0; i < 16; ++i) { 14293f03324189f211db95c312b3cb08b435cc5ac34robertphillips@google.com dst[i] = SkDoubleToMScalar(src[i]); 143f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org } 144f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org#endif 1457d68335eb427547606497eb4edea81acce7891f9reed@google.com 1467d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 147f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org} 148f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org 149f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.orgvoid SkMatrix44::setRowMajorf(const float src[]) { 150f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org SkMScalar* dst = &fMat[0][0]; 151f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org for (int i = 0; i < 4; ++i) { 152f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org dst[0] = SkMScalarToFloat(src[0]); 153f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org dst[4] = SkMScalarToFloat(src[1]); 154f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org dst[8] = SkMScalarToFloat(src[2]); 155f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org dst[12] = SkMScalarToFloat(src[3]); 156f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org src += 4; 157f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org dst += 1; 158f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org } 1597d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 160f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org} 161f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org 162f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.orgvoid SkMatrix44::setRowMajord(const double src[]) { 163f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org SkMScalar* dst = &fMat[0][0]; 164f11cf9ff885c81e29f55283174ca34ce2fc5fd23vollick@chromium.org for (int i = 0; i < 4; ++i) { 16593f03324189f211db95c312b3cb08b435cc5ac34robertphillips@google.com dst[0] = SkDoubleToMScalar(src[0]); 16693f03324189f211db95c312b3cb08b435cc5ac34robertphillips@google.com dst[4] = SkDoubleToMScalar(src[1]); 16793f03324189f211db95c312b3cb08b435cc5ac34robertphillips@google.com dst[8] = SkDoubleToMScalar(src[2]); 16893f03324189f211db95c312b3cb08b435cc5ac34robertphillips@google.com dst[12] = SkDoubleToMScalar(src[3]); 169da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com src += 4; 170da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com dst += 1; 171da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com } 1727d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 173da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com} 174da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com 175da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com/////////////////////////////////////////////////////////////////////////////// 176da9fac0aa13d1445f8b58a75d9390638845c814dreed@google.com 1777d68335eb427547606497eb4edea81acce7891f9reed@google.comconst SkMatrix44& SkMatrix44::I() { 1781adad343b9ee010a5adc07a369bd98cb25062e5dreed@google.com static const SkMatrix44 gIdentity44(kIdentity_Constructor); 1791adad343b9ee010a5adc07a369bd98cb25062e5dreed@google.com return gIdentity44; 1808260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 1818260a895869beaa4cab9f8b915e457728f41e561reed@google.com 1828260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::setIdentity() { 1835a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[0][0] = 1; 1845a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[0][1] = 0; 1855a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[0][2] = 0; 1865a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[0][3] = 0; 1875a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[1][0] = 0; 1885a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[1][1] = 1; 1895a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[1][2] = 0; 1905a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[1][3] = 0; 1915a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[2][0] = 0; 1925a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[2][1] = 0; 1935a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[2][2] = 1; 1945a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[2][3] = 0; 1955a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[3][0] = 0; 1965a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[3][1] = 0; 1975a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[3][2] = 0; 1985a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org fMat[3][3] = 1; 1997d68335eb427547606497eb4edea81acce7891f9reed@google.com this->setTypeMask(kIdentity_Mask); 2008260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 2018260a895869beaa4cab9f8b915e457728f41e561reed@google.com 2028260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::set3x3(SkMScalar m00, SkMScalar m01, SkMScalar m02, 2038260a895869beaa4cab9f8b915e457728f41e561reed@google.com SkMScalar m10, SkMScalar m11, SkMScalar m12, 2048260a895869beaa4cab9f8b915e457728f41e561reed@google.com SkMScalar m20, SkMScalar m21, SkMScalar m22) { 2058260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[0][0] = m00; fMat[0][1] = m01; fMat[0][2] = m02; fMat[0][3] = 0; 2068260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[1][0] = m10; fMat[1][1] = m11; fMat[1][2] = m12; fMat[1][3] = 0; 2078260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[2][0] = m20; fMat[2][1] = m21; fMat[2][2] = m22; fMat[2][3] = 0; 2088260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[3][0] = 0; fMat[3][1] = 0; fMat[3][2] = 0; fMat[3][3] = 1; 2097d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 2108260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 2118260a895869beaa4cab9f8b915e457728f41e561reed@google.com 2128260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 2138260a895869beaa4cab9f8b915e457728f41e561reed@google.com 21499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comvoid SkMatrix44::setTranslate(SkMScalar dx, SkMScalar dy, SkMScalar dz) { 2158260a895869beaa4cab9f8b915e457728f41e561reed@google.com this->setIdentity(); 216e659c2e820de0b8d12d81247ed4430022ded0a90skia.committer@gmail.com 21799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (!dx && !dy && !dz) { 21899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return; 2197d68335eb427547606497eb4edea81acce7891f9reed@google.com } 2200264fb4543b0d8cebe00f1ee32433784f4ceb074skia.committer@gmail.com 22199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com fMat[3][0] = dx; 22299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com fMat[3][1] = dy; 22399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com fMat[3][2] = dz; 22499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com this->setTypeMask(kTranslate_Mask); 2258260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 2268260a895869beaa4cab9f8b915e457728f41e561reed@google.com 2278260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::preTranslate(SkMScalar dx, SkMScalar dy, SkMScalar dz) { 22899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (!dx && !dy && !dz) { 22999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return; 23099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 23199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 23299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int i = 0; i < 4; ++i) { 233658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org fMat[3][i] = fMat[0][i] * dx + fMat[1][i] * dy + fMat[2][i] * dz + fMat[3][i]; 23499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 23599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com this->dirtyTypeMask(); 2368260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 2378260a895869beaa4cab9f8b915e457728f41e561reed@google.com 2388260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::postTranslate(SkMScalar dx, SkMScalar dy, SkMScalar dz) { 23999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (!dx && !dy && !dz) { 24099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return; 24199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 24299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 24399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (this->getType() & kPerspective_Mask) { 24499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int i = 0; i < 4; ++i) { 24599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com fMat[i][0] += fMat[i][3] * dx; 24699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com fMat[i][1] += fMat[i][3] * dy; 24799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com fMat[i][2] += fMat[i][3] * dz; 24899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 24999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } else { 25099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com fMat[3][0] += dx; 25199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com fMat[3][1] += dy; 25299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com fMat[3][2] += dz; 25399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com this->dirtyTypeMask(); 25499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 2558260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 2568260a895869beaa4cab9f8b915e457728f41e561reed@google.com 2578260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 2588260a895869beaa4cab9f8b915e457728f41e561reed@google.com 2598260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::setScale(SkMScalar sx, SkMScalar sy, SkMScalar sz) { 26099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com this->setIdentity(); 26199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 26299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (1 == sx && 1 == sy && 1 == sz) { 26399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return; 26499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 26599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 2668260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[0][0] = sx; 2678260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[1][1] = sy; 2688260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[2][2] = sz; 26999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com this->setTypeMask(kScale_Mask); 2708260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 2718260a895869beaa4cab9f8b915e457728f41e561reed@google.com 2728260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::preScale(SkMScalar sx, SkMScalar sy, SkMScalar sz) { 27399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (1 == sx && 1 == sy && 1 == sz) { 27499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return; 27599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 2760264fb4543b0d8cebe00f1ee32433784f4ceb074skia.committer@gmail.com 277f81f97e75bed9e407952c9be629f5479c65f9865shawnsingh@chromium.org // The implementation matrix * pureScale can be shortcut 278f81f97e75bed9e407952c9be629f5479c65f9865shawnsingh@chromium.org // by knowing that pureScale components effectively scale 279f81f97e75bed9e407952c9be629f5479c65f9865shawnsingh@chromium.org // the columns of the original matrix. 280f81f97e75bed9e407952c9be629f5479c65f9865shawnsingh@chromium.org for (int i = 0; i < 4; i++) { 281f81f97e75bed9e407952c9be629f5479c65f9865shawnsingh@chromium.org fMat[0][i] *= sx; 282f81f97e75bed9e407952c9be629f5479c65f9865shawnsingh@chromium.org fMat[1][i] *= sy; 283f81f97e75bed9e407952c9be629f5479c65f9865shawnsingh@chromium.org fMat[2][i] *= sz; 284f81f97e75bed9e407952c9be629f5479c65f9865shawnsingh@chromium.org } 285f81f97e75bed9e407952c9be629f5479c65f9865shawnsingh@chromium.org this->dirtyTypeMask(); 2868260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 2878260a895869beaa4cab9f8b915e457728f41e561reed@google.com 2888260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::postScale(SkMScalar sx, SkMScalar sy, SkMScalar sz) { 28999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (1 == sx && 1 == sy && 1 == sz) { 29099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return; 29199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 2920264fb4543b0d8cebe00f1ee32433784f4ceb074skia.committer@gmail.com 2938260a895869beaa4cab9f8b915e457728f41e561reed@google.com for (int i = 0; i < 4; i++) { 2948260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[i][0] *= sx; 2958260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[i][1] *= sy; 2968260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[i][2] *= sz; 2978260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 2987d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 2998260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 3008260a895869beaa4cab9f8b915e457728f41e561reed@google.com 3018260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 3028260a895869beaa4cab9f8b915e457728f41e561reed@google.com 3038260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::setRotateAbout(SkMScalar x, SkMScalar y, SkMScalar z, 3048260a895869beaa4cab9f8b915e457728f41e561reed@google.com SkMScalar radians) { 3057d68335eb427547606497eb4edea81acce7891f9reed@google.com double len2 = (double)x * x + (double)y * y + (double)z * z; 3067d68335eb427547606497eb4edea81acce7891f9reed@google.com if (1 != len2) { 3077d68335eb427547606497eb4edea81acce7891f9reed@google.com if (0 == len2) { 3088260a895869beaa4cab9f8b915e457728f41e561reed@google.com this->setIdentity(); 3098260a895869beaa4cab9f8b915e457728f41e561reed@google.com return; 3108260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 3118260a895869beaa4cab9f8b915e457728f41e561reed@google.com double scale = 1 / sqrt(len2); 3129d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com x = SkDoubleToMScalar(x * scale); 3139d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com y = SkDoubleToMScalar(y * scale); 3149d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com z = SkDoubleToMScalar(z * scale); 3158260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 3168260a895869beaa4cab9f8b915e457728f41e561reed@google.com this->setRotateAboutUnit(x, y, z, radians); 3178260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 3188260a895869beaa4cab9f8b915e457728f41e561reed@google.com 3198260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::setRotateAboutUnit(SkMScalar x, SkMScalar y, SkMScalar z, 3208260a895869beaa4cab9f8b915e457728f41e561reed@google.com SkMScalar radians) { 3218260a895869beaa4cab9f8b915e457728f41e561reed@google.com double c = cos(radians); 3228260a895869beaa4cab9f8b915e457728f41e561reed@google.com double s = sin(radians); 3238260a895869beaa4cab9f8b915e457728f41e561reed@google.com double C = 1 - c; 3248260a895869beaa4cab9f8b915e457728f41e561reed@google.com double xs = x * s; 3258260a895869beaa4cab9f8b915e457728f41e561reed@google.com double ys = y * s; 3268260a895869beaa4cab9f8b915e457728f41e561reed@google.com double zs = z * s; 3278260a895869beaa4cab9f8b915e457728f41e561reed@google.com double xC = x * C; 3288260a895869beaa4cab9f8b915e457728f41e561reed@google.com double yC = y * C; 3298260a895869beaa4cab9f8b915e457728f41e561reed@google.com double zC = z * C; 3308260a895869beaa4cab9f8b915e457728f41e561reed@google.com double xyC = x * yC; 3318260a895869beaa4cab9f8b915e457728f41e561reed@google.com double yzC = y * zC; 3328260a895869beaa4cab9f8b915e457728f41e561reed@google.com double zxC = z * xC; 3338260a895869beaa4cab9f8b915e457728f41e561reed@google.com 3348260a895869beaa4cab9f8b915e457728f41e561reed@google.com // if you're looking at wikipedia, remember that we're column major. 3359d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com this->set3x3(SkDoubleToMScalar(x * xC + c), // scale x 3369d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com SkDoubleToMScalar(xyC + zs), // skew x 3379d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com SkDoubleToMScalar(zxC - ys), // trans x 3389d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com 3399d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com SkDoubleToMScalar(xyC - zs), // skew y 3409d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com SkDoubleToMScalar(y * yC + c), // scale y 3419d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com SkDoubleToMScalar(yzC + xs), // trans y 3429d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com 3439d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com SkDoubleToMScalar(zxC + ys), // persp x 3449d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com SkDoubleToMScalar(yzC - xs), // persp y 3459d12f5c11b56ef51ba2c95db721ae7e5bab27023bsalomon@google.com SkDoubleToMScalar(z * zC + c)); // persp 2 3468260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 3478260a895869beaa4cab9f8b915e457728f41e561reed@google.com 3488260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 3498260a895869beaa4cab9f8b915e457728f41e561reed@google.com 35099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic bool bits_isonly(int value, int mask) { 35199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return 0 == (value & ~mask); 35299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 35399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 3548260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::setConcat(const SkMatrix44& a, const SkMatrix44& b) { 35599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com const SkMatrix44::TypeMask a_mask = a.getType(); 35699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com const SkMatrix44::TypeMask b_mask = b.getType(); 35799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 35899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (kIdentity_Mask == a_mask) { 3597d68335eb427547606497eb4edea81acce7891f9reed@google.com *this = b; 3607d68335eb427547606497eb4edea81acce7891f9reed@google.com return; 3617d68335eb427547606497eb4edea81acce7891f9reed@google.com } 36299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (kIdentity_Mask == b_mask) { 3637d68335eb427547606497eb4edea81acce7891f9reed@google.com *this = a; 3647d68335eb427547606497eb4edea81acce7891f9reed@google.com return; 3657d68335eb427547606497eb4edea81acce7891f9reed@google.com } 3667d68335eb427547606497eb4edea81acce7891f9reed@google.com 3677d68335eb427547606497eb4edea81acce7891f9reed@google.com bool useStorage = (this == &a || this == &b); 3687d68335eb427547606497eb4edea81acce7891f9reed@google.com SkMScalar storage[16]; 3697d68335eb427547606497eb4edea81acce7891f9reed@google.com SkMScalar* result = useStorage ? storage : &fMat[0][0]; 3707d68335eb427547606497eb4edea81acce7891f9reed@google.com 3712b16570bda716725e08ad2e92a852f043179c13creed@google.com // Both matrices are at most scale+translate 37299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (bits_isonly(a_mask | b_mask, kScale_Mask | kTranslate_Mask)) { 37399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com result[0] = a.fMat[0][0] * b.fMat[0][0]; 3742b16570bda716725e08ad2e92a852f043179c13creed@google.com result[1] = result[2] = result[3] = result[4] = 0; 37599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com result[5] = a.fMat[1][1] * b.fMat[1][1]; 3762b16570bda716725e08ad2e92a852f043179c13creed@google.com result[6] = result[7] = result[8] = result[9] = 0; 37799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com result[10] = a.fMat[2][2] * b.fMat[2][2]; 3782b16570bda716725e08ad2e92a852f043179c13creed@google.com result[11] = 0; 37999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com result[12] = a.fMat[0][0] * b.fMat[3][0] + a.fMat[3][0]; 38099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com result[13] = a.fMat[1][1] * b.fMat[3][1] + a.fMat[3][1]; 38199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com result[14] = a.fMat[2][2] * b.fMat[3][2] + a.fMat[3][2]; 38299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com result[15] = 1; 38399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } else { 38499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int j = 0; j < 4; j++) { 38599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int i = 0; i < 4; i++) { 38699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com double value = 0; 38799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int k = 0; k < 4; k++) { 38899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com value += SkMScalarToDouble(a.fMat[k][i]) * b.fMat[j][k]; 38999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 39099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com *result++ = SkDoubleToMScalar(value); 3918260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 3928260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 3938260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 39499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 3957d68335eb427547606497eb4edea81acce7891f9reed@google.com if (useStorage) { 3967cfb9c7b6186bf1e42b7d13466eab94470587e7etomhudson@google.com memcpy(fMat, storage, sizeof(storage)); 3977d68335eb427547606497eb4edea81acce7891f9reed@google.com } 3987d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 3998260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 4008260a895869beaa4cab9f8b915e457728f41e561reed@google.com 4018260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 4028260a895869beaa4cab9f8b915e457728f41e561reed@google.com 4038260a895869beaa4cab9f8b915e457728f41e561reed@google.com/** We always perform the calculation in doubles, to avoid prematurely losing 4048260a895869beaa4cab9f8b915e457728f41e561reed@google.com precision along the way. This relies on the compiler automatically 4058260a895869beaa4cab9f8b915e457728f41e561reed@google.com promoting our SkMScalar values to double (if needed). 4068260a895869beaa4cab9f8b915e457728f41e561reed@google.com */ 4078260a895869beaa4cab9f8b915e457728f41e561reed@google.comdouble SkMatrix44::determinant() const { 408f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org if (this->isIdentity()) { 409f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org return 1; 410f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org } 411f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org if (this->isScaleTranslate()) { 412f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org return fMat[0][0] * fMat[1][1] * fMat[2][2] * fMat[3][3]; 413f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org } 414f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org 4159973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a00 = fMat[0][0]; 4169973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a01 = fMat[0][1]; 4179973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a02 = fMat[0][2]; 4189973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a03 = fMat[0][3]; 4199973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a10 = fMat[1][0]; 4209973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a11 = fMat[1][1]; 4219973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a12 = fMat[1][2]; 4229973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a13 = fMat[1][3]; 4239973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a20 = fMat[2][0]; 4249973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a21 = fMat[2][1]; 4259973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a22 = fMat[2][2]; 4269973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a23 = fMat[2][3]; 4279973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a30 = fMat[3][0]; 4289973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a31 = fMat[3][1]; 4299973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a32 = fMat[3][2]; 4309973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a33 = fMat[3][3]; 4319973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com 4329973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b00 = a00 * a11 - a01 * a10; 4339973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b01 = a00 * a12 - a02 * a10; 4349973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b02 = a00 * a13 - a03 * a10; 4359973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b03 = a01 * a12 - a02 * a11; 4369973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b04 = a01 * a13 - a03 * a11; 4379973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b05 = a02 * a13 - a03 * a12; 4389973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b06 = a20 * a31 - a21 * a30; 4399973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b07 = a20 * a32 - a22 * a30; 4409973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b08 = a20 * a33 - a23 * a30; 4419973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b09 = a21 * a32 - a22 * a31; 4429973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b10 = a21 * a33 - a23 * a31; 4439973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b11 = a22 * a33 - a23 * a32; 4449973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com 4459973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com // Calculate the determinant 4469973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com return b00 * b11 - b01 * b10 + b02 * b09 + b03 * b08 - b04 * b07 + b05 * b06; 4478260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 4488260a895869beaa4cab9f8b915e457728f41e561reed@google.com 4498260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 4508260a895869beaa4cab9f8b915e457728f41e561reed@google.com 4518260a895869beaa4cab9f8b915e457728f41e561reed@google.combool SkMatrix44::invert(SkMatrix44* inverse) const { 452f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org if (this->isIdentity()) { 4537d68335eb427547606497eb4edea81acce7891f9reed@google.com if (inverse) { 4545a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org inverse->setIdentity(); 4557d68335eb427547606497eb4edea81acce7891f9reed@google.com return true; 4567d68335eb427547606497eb4edea81acce7891f9reed@google.com } 4577d68335eb427547606497eb4edea81acce7891f9reed@google.com } 458f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org if (this->isTranslate()) { 45999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (inverse) { 46099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com inverse->setTranslate(-fMat[3][0], -fMat[3][1], -fMat[3][2]); 46199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 46299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return true; 46399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 464f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org if (this->isScaleTranslate()) { 46599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (0 == fMat[0][0] * fMat[1][1] * fMat[2][2]) { 46699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return false; 46799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 46899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 469772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com if (inverse) { 470772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com double invXScale = 1 / fMat[0][0]; 471772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com double invYScale = 1 / fMat[1][1]; 472772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com double invZScale = 1 / fMat[2][2]; 473772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com 474c33d6218f06520f577c16c4d1914d031a29396efcommit-bot@chromium.org inverse->fMat[0][0] = invXScale; 475772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com inverse->fMat[0][1] = 0; 476772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com inverse->fMat[0][2] = 0; 477772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com inverse->fMat[0][3] = 0; 478772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com 479772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com inverse->fMat[1][0] = 0; 480772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com inverse->fMat[1][1] = invYScale; 481772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com inverse->fMat[1][2] = 0; 482772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com inverse->fMat[1][3] = 0; 483772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com 484772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com inverse->fMat[2][0] = 0; 485c33d6218f06520f577c16c4d1914d031a29396efcommit-bot@chromium.org inverse->fMat[2][1] = 0; 486772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com inverse->fMat[2][2] = invZScale; 487772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com inverse->fMat[2][3] = 0; 488772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com 489c33d6218f06520f577c16c4d1914d031a29396efcommit-bot@chromium.org inverse->fMat[3][0] = -fMat[3][0] * invXScale; 490c33d6218f06520f577c16c4d1914d031a29396efcommit-bot@chromium.org inverse->fMat[3][1] = -fMat[3][1] * invYScale; 491c33d6218f06520f577c16c4d1914d031a29396efcommit-bot@chromium.org inverse->fMat[3][2] = -fMat[3][2] * invZScale; 492c33d6218f06520f577c16c4d1914d031a29396efcommit-bot@chromium.org inverse->fMat[3][3] = 1; 493c33d6218f06520f577c16c4d1914d031a29396efcommit-bot@chromium.org 494c33d6218f06520f577c16c4d1914d031a29396efcommit-bot@chromium.org inverse->setTypeMask(this->getType()); 49599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 4965a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org 49799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return true; 49899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 49999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 5009973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a00 = fMat[0][0]; 5019973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a01 = fMat[0][1]; 5029973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a02 = fMat[0][2]; 5039973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a03 = fMat[0][3]; 5049973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a10 = fMat[1][0]; 5059973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a11 = fMat[1][1]; 5069973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a12 = fMat[1][2]; 5079973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a13 = fMat[1][3]; 5089973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a20 = fMat[2][0]; 5099973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a21 = fMat[2][1]; 5109973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a22 = fMat[2][2]; 5119973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a23 = fMat[2][3]; 5129973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a30 = fMat[3][0]; 5139973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a31 = fMat[3][1]; 5149973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a32 = fMat[3][2]; 5159973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a33 = fMat[3][3]; 5169973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com 517b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org if (!(this->getType() & kPerspective_Mask)) { 518b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // If we know the matrix has no perspective, then the perspective 519b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // component is (0, 0, 0, 1). We can use this information to save a lot 520b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // of arithmetic that would otherwise be spent to compute the inverse 521b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // of a general matrix. 522b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 523b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org SkASSERT(a03 == 0); 524b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org SkASSERT(a13 == 0); 525b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org SkASSERT(a23 == 0); 526b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org SkASSERT(a33 == 1); 527b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 528b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b00 = a00 * a11 - a01 * a10; 529b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b01 = a00 * a12 - a02 * a10; 530b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b03 = a01 * a12 - a02 * a11; 531b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b06 = a20 * a31 - a21 * a30; 532b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b07 = a20 * a32 - a22 * a30; 533b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b08 = a20; 534b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b09 = a21 * a32 - a22 * a31; 535b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b10 = a21; 536b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b11 = a22; 537b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 538b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // Calculate the determinant 539b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double det = b00 * b11 - b01 * b10 + b03 * b08; 540b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 541b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double invdet = 1.0 / det; 542b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // If det is zero, we want to return false. However, we also want to return false 543b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // if 1/det overflows to infinity (i.e. det is denormalized). Both of these are 544b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // handled by checking that 1/det is finite. 545b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org if (!sk_float_isfinite(invdet)) { 546b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org return false; 547b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org } 548b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org if (NULL == inverse) { 549b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org return true; 550b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org } 551b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 552b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b00 *= invdet; 553b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b01 *= invdet; 554b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b03 *= invdet; 555b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b06 *= invdet; 556b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b07 *= invdet; 557b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b08 *= invdet; 558b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b09 *= invdet; 559b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b10 *= invdet; 560b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b11 *= invdet; 561b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 562b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[0][0] = SkDoubleToMScalar(a11 * b11 - a12 * b10); 563b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[0][1] = SkDoubleToMScalar(a02 * b10 - a01 * b11); 564b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[0][2] = SkDoubleToMScalar(b03); 565b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[0][3] = 0; 566b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[1][0] = SkDoubleToMScalar(a12 * b08 - a10 * b11); 567b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[1][1] = SkDoubleToMScalar(a00 * b11 - a02 * b08); 568b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[1][2] = SkDoubleToMScalar(-b01); 569b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[1][3] = 0; 570b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[2][0] = SkDoubleToMScalar(a10 * b10 - a11 * b08); 571b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[2][1] = SkDoubleToMScalar(a01 * b08 - a00 * b10); 572b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[2][2] = SkDoubleToMScalar(b00); 573b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[2][3] = 0; 574b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[3][0] = SkDoubleToMScalar(a11 * b07 - a10 * b09 - a12 * b06); 575b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[3][1] = SkDoubleToMScalar(a00 * b09 - a01 * b07 + a02 * b06); 576b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[3][2] = SkDoubleToMScalar(a31 * b01 - a30 * b03 - a32 * b00); 577b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[3][3] = 1; 578b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 579b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->setTypeMask(this->getType()); 580b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org return true; 581b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org } 582b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 5839973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b00 = a00 * a11 - a01 * a10; 5849973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b01 = a00 * a12 - a02 * a10; 5859973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b02 = a00 * a13 - a03 * a10; 5869973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b03 = a01 * a12 - a02 * a11; 5879973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b04 = a01 * a13 - a03 * a11; 5889973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b05 = a02 * a13 - a03 * a12; 5899973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b06 = a20 * a31 - a21 * a30; 5909973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b07 = a20 * a32 - a22 * a30; 5919973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b08 = a20 * a33 - a23 * a30; 5929973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b09 = a21 * a32 - a22 * a31; 5939973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b10 = a21 * a33 - a23 * a31; 5949973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b11 = a22 * a33 - a23 * a32; 5959973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com 5969973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com // Calculate the determinant 5979973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double det = b00 * b11 - b01 * b10 + b02 * b09 + b03 * b08 - b04 * b07 + b05 * b06; 5989973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com 599f02f07835e417a5baff27dc8ef0b0e773ab7be00commit-bot@chromium.org double invdet = 1.0 / det; 600f02f07835e417a5baff27dc8ef0b0e773ab7be00commit-bot@chromium.org // If det is zero, we want to return false. However, we also want to return false 601f02f07835e417a5baff27dc8ef0b0e773ab7be00commit-bot@chromium.org // if 1/det overflows to infinity (i.e. det is denormalized). Both of these are 602f02f07835e417a5baff27dc8ef0b0e773ab7be00commit-bot@chromium.org // handled by checking that 1/det is finite. 603f02f07835e417a5baff27dc8ef0b0e773ab7be00commit-bot@chromium.org if (!sk_float_isfinite(invdet)) { 6048260a895869beaa4cab9f8b915e457728f41e561reed@google.com return false; 6058260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 6068260a895869beaa4cab9f8b915e457728f41e561reed@google.com if (NULL == inverse) { 6078260a895869beaa4cab9f8b915e457728f41e561reed@google.com return true; 6088260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 6099973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com 6109973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b00 *= invdet; 6119973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b01 *= invdet; 6129973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b02 *= invdet; 6139973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b03 *= invdet; 6149973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b04 *= invdet; 6159973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b05 *= invdet; 6169973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b06 *= invdet; 6179973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b07 *= invdet; 6189973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b08 *= invdet; 6199973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b09 *= invdet; 6209973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b10 *= invdet; 6219973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b11 *= invdet; 6229973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com 6239973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[0][0] = SkDoubleToMScalar(a11 * b11 - a12 * b10 + a13 * b09); 6249973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[0][1] = SkDoubleToMScalar(a02 * b10 - a01 * b11 - a03 * b09); 6259973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[0][2] = SkDoubleToMScalar(a31 * b05 - a32 * b04 + a33 * b03); 6269973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[0][3] = SkDoubleToMScalar(a22 * b04 - a21 * b05 - a23 * b03); 6279973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[1][0] = SkDoubleToMScalar(a12 * b08 - a10 * b11 - a13 * b07); 6289973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[1][1] = SkDoubleToMScalar(a00 * b11 - a02 * b08 + a03 * b07); 6299973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[1][2] = SkDoubleToMScalar(a32 * b02 - a30 * b05 - a33 * b01); 6309973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[1][3] = SkDoubleToMScalar(a20 * b05 - a22 * b02 + a23 * b01); 6319973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[2][0] = SkDoubleToMScalar(a10 * b10 - a11 * b08 + a13 * b06); 6329973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[2][1] = SkDoubleToMScalar(a01 * b08 - a00 * b10 - a03 * b06); 6339973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[2][2] = SkDoubleToMScalar(a30 * b04 - a31 * b02 + a33 * b00); 6349973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[2][3] = SkDoubleToMScalar(a21 * b02 - a20 * b04 - a23 * b00); 6359973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[3][0] = SkDoubleToMScalar(a11 * b07 - a10 * b09 - a12 * b06); 6369973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[3][1] = SkDoubleToMScalar(a00 * b09 - a01 * b07 + a02 * b06); 6379973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[3][2] = SkDoubleToMScalar(a31 * b01 - a30 * b03 - a32 * b00); 6389973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[3][3] = SkDoubleToMScalar(a20 * b03 - a21 * b01 + a22 * b00); 6399973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->dirtyTypeMask(); 6408260a895869beaa4cab9f8b915e457728f41e561reed@google.com 6418260a895869beaa4cab9f8b915e457728f41e561reed@google.com return true; 6428260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 6438260a895869beaa4cab9f8b915e457728f41e561reed@google.com 6448260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 6458260a895869beaa4cab9f8b915e457728f41e561reed@google.com 6469b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.orgvoid SkMatrix44::transpose() { 6479b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org SkTSwap(fMat[0][1], fMat[1][0]); 6489b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org SkTSwap(fMat[0][2], fMat[2][0]); 6499b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org SkTSwap(fMat[0][3], fMat[3][0]); 6509b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org SkTSwap(fMat[1][2], fMat[2][1]); 6519b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org SkTSwap(fMat[1][3], fMat[3][1]); 6529b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org SkTSwap(fMat[2][3], fMat[3][2]); 6537d68335eb427547606497eb4edea81acce7891f9reed@google.com 6547d68335eb427547606497eb4edea81acce7891f9reed@google.com if (!this->isTriviallyIdentity()) { 6557d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 6567d68335eb427547606497eb4edea81acce7891f9reed@google.com } 6579b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org} 6589b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org 6599b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org/////////////////////////////////////////////////////////////////////////////// 6609b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org 6611ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.comvoid SkMatrix44::mapScalars(const SkScalar src[4], SkScalar dst[4]) const { 6627d68335eb427547606497eb4edea81acce7891f9reed@google.com SkScalar storage[4]; 6637d68335eb427547606497eb4edea81acce7891f9reed@google.com SkScalar* result = (src == dst) ? storage : dst; 6647d68335eb427547606497eb4edea81acce7891f9reed@google.com 6658260a895869beaa4cab9f8b915e457728f41e561reed@google.com for (int i = 0; i < 4; i++) { 6668260a895869beaa4cab9f8b915e457728f41e561reed@google.com SkMScalar value = 0; 6678260a895869beaa4cab9f8b915e457728f41e561reed@google.com for (int j = 0; j < 4; j++) { 6688260a895869beaa4cab9f8b915e457728f41e561reed@google.com value += fMat[j][i] * src[j]; 6698260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 67072e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com result[i] = SkMScalarToScalar(value); 6718260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 6720264fb4543b0d8cebe00f1ee32433784f4ceb074skia.committer@gmail.com 6737d68335eb427547606497eb4edea81acce7891f9reed@google.com if (storage == result) { 6747d68335eb427547606497eb4edea81acce7891f9reed@google.com memcpy(dst, storage, sizeof(storage)); 6757d68335eb427547606497eb4edea81acce7891f9reed@google.com } 6768260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 6778260a895869beaa4cab9f8b915e457728f41e561reed@google.com 6781ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com#ifdef SK_MSCALAR_IS_DOUBLE 6797d68335eb427547606497eb4edea81acce7891f9reed@google.com 6801ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.comvoid SkMatrix44::mapMScalars(const SkMScalar src[4], SkMScalar dst[4]) const { 6817d68335eb427547606497eb4edea81acce7891f9reed@google.com SkMScalar storage[4]; 6827d68335eb427547606497eb4edea81acce7891f9reed@google.com SkMScalar* result = (src == dst) ? storage : dst; 6830264fb4543b0d8cebe00f1ee32433784f4ceb074skia.committer@gmail.com 6841ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com for (int i = 0; i < 4; i++) { 6851ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com SkMScalar value = 0; 6861ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com for (int j = 0; j < 4; j++) { 6871ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com value += fMat[j][i] * src[j]; 6881ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com } 6897d68335eb427547606497eb4edea81acce7891f9reed@google.com result[i] = value; 6907d68335eb427547606497eb4edea81acce7891f9reed@google.com } 6910264fb4543b0d8cebe00f1ee32433784f4ceb074skia.committer@gmail.com 6927d68335eb427547606497eb4edea81acce7891f9reed@google.com if (storage == result) { 6937d68335eb427547606497eb4edea81acce7891f9reed@google.com memcpy(dst, storage, sizeof(storage)); 6941ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com } 6951ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com} 6967d68335eb427547606497eb4edea81acce7891f9reed@google.com 6971ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com#endif 6981ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com 69999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comtypedef void (*Map2Procf)(const SkMScalar mat[][4], const float src2[], int count, float dst4[]); 70099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comtypedef void (*Map2Procd)(const SkMScalar mat[][4], const double src2[], int count, double dst4[]); 70199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 70299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_if(const SkMScalar mat[][4], const float* SK_RESTRICT src2, 70399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, float* SK_RESTRICT dst4) { 70499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int i = 0; i < count; ++i) { 70599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = src2[0]; 70699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = src2[1]; 70799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = 0; 70899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 70999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 71099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 71199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 71299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 71399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 71499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_id(const SkMScalar mat[][4], const double* SK_RESTRICT src2, 71599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, double* SK_RESTRICT dst4) { 71699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int i = 0; i < count; ++i) { 71799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = src2[0]; 71899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = src2[1]; 71999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = 0; 72099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 72199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 72299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 72399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 72499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 72599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 72699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_tf(const SkMScalar mat[][4], const float* SK_RESTRICT src2, 72799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, float* SK_RESTRICT dst4) { 72899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com const float mat30 = SkMScalarToFloat(mat[3][0]); 72999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com const float mat31 = SkMScalarToFloat(mat[3][1]); 73099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com const float mat32 = SkMScalarToFloat(mat[3][2]); 73199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 73299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = src2[0] + mat30; 73399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = src2[1] + mat31; 73499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = mat32; 73599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 73699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 73799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 73899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 73999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 74099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 74199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_td(const SkMScalar mat[][4], const double* SK_RESTRICT src2, 74299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, double* SK_RESTRICT dst4) { 74399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 74499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = src2[0] + mat[3][0]; 74599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = src2[1] + mat[3][1]; 74699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = mat[3][2]; 74799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 74899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 74999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 75099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 75199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 75299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 75399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_sf(const SkMScalar mat[][4], const float* SK_RESTRICT src2, 75499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, float* SK_RESTRICT dst4) { 75599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com const float mat32 = SkMScalarToFloat(mat[3][2]); 75699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 75799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = SkMScalarToFloat(mat[0][0] * src2[0] + mat[3][0]); 75899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = SkMScalarToFloat(mat[1][1] * src2[1] + mat[3][1]); 75999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = mat32; 76099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 76199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 76299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 76399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 76499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 76599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 76699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_sd(const SkMScalar mat[][4], const double* SK_RESTRICT src2, 76799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, double* SK_RESTRICT dst4) { 76899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 76999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = mat[0][0] * src2[0] + mat[3][0]; 77099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = mat[1][1] * src2[1] + mat[3][1]; 77199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = mat[3][2]; 77299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 77399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 77499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 77599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 77699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 77799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 77899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_af(const SkMScalar mat[][4], const float* SK_RESTRICT src2, 77999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, float* SK_RESTRICT dst4) { 780658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org SkMScalar r; 78199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 782658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org SkMScalar sx = SkFloatToMScalar(src2[0]); 783658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org SkMScalar sy = SkFloatToMScalar(src2[1]); 78499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com r = mat[0][0] * sx + mat[1][0] * sy + mat[3][0]; 78599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = SkMScalarToFloat(r); 78699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com r = mat[0][1] * sx + mat[1][1] * sy + mat[3][1]; 78799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = SkMScalarToFloat(r); 78899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com r = mat[0][2] * sx + mat[1][2] * sy + mat[3][2]; 78999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = SkMScalarToFloat(r); 79099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 79199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 79299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 79399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 79499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 79599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 79699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_ad(const SkMScalar mat[][4], const double* SK_RESTRICT src2, 79799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, double* SK_RESTRICT dst4) { 79899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 79999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com double sx = src2[0]; 80099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com double sy = src2[1]; 80199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = mat[0][0] * sx + mat[1][0] * sy + mat[3][0]; 80299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = mat[0][1] * sx + mat[1][1] * sy + mat[3][1]; 80399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = mat[0][2] * sx + mat[1][2] * sy + mat[3][2]; 80499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 80599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 80699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 80799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 80899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 80999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 81099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_pf(const SkMScalar mat[][4], const float* SK_RESTRICT src2, 81199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, float* SK_RESTRICT dst4) { 812658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org SkMScalar r; 81399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 814658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org SkMScalar sx = SkFloatToMScalar(src2[0]); 815658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org SkMScalar sy = SkFloatToMScalar(src2[1]); 81699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int i = 0; i < 4; i++) { 817658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org r = mat[0][i] * sx + mat[1][i] * sy + mat[3][i]; 818658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org dst4[i] = SkMScalarToFloat(r); 81999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 82099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 82199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 82299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 82399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 82499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 82599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_pd(const SkMScalar mat[][4], const double* SK_RESTRICT src2, 82699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, double* SK_RESTRICT dst4) { 82799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 82899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com double sx = src2[0]; 82999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com double sy = src2[1]; 83099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int i = 0; i < 4; i++) { 83199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[i] = mat[0][i] * sx + mat[1][i] * sy + mat[3][i]; 83299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 83399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 83499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 83599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 83699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 83799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 83899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comvoid SkMatrix44::map2(const float src2[], int count, float dst4[]) const { 83999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com static const Map2Procf gProc[] = { 84099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com map2_if, map2_tf, map2_sf, map2_sf, map2_af, map2_af, map2_af, map2_af 84199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com }; 84299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 84399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com TypeMask mask = this->getType(); 84499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com Map2Procf proc = (mask & kPerspective_Mask) ? map2_pf : gProc[mask]; 84599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com proc(fMat, src2, count, dst4); 84699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 84799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 84899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comvoid SkMatrix44::map2(const double src2[], int count, double dst4[]) const { 84999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com static const Map2Procd gProc[] = { 85099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com map2_id, map2_td, map2_sd, map2_sd, map2_ad, map2_ad, map2_ad, map2_ad 85199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com }; 8520264fb4543b0d8cebe00f1ee32433784f4ceb074skia.committer@gmail.com 85399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com TypeMask mask = this->getType(); 85499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com Map2Procd proc = (mask & kPerspective_Mask) ? map2_pd : gProc[mask]; 85599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com proc(fMat, src2, count, dst4); 85699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 85799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 8588260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 8598260a895869beaa4cab9f8b915e457728f41e561reed@google.com 8608260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::dump() const { 8619ac4a89d35df3d581886a84df421161418707fd6tomhudson@google.com static const char* format = 8629ac4a89d35df3d581886a84df421161418707fd6tomhudson@google.com "[%g %g %g %g][%g %g %g %g][%g %g %g %g][%g %g %g %g]\n"; 8638260a895869beaa4cab9f8b915e457728f41e561reed@google.com#if 0 8649ac4a89d35df3d581886a84df421161418707fd6tomhudson@google.com SkDebugf(format, 8658260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[0][0], fMat[1][0], fMat[2][0], fMat[3][0], 8668260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[0][1], fMat[1][1], fMat[2][1], fMat[3][1], 8678260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[0][2], fMat[1][2], fMat[2][2], fMat[3][2], 8688260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[0][3], fMat[1][3], fMat[2][3], fMat[3][3]); 8699ac4a89d35df3d581886a84df421161418707fd6tomhudson@google.com#else 8709ac4a89d35df3d581886a84df421161418707fd6tomhudson@google.com SkDebugf(format, 8719ac4a89d35df3d581886a84df421161418707fd6tomhudson@google.com fMat[0][0], fMat[0][1], fMat[0][2], fMat[0][3], 8729ac4a89d35df3d581886a84df421161418707fd6tomhudson@google.com fMat[1][0], fMat[1][1], fMat[1][2], fMat[1][3], 8739ac4a89d35df3d581886a84df421161418707fd6tomhudson@google.com fMat[2][0], fMat[2][1], fMat[2][2], fMat[2][3], 8749ac4a89d35df3d581886a84df421161418707fd6tomhudson@google.com fMat[3][0], fMat[3][1], fMat[3][2], fMat[3][3]); 8758260a895869beaa4cab9f8b915e457728f41e561reed@google.com#endif 8768260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 8778260a895869beaa4cab9f8b915e457728f41e561reed@google.com 8788260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 8798260a895869beaa4cab9f8b915e457728f41e561reed@google.com 8808260a895869beaa4cab9f8b915e457728f41e561reed@google.comstatic void initFromMatrix(SkMScalar dst[4][4], const SkMatrix& src) { 88172e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[0][0] = SkScalarToMScalar(src[SkMatrix::kMScaleX]); 88272e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[1][0] = SkScalarToMScalar(src[SkMatrix::kMSkewX]); 8835a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[2][0] = 0; 88472e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[3][0] = SkScalarToMScalar(src[SkMatrix::kMTransX]); 88572e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[0][1] = SkScalarToMScalar(src[SkMatrix::kMSkewY]); 88672e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[1][1] = SkScalarToMScalar(src[SkMatrix::kMScaleY]); 8875a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[2][1] = 0; 88872e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[3][1] = SkScalarToMScalar(src[SkMatrix::kMTransY]); 8895a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[0][2] = 0; 8905a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[1][2] = 0; 8915a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[2][2] = 1; 8925a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[3][2] = 0; 893722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org dst[0][3] = SkScalarToMScalar(src[SkMatrix::kMPersp0]); 894722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org dst[1][3] = SkScalarToMScalar(src[SkMatrix::kMPersp1]); 8955a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[2][3] = 0; 896722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org dst[3][3] = SkScalarToMScalar(src[SkMatrix::kMPersp2]); 8978260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 8988260a895869beaa4cab9f8b915e457728f41e561reed@google.com 8998260a895869beaa4cab9f8b915e457728f41e561reed@google.comSkMatrix44::SkMatrix44(const SkMatrix& src) { 9008260a895869beaa4cab9f8b915e457728f41e561reed@google.com initFromMatrix(fMat, src); 9018260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 9028260a895869beaa4cab9f8b915e457728f41e561reed@google.com 9038260a895869beaa4cab9f8b915e457728f41e561reed@google.comSkMatrix44& SkMatrix44::operator=(const SkMatrix& src) { 9048260a895869beaa4cab9f8b915e457728f41e561reed@google.com initFromMatrix(fMat, src); 9057d68335eb427547606497eb4edea81acce7891f9reed@google.com 9067d68335eb427547606497eb4edea81acce7891f9reed@google.com if (src.isIdentity()) { 9077d68335eb427547606497eb4edea81acce7891f9reed@google.com this->setTypeMask(kIdentity_Mask); 9087d68335eb427547606497eb4edea81acce7891f9reed@google.com } else { 9097d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 9107d68335eb427547606497eb4edea81acce7891f9reed@google.com } 9118260a895869beaa4cab9f8b915e457728f41e561reed@google.com return *this; 9128260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 9138260a895869beaa4cab9f8b915e457728f41e561reed@google.com 9148260a895869beaa4cab9f8b915e457728f41e561reed@google.comSkMatrix44::operator SkMatrix() const { 9158260a895869beaa4cab9f8b915e457728f41e561reed@google.com SkMatrix dst; 9168260a895869beaa4cab9f8b915e457728f41e561reed@google.com 91772e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[SkMatrix::kMScaleX] = SkMScalarToScalar(fMat[0][0]); 91872e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[SkMatrix::kMSkewX] = SkMScalarToScalar(fMat[1][0]); 91972e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[SkMatrix::kMTransX] = SkMScalarToScalar(fMat[3][0]); 9208260a895869beaa4cab9f8b915e457728f41e561reed@google.com 92172e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[SkMatrix::kMSkewY] = SkMScalarToScalar(fMat[0][1]); 92272e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[SkMatrix::kMScaleY] = SkMScalarToScalar(fMat[1][1]); 92372e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[SkMatrix::kMTransY] = SkMScalarToScalar(fMat[3][1]); 9248260a895869beaa4cab9f8b915e457728f41e561reed@google.com 925722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org dst[SkMatrix::kMPersp0] = SkMScalarToScalar(fMat[0][3]); 926722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org dst[SkMatrix::kMPersp1] = SkMScalarToScalar(fMat[1][3]); 927722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org dst[SkMatrix::kMPersp2] = SkMScalarToScalar(fMat[3][3]); 928722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org 9298260a895869beaa4cab9f8b915e457728f41e561reed@google.com return dst; 9308260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 931