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++) { 386bde4ba2ce6994a57f1b4e820ac83e9d27caf75decommit-bot@chromium.org double value = 0; 38799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int k = 0; k < 4; k++) { 388bde4ba2ce6994a57f1b4e820ac83e9d27caf75decommit-bot@chromium.org value += SkMScalarToDouble(a.fMat[k][i]) * b.fMat[j][k]; 38999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 390bde4ba2ce6994a57f1b4e820ac83e9d27caf75decommit-bot@chromium.org *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 451a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstrstatic bool is_matrix_finite(const SkMatrix44& matrix) { 452a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr SkMScalar accumulator = 0; 453a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr for (int row = 0; row < 4; ++row) { 454a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr for (int col = 0; col < 4; ++col) { 455a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr accumulator *= matrix.get(row, col); 456a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr } 457a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr } 458a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr return accumulator == 0; 459a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr} 460a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr 461a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstrbool SkMatrix44::invert(SkMatrix44* storage) const { 462f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org if (this->isIdentity()) { 463a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr if (storage) { 464a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr storage->setIdentity(); 4657d68335eb427547606497eb4edea81acce7891f9reed@google.com } 466178acd25b0053908ffcdf1b07a9f93d797408b13commit-bot@chromium.org return true; 4677d68335eb427547606497eb4edea81acce7891f9reed@google.com } 468178acd25b0053908ffcdf1b07a9f93d797408b13commit-bot@chromium.org 469f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org if (this->isTranslate()) { 470a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr if (storage) { 471a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr storage->setTranslate(-fMat[3][0], -fMat[3][1], -fMat[3][2]); 47299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 47399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return true; 47499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 475178acd25b0053908ffcdf1b07a9f93d797408b13commit-bot@chromium.org 476a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr SkMatrix44 tmp(kUninitialized_Constructor); 477a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr // Use storage if it's available and distinct from this matrix. 478a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr SkMatrix44* inverse = (storage && storage != this) ? storage : &tmp; 479f8b1ebc35b6872c2805a22481b7c23b85486fb46mike@reedtribe.org if (this->isScaleTranslate()) { 48099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com if (0 == fMat[0][0] * fMat[1][1] * fMat[2][2]) { 48199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return false; 48299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 48399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 484a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr double invXScale = 1 / fMat[0][0]; 485a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr double invYScale = 1 / fMat[1][1]; 486a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr double invZScale = 1 / fMat[2][2]; 487772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com 488a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[0][0] = SkDoubleToMScalar(invXScale); 489a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[0][1] = 0; 490a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[0][2] = 0; 491a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[0][3] = 0; 492772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com 493a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[1][0] = 0; 494a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[1][1] = SkDoubleToMScalar(invYScale); 495a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[1][2] = 0; 496a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[1][3] = 0; 497772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com 498a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[2][0] = 0; 499a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[2][1] = 0; 500a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[2][2] = SkDoubleToMScalar(invZScale); 501a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[2][3] = 0; 502772c4e6d09f5e0971a584d2035ee789483d6f47askia.committer@gmail.com 503a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[3][0] = SkDoubleToMScalar(-fMat[3][0] * invXScale); 504a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[3][1] = SkDoubleToMScalar(-fMat[3][1] * invYScale); 505a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[3][2] = SkDoubleToMScalar(-fMat[3][2] * invZScale); 506a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->fMat[3][3] = 1; 507c33d6218f06520f577c16c4d1914d031a29396efcommit-bot@chromium.org 508a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->setTypeMask(this->getType()); 5095a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org 510a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr if (!is_matrix_finite(*inverse)) { 511a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr return false; 512a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr } 513a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr if (storage && inverse != storage) { 514a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr *storage = *inverse; 515a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr } 51699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com return true; 51799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 51899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 5199973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a00 = fMat[0][0]; 5209973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a01 = fMat[0][1]; 5219973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a02 = fMat[0][2]; 5229973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a03 = fMat[0][3]; 5239973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a10 = fMat[1][0]; 5249973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a11 = fMat[1][1]; 5259973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a12 = fMat[1][2]; 5269973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a13 = fMat[1][3]; 5279973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a20 = fMat[2][0]; 5289973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a21 = fMat[2][1]; 5299973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a22 = fMat[2][2]; 5309973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a23 = fMat[2][3]; 5319973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a30 = fMat[3][0]; 5329973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a31 = fMat[3][1]; 5339973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a32 = fMat[3][2]; 5349973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double a33 = fMat[3][3]; 5359973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com 536b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org if (!(this->getType() & kPerspective_Mask)) { 537b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // If we know the matrix has no perspective, then the perspective 538b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // component is (0, 0, 0, 1). We can use this information to save a lot 539b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // of arithmetic that would otherwise be spent to compute the inverse 540b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // of a general matrix. 541b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 542b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org SkASSERT(a03 == 0); 543b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org SkASSERT(a13 == 0); 544b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org SkASSERT(a23 == 0); 545b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org SkASSERT(a33 == 1); 546b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 547b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b00 = a00 * a11 - a01 * a10; 548b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b01 = a00 * a12 - a02 * a10; 549b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b03 = a01 * a12 - a02 * a11; 550b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b06 = a20 * a31 - a21 * a30; 551b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b07 = a20 * a32 - a22 * a30; 552b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b08 = a20; 553b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b09 = a21 * a32 - a22 * a31; 554b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b10 = a21; 555b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double b11 = a22; 556b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 557b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // Calculate the determinant 558b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double det = b00 * b11 - b01 * b10 + b03 * b08; 559b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 560b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org double invdet = 1.0 / det; 561b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // If det is zero, we want to return false. However, we also want to return false 562b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // if 1/det overflows to infinity (i.e. det is denormalized). Both of these are 563b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org // handled by checking that 1/det is finite. 564b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org if (!sk_float_isfinite(invdet)) { 565b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org return false; 566b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org } 567b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 568b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b00 *= invdet; 569b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b01 *= invdet; 570b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b03 *= invdet; 571b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b06 *= invdet; 572b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b07 *= invdet; 573b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b08 *= invdet; 574b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b09 *= invdet; 575b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b10 *= invdet; 576b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org b11 *= invdet; 577b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 578b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[0][0] = SkDoubleToMScalar(a11 * b11 - a12 * b10); 579b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[0][1] = SkDoubleToMScalar(a02 * b10 - a01 * b11); 580b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[0][2] = SkDoubleToMScalar(b03); 581b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[0][3] = 0; 582b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[1][0] = SkDoubleToMScalar(a12 * b08 - a10 * b11); 583b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[1][1] = SkDoubleToMScalar(a00 * b11 - a02 * b08); 584b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[1][2] = SkDoubleToMScalar(-b01); 585b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[1][3] = 0; 586b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[2][0] = SkDoubleToMScalar(a10 * b10 - a11 * b08); 587b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[2][1] = SkDoubleToMScalar(a01 * b08 - a00 * b10); 588b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[2][2] = SkDoubleToMScalar(b00); 589b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[2][3] = 0; 590b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[3][0] = SkDoubleToMScalar(a11 * b07 - a10 * b09 - a12 * b06); 591b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[3][1] = SkDoubleToMScalar(a00 * b09 - a01 * b07 + a02 * b06); 592b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[3][2] = SkDoubleToMScalar(a31 * b01 - a30 * b03 - a32 * b00); 593b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->fMat[3][3] = 1; 594b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 595b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org inverse->setTypeMask(this->getType()); 596a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr if (!is_matrix_finite(*inverse)) { 597a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr return false; 598a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr } 599a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr if (storage && inverse != storage) { 600a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr *storage = *inverse; 601a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr } 602b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org return true; 603b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org } 604b6823c19b69d76059f1e16de4d48c4e3f013e3bcshawnsingh@chromium.org 6059973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b00 = a00 * a11 - a01 * a10; 6069973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b01 = a00 * a12 - a02 * a10; 6079973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b02 = a00 * a13 - a03 * a10; 6089973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b03 = a01 * a12 - a02 * a11; 6099973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b04 = a01 * a13 - a03 * a11; 6109973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b05 = a02 * a13 - a03 * a12; 6119973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b06 = a20 * a31 - a21 * a30; 6129973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b07 = a20 * a32 - a22 * a30; 6139973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b08 = a20 * a33 - a23 * a30; 6149973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b09 = a21 * a32 - a22 * a31; 6159973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b10 = a21 * a33 - a23 * a31; 6169973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double b11 = a22 * a33 - a23 * a32; 6179973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com 6189973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com // Calculate the determinant 6199973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com double det = b00 * b11 - b01 * b10 + b02 * b09 + b03 * b08 - b04 * b07 + b05 * b06; 6209973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com 621f02f07835e417a5baff27dc8ef0b0e773ab7be00commit-bot@chromium.org double invdet = 1.0 / det; 622f02f07835e417a5baff27dc8ef0b0e773ab7be00commit-bot@chromium.org // If det is zero, we want to return false. However, we also want to return false 623f02f07835e417a5baff27dc8ef0b0e773ab7be00commit-bot@chromium.org // if 1/det overflows to infinity (i.e. det is denormalized). Both of these are 624f02f07835e417a5baff27dc8ef0b0e773ab7be00commit-bot@chromium.org // handled by checking that 1/det is finite. 625f02f07835e417a5baff27dc8ef0b0e773ab7be00commit-bot@chromium.org if (!sk_float_isfinite(invdet)) { 6268260a895869beaa4cab9f8b915e457728f41e561reed@google.com return false; 6278260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 6289973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com 6299973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b00 *= invdet; 6309973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b01 *= invdet; 6319973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b02 *= invdet; 6329973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b03 *= invdet; 6339973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b04 *= invdet; 6349973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b05 *= invdet; 6359973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b06 *= invdet; 6369973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b07 *= invdet; 6379973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b08 *= invdet; 6389973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b09 *= invdet; 6399973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b10 *= invdet; 6409973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com b11 *= invdet; 6419973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com 6429973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[0][0] = SkDoubleToMScalar(a11 * b11 - a12 * b10 + a13 * b09); 6439973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[0][1] = SkDoubleToMScalar(a02 * b10 - a01 * b11 - a03 * b09); 6449973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[0][2] = SkDoubleToMScalar(a31 * b05 - a32 * b04 + a33 * b03); 6459973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[0][3] = SkDoubleToMScalar(a22 * b04 - a21 * b05 - a23 * b03); 6469973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[1][0] = SkDoubleToMScalar(a12 * b08 - a10 * b11 - a13 * b07); 6479973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[1][1] = SkDoubleToMScalar(a00 * b11 - a02 * b08 + a03 * b07); 6489973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[1][2] = SkDoubleToMScalar(a32 * b02 - a30 * b05 - a33 * b01); 6499973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[1][3] = SkDoubleToMScalar(a20 * b05 - a22 * b02 + a23 * b01); 6509973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[2][0] = SkDoubleToMScalar(a10 * b10 - a11 * b08 + a13 * b06); 6519973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[2][1] = SkDoubleToMScalar(a01 * b08 - a00 * b10 - a03 * b06); 6529973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[2][2] = SkDoubleToMScalar(a30 * b04 - a31 * b02 + a33 * b00); 6539973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[2][3] = SkDoubleToMScalar(a21 * b02 - a20 * b04 - a23 * b00); 6549973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[3][0] = SkDoubleToMScalar(a11 * b07 - a10 * b09 - a12 * b06); 6559973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[3][1] = SkDoubleToMScalar(a00 * b09 - a01 * b07 + a02 * b06); 6569973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[3][2] = SkDoubleToMScalar(a31 * b01 - a30 * b03 - a32 * b00); 6579973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->fMat[3][3] = SkDoubleToMScalar(a20 * b03 - a21 * b01 + a22 * b00); 6589973a8a396957afb66c9ba5ee40f829770619ce3tomhudson@google.com inverse->dirtyTypeMask(); 6598260a895869beaa4cab9f8b915e457728f41e561reed@google.com 660a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr inverse->setTypeMask(this->getType()); 661a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr if (!is_matrix_finite(*inverse)) { 662a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr return false; 663a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr } 664a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr if (storage && inverse != storage) { 665a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr *storage = *inverse; 666a8d4559fd6fb4f8ed213e201bb738dbc7b3c3512vmpstr } 6678260a895869beaa4cab9f8b915e457728f41e561reed@google.com return true; 6688260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 6698260a895869beaa4cab9f8b915e457728f41e561reed@google.com 6708260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 6718260a895869beaa4cab9f8b915e457728f41e561reed@google.com 6729b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.orgvoid SkMatrix44::transpose() { 6739b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org SkTSwap(fMat[0][1], fMat[1][0]); 6749b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org SkTSwap(fMat[0][2], fMat[2][0]); 6759b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org SkTSwap(fMat[0][3], fMat[3][0]); 6769b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org SkTSwap(fMat[1][2], fMat[2][1]); 6779b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org SkTSwap(fMat[1][3], fMat[3][1]); 6789b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org SkTSwap(fMat[2][3], fMat[3][2]); 6797d68335eb427547606497eb4edea81acce7891f9reed@google.com 6807d68335eb427547606497eb4edea81acce7891f9reed@google.com if (!this->isTriviallyIdentity()) { 6817d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 6827d68335eb427547606497eb4edea81acce7891f9reed@google.com } 6839b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org} 6849b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org 6859b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org/////////////////////////////////////////////////////////////////////////////// 6869b21c25e742d6a8b69bee8b049e79877f93b5936vollick@chromium.org 6871ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.comvoid SkMatrix44::mapScalars(const SkScalar src[4], SkScalar dst[4]) const { 6887d68335eb427547606497eb4edea81acce7891f9reed@google.com SkScalar storage[4]; 6897d68335eb427547606497eb4edea81acce7891f9reed@google.com SkScalar* result = (src == dst) ? storage : dst; 6907d68335eb427547606497eb4edea81acce7891f9reed@google.com 6918260a895869beaa4cab9f8b915e457728f41e561reed@google.com for (int i = 0; i < 4; i++) { 6928260a895869beaa4cab9f8b915e457728f41e561reed@google.com SkMScalar value = 0; 6938260a895869beaa4cab9f8b915e457728f41e561reed@google.com for (int j = 0; j < 4; j++) { 6948260a895869beaa4cab9f8b915e457728f41e561reed@google.com value += fMat[j][i] * src[j]; 6958260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 69672e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com result[i] = SkMScalarToScalar(value); 6978260a895869beaa4cab9f8b915e457728f41e561reed@google.com } 6980264fb4543b0d8cebe00f1ee32433784f4ceb074skia.committer@gmail.com 6997d68335eb427547606497eb4edea81acce7891f9reed@google.com if (storage == result) { 7007d68335eb427547606497eb4edea81acce7891f9reed@google.com memcpy(dst, storage, sizeof(storage)); 7017d68335eb427547606497eb4edea81acce7891f9reed@google.com } 7028260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 7038260a895869beaa4cab9f8b915e457728f41e561reed@google.com 7041ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com#ifdef SK_MSCALAR_IS_DOUBLE 7057d68335eb427547606497eb4edea81acce7891f9reed@google.com 7061ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.comvoid SkMatrix44::mapMScalars(const SkMScalar src[4], SkMScalar dst[4]) const { 7077d68335eb427547606497eb4edea81acce7891f9reed@google.com SkMScalar storage[4]; 7087d68335eb427547606497eb4edea81acce7891f9reed@google.com SkMScalar* result = (src == dst) ? storage : dst; 7090264fb4543b0d8cebe00f1ee32433784f4ceb074skia.committer@gmail.com 7101ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com for (int i = 0; i < 4; i++) { 7111ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com SkMScalar value = 0; 7121ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com for (int j = 0; j < 4; j++) { 7131ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com value += fMat[j][i] * src[j]; 7141ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com } 7157d68335eb427547606497eb4edea81acce7891f9reed@google.com result[i] = value; 7167d68335eb427547606497eb4edea81acce7891f9reed@google.com } 7170264fb4543b0d8cebe00f1ee32433784f4ceb074skia.committer@gmail.com 7187d68335eb427547606497eb4edea81acce7891f9reed@google.com if (storage == result) { 7197d68335eb427547606497eb4edea81acce7891f9reed@google.com memcpy(dst, storage, sizeof(storage)); 7201ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com } 7211ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com} 7227d68335eb427547606497eb4edea81acce7891f9reed@google.com 7231ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com#endif 7241ea95be560b38a71e3f24749c4e5e3d3564e4c6creed@google.com 72599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comtypedef void (*Map2Procf)(const SkMScalar mat[][4], const float src2[], int count, float dst4[]); 72699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comtypedef void (*Map2Procd)(const SkMScalar mat[][4], const double src2[], int count, double dst4[]); 72799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 72899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_if(const SkMScalar mat[][4], const float* SK_RESTRICT src2, 72999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, float* SK_RESTRICT dst4) { 73099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int i = 0; i < count; ++i) { 73199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = src2[0]; 73299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = src2[1]; 73399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = 0; 73499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 73599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 73699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 73799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 73899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 73999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 74099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_id(const SkMScalar mat[][4], const double* SK_RESTRICT src2, 74199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, double* SK_RESTRICT dst4) { 74299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int i = 0; i < count; ++i) { 74399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = src2[0]; 74499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = src2[1]; 74599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = 0; 74699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 74799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 74899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 74999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 75099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 75199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 75299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_tf(const SkMScalar mat[][4], const float* SK_RESTRICT src2, 75399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, float* SK_RESTRICT dst4) { 75499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com const float mat30 = SkMScalarToFloat(mat[3][0]); 75599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com const float mat31 = SkMScalarToFloat(mat[3][1]); 75699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com const float mat32 = SkMScalarToFloat(mat[3][2]); 75799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 75899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = src2[0] + mat30; 75999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = src2[1] + mat31; 76099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = mat32; 76199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 76299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 76399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 76499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 76599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 76699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 76799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_td(const SkMScalar mat[][4], const double* SK_RESTRICT src2, 76899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, double* SK_RESTRICT dst4) { 76999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 77099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = src2[0] + mat[3][0]; 77199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = src2[1] + mat[3][1]; 77299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = mat[3][2]; 77399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 77499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 77599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 77699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 77799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 77899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 77999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_sf(const SkMScalar mat[][4], const float* SK_RESTRICT src2, 78099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, float* SK_RESTRICT dst4) { 78199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com const float mat32 = SkMScalarToFloat(mat[3][2]); 78299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 78399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = SkMScalarToFloat(mat[0][0] * src2[0] + mat[3][0]); 78499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = SkMScalarToFloat(mat[1][1] * src2[1] + mat[3][1]); 78599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = mat32; 78699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 78799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 78899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 78999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 79099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 79199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 79299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_sd(const SkMScalar mat[][4], const double* SK_RESTRICT src2, 79399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, double* SK_RESTRICT dst4) { 79499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 79599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = mat[0][0] * src2[0] + mat[3][0]; 79699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = mat[1][1] * src2[1] + mat[3][1]; 79799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = mat[3][2]; 79899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 79999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 80099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 80199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 80299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 80399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 80499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_af(const SkMScalar mat[][4], const float* SK_RESTRICT src2, 80599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, float* SK_RESTRICT dst4) { 806658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org SkMScalar r; 80799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 808658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org SkMScalar sx = SkFloatToMScalar(src2[0]); 809658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org SkMScalar sy = SkFloatToMScalar(src2[1]); 81099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com r = mat[0][0] * sx + mat[1][0] * sy + mat[3][0]; 81199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = SkMScalarToFloat(r); 81299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com r = mat[0][1] * sx + mat[1][1] * sy + mat[3][1]; 81399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = SkMScalarToFloat(r); 81499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com r = mat[0][2] * sx + mat[1][2] * sy + mat[3][2]; 81599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = SkMScalarToFloat(r); 81699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 81799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 81899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 81999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 82099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 82199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 82299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_ad(const SkMScalar mat[][4], const double* SK_RESTRICT src2, 82399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, double* SK_RESTRICT dst4) { 82499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 82599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com double sx = src2[0]; 82699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com double sy = src2[1]; 82799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[0] = mat[0][0] * sx + mat[1][0] * sy + mat[3][0]; 82899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[1] = mat[0][1] * sx + mat[1][1] * sy + mat[3][1]; 82999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[2] = mat[0][2] * sx + mat[1][2] * sy + mat[3][2]; 83099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[3] = 1; 83199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 83299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 83399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 83499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 83599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 83699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_pf(const SkMScalar mat[][4], const float* SK_RESTRICT src2, 83799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, float* SK_RESTRICT dst4) { 838658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org SkMScalar r; 83999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 840658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org SkMScalar sx = SkFloatToMScalar(src2[0]); 841658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org SkMScalar sy = SkFloatToMScalar(src2[1]); 84299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int i = 0; i < 4; i++) { 843658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org r = mat[0][i] * sx + mat[1][i] * sy + mat[3][i]; 844658e28b0810d01dc03f8c48b93f6659d41f25b09commit-bot@chromium.org dst4[i] = SkMScalarToFloat(r); 84599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 84699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 84799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 84899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 84999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 85099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 85199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comstatic void map2_pd(const SkMScalar mat[][4], const double* SK_RESTRICT src2, 85299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com int count, double* SK_RESTRICT dst4) { 85399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int n = 0; n < count; ++n) { 85499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com double sx = src2[0]; 85599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com double sy = src2[1]; 85699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com for (int i = 0; i < 4; i++) { 85799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4[i] = mat[0][i] * sx + mat[1][i] * sy + mat[3][i]; 85899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 85999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com src2 += 2; 86099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com dst4 += 4; 86199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com } 86299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 86399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 86499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comvoid SkMatrix44::map2(const float src2[], int count, float dst4[]) const { 86599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com static const Map2Procf gProc[] = { 86699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com map2_if, map2_tf, map2_sf, map2_sf, map2_af, map2_af, map2_af, map2_af 86799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com }; 86899b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 86999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com TypeMask mask = this->getType(); 87099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com Map2Procf proc = (mask & kPerspective_Mask) ? map2_pf : gProc[mask]; 87199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com proc(fMat, src2, count, dst4); 87299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 87399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 87499b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.comvoid SkMatrix44::map2(const double src2[], int count, double dst4[]) const { 87599b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com static const Map2Procd gProc[] = { 87699b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com map2_id, map2_td, map2_sd, map2_sd, map2_ad, map2_ad, map2_ad, map2_ad 87799b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com }; 8780264fb4543b0d8cebe00f1ee32433784f4ceb074skia.committer@gmail.com 87999b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com TypeMask mask = this->getType(); 88099b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com Map2Procd proc = (mask & kPerspective_Mask) ? map2_pd : gProc[mask]; 88199b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com proc(fMat, src2, count, dst4); 88299b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com} 88399b5c7f94ba5ef0c9cb464e34834cd5adea37a0ereed@google.com 884faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudsonbool SkMatrix44::preserves2dAxisAlignment (SkMScalar epsilon) const { 885faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson 886faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson // Can't check (mask & kPerspective_Mask) because Z isn't relevant here. 887faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson if (0 != perspX() || 0 != perspY()) return false; 888faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson 889faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson // A matrix with two non-zeroish values in any of the upper right 890faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson // rows or columns will skew. If only one value in each row or 891faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson // column is non-zeroish, we get a scale plus perhaps a 90-degree 892faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson // rotation. 893faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson int col0 = 0; 894faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson int col1 = 0; 895faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson int row0 = 0; 896faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson int row1 = 0; 897faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson 898faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson // Must test against epsilon, not 0, because we can get values 899faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson // around 6e-17 in the matrix that "should" be 0. 900faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson 901faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson if (SkMScalarAbs(fMat[0][0]) > epsilon) { 902faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson col0++; 903faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson row0++; 904faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson } 905faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson if (SkMScalarAbs(fMat[0][1]) > epsilon) { 906faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson col1++; 907faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson row0++; 908faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson } 909faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson if (SkMScalarAbs(fMat[1][0]) > epsilon) { 910faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson col0++; 911faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson row1++; 912faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson } 913faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson if (SkMScalarAbs(fMat[1][1]) > epsilon) { 914faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson col1++; 915faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson row1++; 916faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson } 917faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson if (col0 > 1 || col1 > 1 || row0 > 1 || row1 > 1) { 918faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson return false; 919faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson } 920faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson 921faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson return true; 922faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson} 923faccb8eb53f1bc745d3dd530d8df8b40e0dedc23tomhudson 9248260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 9258260a895869beaa4cab9f8b915e457728f41e561reed@google.com 9268260a895869beaa4cab9f8b915e457728f41e561reed@google.comvoid SkMatrix44::dump() const { 9279ac4a89d35df3d581886a84df421161418707fd6tomhudson@google.com static const char* format = 9289ac4a89d35df3d581886a84df421161418707fd6tomhudson@google.com "[%g %g %g %g][%g %g %g %g][%g %g %g %g][%g %g %g %g]\n"; 9298260a895869beaa4cab9f8b915e457728f41e561reed@google.com#if 0 9309ac4a89d35df3d581886a84df421161418707fd6tomhudson@google.com SkDebugf(format, 9318260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[0][0], fMat[1][0], fMat[2][0], fMat[3][0], 9328260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[0][1], fMat[1][1], fMat[2][1], fMat[3][1], 9338260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[0][2], fMat[1][2], fMat[2][2], fMat[3][2], 9348260a895869beaa4cab9f8b915e457728f41e561reed@google.com fMat[0][3], fMat[1][3], fMat[2][3], fMat[3][3]); 9359ac4a89d35df3d581886a84df421161418707fd6tomhudson@google.com#else 9369ac4a89d35df3d581886a84df421161418707fd6tomhudson@google.com SkDebugf(format, 9379ac4a89d35df3d581886a84df421161418707fd6tomhudson@google.com fMat[0][0], fMat[0][1], fMat[0][2], fMat[0][3], 9389ac4a89d35df3d581886a84df421161418707fd6tomhudson@google.com fMat[1][0], fMat[1][1], fMat[1][2], fMat[1][3], 9399ac4a89d35df3d581886a84df421161418707fd6tomhudson@google.com fMat[2][0], fMat[2][1], fMat[2][2], fMat[2][3], 9409ac4a89d35df3d581886a84df421161418707fd6tomhudson@google.com fMat[3][0], fMat[3][1], fMat[3][2], fMat[3][3]); 9418260a895869beaa4cab9f8b915e457728f41e561reed@google.com#endif 9428260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 9438260a895869beaa4cab9f8b915e457728f41e561reed@google.com 9448260a895869beaa4cab9f8b915e457728f41e561reed@google.com/////////////////////////////////////////////////////////////////////////////// 9458260a895869beaa4cab9f8b915e457728f41e561reed@google.com 9468260a895869beaa4cab9f8b915e457728f41e561reed@google.comstatic void initFromMatrix(SkMScalar dst[4][4], const SkMatrix& src) { 94772e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[0][0] = SkScalarToMScalar(src[SkMatrix::kMScaleX]); 94872e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[1][0] = SkScalarToMScalar(src[SkMatrix::kMSkewX]); 9495a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[2][0] = 0; 95072e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[3][0] = SkScalarToMScalar(src[SkMatrix::kMTransX]); 95172e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[0][1] = SkScalarToMScalar(src[SkMatrix::kMSkewY]); 95272e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[1][1] = SkScalarToMScalar(src[SkMatrix::kMScaleY]); 9535a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[2][1] = 0; 95472e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[3][1] = SkScalarToMScalar(src[SkMatrix::kMTransY]); 9555a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[0][2] = 0; 9565a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[1][2] = 0; 9575a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[2][2] = 1; 9585a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[3][2] = 0; 959722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org dst[0][3] = SkScalarToMScalar(src[SkMatrix::kMPersp0]); 960722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org dst[1][3] = SkScalarToMScalar(src[SkMatrix::kMPersp1]); 9615a6cd35b1961a1a3dea242c902300cafbd68fdc0shawnsingh@chromium.org dst[2][3] = 0; 962722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org dst[3][3] = SkScalarToMScalar(src[SkMatrix::kMPersp2]); 9638260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 9648260a895869beaa4cab9f8b915e457728f41e561reed@google.com 9658260a895869beaa4cab9f8b915e457728f41e561reed@google.comSkMatrix44::SkMatrix44(const SkMatrix& src) { 96688640cf363ac15761784902706296b7a611a42d4fs this->operator=(src); 9678260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 9688260a895869beaa4cab9f8b915e457728f41e561reed@google.com 9698260a895869beaa4cab9f8b915e457728f41e561reed@google.comSkMatrix44& SkMatrix44::operator=(const SkMatrix& src) { 9708260a895869beaa4cab9f8b915e457728f41e561reed@google.com initFromMatrix(fMat, src); 9717d68335eb427547606497eb4edea81acce7891f9reed@google.com 9727d68335eb427547606497eb4edea81acce7891f9reed@google.com if (src.isIdentity()) { 9737d68335eb427547606497eb4edea81acce7891f9reed@google.com this->setTypeMask(kIdentity_Mask); 9747d68335eb427547606497eb4edea81acce7891f9reed@google.com } else { 9757d68335eb427547606497eb4edea81acce7891f9reed@google.com this->dirtyTypeMask(); 9767d68335eb427547606497eb4edea81acce7891f9reed@google.com } 9778260a895869beaa4cab9f8b915e457728f41e561reed@google.com return *this; 9788260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 9798260a895869beaa4cab9f8b915e457728f41e561reed@google.com 9808260a895869beaa4cab9f8b915e457728f41e561reed@google.comSkMatrix44::operator SkMatrix() const { 9818260a895869beaa4cab9f8b915e457728f41e561reed@google.com SkMatrix dst; 9828260a895869beaa4cab9f8b915e457728f41e561reed@google.com 98372e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[SkMatrix::kMScaleX] = SkMScalarToScalar(fMat[0][0]); 98472e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[SkMatrix::kMSkewX] = SkMScalarToScalar(fMat[1][0]); 98572e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[SkMatrix::kMTransX] = SkMScalarToScalar(fMat[3][0]); 9868260a895869beaa4cab9f8b915e457728f41e561reed@google.com 98772e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[SkMatrix::kMSkewY] = SkMScalarToScalar(fMat[0][1]); 98872e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[SkMatrix::kMScaleY] = SkMScalarToScalar(fMat[1][1]); 98972e49b8982586a5d8b0425f16d909c05a36ea8c3bsalomon@google.com dst[SkMatrix::kMTransY] = SkMScalarToScalar(fMat[3][1]); 9908260a895869beaa4cab9f8b915e457728f41e561reed@google.com 991722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org dst[SkMatrix::kMPersp0] = SkMScalarToScalar(fMat[0][3]); 992722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org dst[SkMatrix::kMPersp1] = SkMScalarToScalar(fMat[1][3]); 993722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org dst[SkMatrix::kMPersp2] = SkMScalarToScalar(fMat[3][3]); 994722555bebbe9128783b8dbe0e897c09c9ccb88cecommit-bot@chromium.org 9958260a895869beaa4cab9f8b915e457728f41e561reed@google.com return dst; 9968260a895869beaa4cab9f8b915e457728f41e561reed@google.com} 997