Matrix.cpp revision 710f46d9d6a5bf9ea1c1833384caf61e1934124f
108ae317c21ec3086b5017672bba87420cc38a407Romain Guy/* 208ae317c21ec3086b5017672bba87420cc38a407Romain Guy * Copyright (C) 2010 The Android Open Source Project 308ae317c21ec3086b5017672bba87420cc38a407Romain Guy * 408ae317c21ec3086b5017672bba87420cc38a407Romain Guy * Licensed under the Apache License, Version 2.0 (the "License"); 508ae317c21ec3086b5017672bba87420cc38a407Romain Guy * you may not use this file except in compliance with the License. 608ae317c21ec3086b5017672bba87420cc38a407Romain Guy * You may obtain a copy of the License at 708ae317c21ec3086b5017672bba87420cc38a407Romain Guy * 808ae317c21ec3086b5017672bba87420cc38a407Romain Guy * http://www.apache.org/licenses/LICENSE-2.0 908ae317c21ec3086b5017672bba87420cc38a407Romain Guy * 1008ae317c21ec3086b5017672bba87420cc38a407Romain Guy * Unless required by applicable law or agreed to in writing, software 1108ae317c21ec3086b5017672bba87420cc38a407Romain Guy * distributed under the License is distributed on an "AS IS" BASIS, 1208ae317c21ec3086b5017672bba87420cc38a407Romain Guy * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 1308ae317c21ec3086b5017672bba87420cc38a407Romain Guy * See the License for the specific language governing permissions and 1408ae317c21ec3086b5017672bba87420cc38a407Romain Guy * limitations under the License. 1508ae317c21ec3086b5017672bba87420cc38a407Romain Guy */ 1608ae317c21ec3086b5017672bba87420cc38a407Romain Guy 175cbbce535744b89df5ecea95de21ee3733298260Romain Guy#define LOG_TAG "OpenGLRenderer" 1808ae317c21ec3086b5017672bba87420cc38a407Romain Guy 1908ae317c21ec3086b5017672bba87420cc38a407Romain Guy#include <math.h> 2008ae317c21ec3086b5017672bba87420cc38a407Romain Guy#include <stdlib.h> 213e168335b3422008908ac6973bb36078fd979f35Romain Guy#include <string.h> 2208ae317c21ec3086b5017672bba87420cc38a407Romain Guy 2308ae317c21ec3086b5017672bba87420cc38a407Romain Guy#include <utils/Log.h> 2408ae317c21ec3086b5017672bba87420cc38a407Romain Guy 25f6a11b8a9e25ff9861bbba19251bea84d8a5daf2Romain Guy#include <SkMatrix.h> 26f6a11b8a9e25ff9861bbba19251bea84d8a5daf2Romain Guy 274bb942083a0d4db746adf95349108dd8ef842e32Romain Guy#include "utils/Compare.h" 2885bf02fc16784d935fb9eebfa9cb20fe46ff7951Romain Guy#include "Matrix.h" 2908ae317c21ec3086b5017672bba87420cc38a407Romain Guy 3008ae317c21ec3086b5017672bba87420cc38a407Romain Guynamespace android { 319d5316e3f56d138504565ff311145ac01621dff4Romain Guynamespace uirenderer { 3208ae317c21ec3086b5017672bba87420cc38a407Romain Guy 3308ae317c21ec3086b5017672bba87420cc38a407Romain Guyvoid Matrix4::loadIdentity() { 34af28b514964861d81b48902f942f706050936d38Romain Guy data[kScaleX] = 1.0f; 35af28b514964861d81b48902f942f706050936d38Romain Guy data[kSkewY] = 0.0f; 36af28b514964861d81b48902f942f706050936d38Romain Guy data[2] = 0.0f; 37af28b514964861d81b48902f942f706050936d38Romain Guy data[kPerspective0] = 0.0f; 38af28b514964861d81b48902f942f706050936d38Romain Guy 39af28b514964861d81b48902f942f706050936d38Romain Guy data[kSkewX] = 0.0f; 40af28b514964861d81b48902f942f706050936d38Romain Guy data[kScaleY] = 1.0f; 41af28b514964861d81b48902f942f706050936d38Romain Guy data[6] = 0.0f; 42af28b514964861d81b48902f942f706050936d38Romain Guy data[kPerspective1] = 0.0f; 43af28b514964861d81b48902f942f706050936d38Romain Guy 44af28b514964861d81b48902f942f706050936d38Romain Guy data[8] = 0.0f; 45af28b514964861d81b48902f942f706050936d38Romain Guy data[9] = 0.0f; 46af28b514964861d81b48902f942f706050936d38Romain Guy data[kScaleZ] = 1.0f; 47af28b514964861d81b48902f942f706050936d38Romain Guy data[11] = 0.0f; 48af28b514964861d81b48902f942f706050936d38Romain Guy 49af28b514964861d81b48902f942f706050936d38Romain Guy data[kTranslateX] = 0.0f; 50af28b514964861d81b48902f942f706050936d38Romain Guy data[kTranslateY] = 0.0f; 51af28b514964861d81b48902f942f706050936d38Romain Guy data[kTranslateZ] = 0.0f; 52af28b514964861d81b48902f942f706050936d38Romain Guy data[kPerspective2] = 1.0f; 53af28b514964861d81b48902f942f706050936d38Romain Guy 54302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy mIsIdentity = true; 55af28b514964861d81b48902f942f706050936d38Romain Guy mSimpleMatrix = true; 5608ae317c21ec3086b5017672bba87420cc38a407Romain Guy} 5708ae317c21ec3086b5017672bba87420cc38a407Romain Guy 58710f46d9d6a5bf9ea1c1833384caf61e1934124fChris Craikbool Matrix4::changesBounds() const { 59d3efd6920e64d0207a0655640297d87d4937ee27Chet Haase return !(data[0] == 1.0f && data[1] == 0.0f && data[2] == 0.0f && data[4] == 0.0f && 60d3efd6920e64d0207a0655640297d87d4937ee27Chet Haase data[5] == 1.0f && data[6] == 0.0f && data[8] == 0.0f && data[9] == 0.0f && 61d3efd6920e64d0207a0655640297d87d4937ee27Chet Haase data[10] == 1.0f); 62e8cb9c14309b0f01c0159efdf9a7198f44a62642Romain Guy} 63e8cb9c14309b0f01c0159efdf9a7198f44a62642Romain Guy 64710f46d9d6a5bf9ea1c1833384caf61e1934124fChris Craikbool Matrix4::isPureTranslate() const { 65d3efd6920e64d0207a0655640297d87d4937ee27Chet Haase return mSimpleMatrix && data[kScaleX] == 1.0f && data[kScaleY] == 1.0f; 666620c6d413f972819fada92b574f0fa9e96d36c1Romain Guy} 676620c6d413f972819fada92b574f0fa9e96d36c1Romain Guy 68710f46d9d6a5bf9ea1c1833384caf61e1934124fChris Craikbool Matrix4::isSimple() const { 69181d0a6ccedee03789919d53c46540a8df751896Romain Guy return mSimpleMatrix; 70181d0a6ccedee03789919d53c46540a8df751896Romain Guy} 71181d0a6ccedee03789919d53c46540a8df751896Romain Guy 72710f46d9d6a5bf9ea1c1833384caf61e1934124fChris Craikbool Matrix4::isIdentity() const { 73302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy return mIsIdentity; 74302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy} 75302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy 7608ae317c21ec3086b5017672bba87420cc38a407Romain Guyvoid Matrix4::load(const float* v) { 777ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy memcpy(data, v, sizeof(data)); 78302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy // TODO: Do something smarter here 79af28b514964861d81b48902f942f706050936d38Romain Guy mSimpleMatrix = false; 80302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy mIsIdentity = false; 8108ae317c21ec3086b5017672bba87420cc38a407Romain Guy} 8208ae317c21ec3086b5017672bba87420cc38a407Romain Guy 8308ae317c21ec3086b5017672bba87420cc38a407Romain Guyvoid Matrix4::load(const Matrix4& v) { 847ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy memcpy(data, v.data, sizeof(data)); 85af28b514964861d81b48902f942f706050936d38Romain Guy mSimpleMatrix = v.mSimpleMatrix; 86302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy mIsIdentity = v.mIsIdentity; 8708ae317c21ec3086b5017672bba87420cc38a407Romain Guy} 8808ae317c21ec3086b5017672bba87420cc38a407Romain Guy 89f6a11b8a9e25ff9861bbba19251bea84d8a5daf2Romain Guyvoid Matrix4::load(const SkMatrix& v) { 907ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy memset(data, 0, sizeof(data)); 91f6a11b8a9e25ff9861bbba19251bea84d8a5daf2Romain Guy 92af28b514964861d81b48902f942f706050936d38Romain Guy data[kScaleX] = v[SkMatrix::kMScaleX]; 93af28b514964861d81b48902f942f706050936d38Romain Guy data[kSkewX] = v[SkMatrix::kMSkewX]; 94af28b514964861d81b48902f942f706050936d38Romain Guy data[kTranslateX] = v[SkMatrix::kMTransX]; 95f6a11b8a9e25ff9861bbba19251bea84d8a5daf2Romain Guy 96af28b514964861d81b48902f942f706050936d38Romain Guy data[kSkewY] = v[SkMatrix::kMSkewY]; 97af28b514964861d81b48902f942f706050936d38Romain Guy data[kScaleY] = v[SkMatrix::kMScaleY]; 98af28b514964861d81b48902f942f706050936d38Romain Guy data[kTranslateY] = v[SkMatrix::kMTransY]; 99f6a11b8a9e25ff9861bbba19251bea84d8a5daf2Romain Guy 100af28b514964861d81b48902f942f706050936d38Romain Guy data[kPerspective0] = v[SkMatrix::kMPersp0]; 101af28b514964861d81b48902f942f706050936d38Romain Guy data[kPerspective1] = v[SkMatrix::kMPersp1]; 102af28b514964861d81b48902f942f706050936d38Romain Guy data[kPerspective2] = v[SkMatrix::kMPersp2]; 103f6a11b8a9e25ff9861bbba19251bea84d8a5daf2Romain Guy 104af28b514964861d81b48902f942f706050936d38Romain Guy data[kScaleZ] = 1.0f; 105af28b514964861d81b48902f942f706050936d38Romain Guy 106e5ebcb0107a939395e03592fd44c746cd09e311dRomain Guy mSimpleMatrix = (v.getType() <= (SkMatrix::kScale_Mask | SkMatrix::kTranslate_Mask)); 107302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy mIsIdentity = v.isIdentity(); 108f6a11b8a9e25ff9861bbba19251bea84d8a5daf2Romain Guy} 109f6a11b8a9e25ff9861bbba19251bea84d8a5daf2Romain Guy 110f6a11b8a9e25ff9861bbba19251bea84d8a5daf2Romain Guyvoid Matrix4::copyTo(SkMatrix& v) const { 1117ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy v.reset(); 112f6a11b8a9e25ff9861bbba19251bea84d8a5daf2Romain Guy 113af28b514964861d81b48902f942f706050936d38Romain Guy v.set(SkMatrix::kMScaleX, data[kScaleX]); 114af28b514964861d81b48902f942f706050936d38Romain Guy v.set(SkMatrix::kMSkewX, data[kSkewX]); 115af28b514964861d81b48902f942f706050936d38Romain Guy v.set(SkMatrix::kMTransX, data[kTranslateX]); 116f6a11b8a9e25ff9861bbba19251bea84d8a5daf2Romain Guy 117af28b514964861d81b48902f942f706050936d38Romain Guy v.set(SkMatrix::kMSkewY, data[kSkewY]); 118af28b514964861d81b48902f942f706050936d38Romain Guy v.set(SkMatrix::kMScaleY, data[kScaleY]); 119af28b514964861d81b48902f942f706050936d38Romain Guy v.set(SkMatrix::kMTransY, data[kTranslateY]); 120f6a11b8a9e25ff9861bbba19251bea84d8a5daf2Romain Guy 121af28b514964861d81b48902f942f706050936d38Romain Guy v.set(SkMatrix::kMPersp0, data[kPerspective0]); 122af28b514964861d81b48902f942f706050936d38Romain Guy v.set(SkMatrix::kMPersp1, data[kPerspective1]); 123af28b514964861d81b48902f942f706050936d38Romain Guy v.set(SkMatrix::kMPersp2, data[kPerspective2]); 124f6a11b8a9e25ff9861bbba19251bea84d8a5daf2Romain Guy} 125f6a11b8a9e25ff9861bbba19251bea84d8a5daf2Romain Guy 126079ba2c85b15e882629b8d188f5fbdb42f7f8eeaRomain Guyvoid Matrix4::loadInverse(const Matrix4& v) { 127079ba2c85b15e882629b8d188f5fbdb42f7f8eeaRomain Guy double scale = 1.0 / 128af28b514964861d81b48902f942f706050936d38Romain Guy (v.data[kScaleX] * ((double) v.data[kScaleY] * v.data[kPerspective2] - 129af28b514964861d81b48902f942f706050936d38Romain Guy (double) v.data[kTranslateY] * v.data[kPerspective1]) + 130af28b514964861d81b48902f942f706050936d38Romain Guy v.data[kSkewX] * ((double) v.data[kTranslateY] * v.data[kPerspective0] - 131af28b514964861d81b48902f942f706050936d38Romain Guy (double) v.data[kSkewY] * v.data[kPerspective2]) + 132af28b514964861d81b48902f942f706050936d38Romain Guy v.data[kTranslateX] * ((double) v.data[kSkewY] * v.data[kPerspective1] - 133af28b514964861d81b48902f942f706050936d38Romain Guy (double) v.data[kScaleY] * v.data[kPerspective0])); 134af28b514964861d81b48902f942f706050936d38Romain Guy 135af28b514964861d81b48902f942f706050936d38Romain Guy data[kScaleX] = (v.data[kScaleY] * v.data[kPerspective2] - 136af28b514964861d81b48902f942f706050936d38Romain Guy v.data[kTranslateY] * v.data[kPerspective1]) * scale; 137af28b514964861d81b48902f942f706050936d38Romain Guy data[kSkewX] = (v.data[kTranslateX] * v.data[kPerspective1] - 138af28b514964861d81b48902f942f706050936d38Romain Guy v.data[kSkewX] * v.data[kPerspective2]) * scale; 139af28b514964861d81b48902f942f706050936d38Romain Guy data[kTranslateX] = (v.data[kSkewX] * v.data[kTranslateY] - 140af28b514964861d81b48902f942f706050936d38Romain Guy v.data[kTranslateX] * v.data[kScaleY]) * scale; 141af28b514964861d81b48902f942f706050936d38Romain Guy 142af28b514964861d81b48902f942f706050936d38Romain Guy data[kSkewY] = (v.data[kTranslateY] * v.data[kPerspective0] - 143af28b514964861d81b48902f942f706050936d38Romain Guy v.data[kSkewY] * v.data[kPerspective2]) * scale; 144af28b514964861d81b48902f942f706050936d38Romain Guy data[kScaleY] = (v.data[kScaleX] * v.data[kPerspective2] - 145af28b514964861d81b48902f942f706050936d38Romain Guy v.data[kTranslateX] * v.data[kPerspective0]) * scale; 146af28b514964861d81b48902f942f706050936d38Romain Guy data[kTranslateY] = (v.data[kTranslateX] * v.data[kSkewY] - 147af28b514964861d81b48902f942f706050936d38Romain Guy v.data[kScaleX] * v.data[kTranslateY]) * scale; 148af28b514964861d81b48902f942f706050936d38Romain Guy 149af28b514964861d81b48902f942f706050936d38Romain Guy data[kPerspective0] = (v.data[kSkewY] * v.data[kPerspective1] - 150af28b514964861d81b48902f942f706050936d38Romain Guy v.data[kScaleY] * v.data[kPerspective0]) * scale; 151af28b514964861d81b48902f942f706050936d38Romain Guy data[kPerspective1] = (v.data[kSkewX] * v.data[kPerspective0] - 152af28b514964861d81b48902f942f706050936d38Romain Guy v.data[kScaleX] * v.data[kPerspective1]) * scale; 153af28b514964861d81b48902f942f706050936d38Romain Guy data[kPerspective2] = (v.data[kScaleX] * v.data[kScaleY] - 154af28b514964861d81b48902f942f706050936d38Romain Guy v.data[kSkewX] * v.data[kSkewY]) * scale; 155af28b514964861d81b48902f942f706050936d38Romain Guy 156af28b514964861d81b48902f942f706050936d38Romain Guy mSimpleMatrix = v.mSimpleMatrix; 157302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy mIsIdentity = v.mIsIdentity; 158079ba2c85b15e882629b8d188f5fbdb42f7f8eeaRomain Guy} 159079ba2c85b15e882629b8d188f5fbdb42f7f8eeaRomain Guy 16008ae317c21ec3086b5017672bba87420cc38a407Romain Guyvoid Matrix4::copyTo(float* v) const { 1617ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy memcpy(v, data, sizeof(data)); 16208ae317c21ec3086b5017672bba87420cc38a407Romain Guy} 16308ae317c21ec3086b5017672bba87420cc38a407Romain Guy 164bd6b79b40247aea7bfe13d0831c6c0472df6c636Romain Guyfloat Matrix4::getTranslateX() { 165af28b514964861d81b48902f942f706050936d38Romain Guy return data[kTranslateX]; 166bd6b79b40247aea7bfe13d0831c6c0472df6c636Romain Guy} 167bd6b79b40247aea7bfe13d0831c6c0472df6c636Romain Guy 168bd6b79b40247aea7bfe13d0831c6c0472df6c636Romain Guyfloat Matrix4::getTranslateY() { 169af28b514964861d81b48902f942f706050936d38Romain Guy return data[kTranslateY]; 170bd6b79b40247aea7bfe13d0831c6c0472df6c636Romain Guy} 171bd6b79b40247aea7bfe13d0831c6c0472df6c636Romain Guy 172ddb80bebb0776e6d852aab6e8bba5d5591847a55Romain Guyvoid Matrix4::multiply(float v) { 173ddb80bebb0776e6d852aab6e8bba5d5591847a55Romain Guy for (int i = 0; i < 16; i++) { 174ddb80bebb0776e6d852aab6e8bba5d5591847a55Romain Guy data[i] *= v; 175ddb80bebb0776e6d852aab6e8bba5d5591847a55Romain Guy } 176302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy mIsIdentity = false; 177ddb80bebb0776e6d852aab6e8bba5d5591847a55Romain Guy} 178ddb80bebb0776e6d852aab6e8bba5d5591847a55Romain Guy 17908ae317c21ec3086b5017672bba87420cc38a407Romain Guyvoid Matrix4::loadTranslate(float x, float y, float z) { 1807ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy loadIdentity(); 181302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy 182af28b514964861d81b48902f942f706050936d38Romain Guy data[kTranslateX] = x; 183af28b514964861d81b48902f942f706050936d38Romain Guy data[kTranslateY] = y; 184af28b514964861d81b48902f942f706050936d38Romain Guy data[kTranslateZ] = z; 185302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy 186302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy mIsIdentity = false; 18708ae317c21ec3086b5017672bba87420cc38a407Romain Guy} 18808ae317c21ec3086b5017672bba87420cc38a407Romain Guy 18908ae317c21ec3086b5017672bba87420cc38a407Romain Guyvoid Matrix4::loadScale(float sx, float sy, float sz) { 1907ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy loadIdentity(); 191302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy 192af28b514964861d81b48902f942f706050936d38Romain Guy data[kScaleX] = sx; 193af28b514964861d81b48902f942f706050936d38Romain Guy data[kScaleY] = sy; 194af28b514964861d81b48902f942f706050936d38Romain Guy data[kScaleZ] = sz; 195302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy 196302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy mIsIdentity = false; 19708ae317c21ec3086b5017672bba87420cc38a407Romain Guy} 19808ae317c21ec3086b5017672bba87420cc38a407Romain Guy 199807daf7df615b60ce6fc41355aabe3aa353cebabRomain Guyvoid Matrix4::loadSkew(float sx, float sy) { 200807daf7df615b60ce6fc41355aabe3aa353cebabRomain Guy loadIdentity(); 201807daf7df615b60ce6fc41355aabe3aa353cebabRomain Guy 202807daf7df615b60ce6fc41355aabe3aa353cebabRomain Guy data[kScaleX] = 1.0f; 203807daf7df615b60ce6fc41355aabe3aa353cebabRomain Guy data[kSkewX] = sx; 204807daf7df615b60ce6fc41355aabe3aa353cebabRomain Guy data[kTranslateX] = 0.0f; 205807daf7df615b60ce6fc41355aabe3aa353cebabRomain Guy 206807daf7df615b60ce6fc41355aabe3aa353cebabRomain Guy data[kSkewY] = sy; 207807daf7df615b60ce6fc41355aabe3aa353cebabRomain Guy data[kScaleY] = 1.0f; 208807daf7df615b60ce6fc41355aabe3aa353cebabRomain Guy data[kTranslateY] = 0.0f; 209807daf7df615b60ce6fc41355aabe3aa353cebabRomain Guy 210807daf7df615b60ce6fc41355aabe3aa353cebabRomain Guy data[kPerspective0] = 0.0f; 211807daf7df615b60ce6fc41355aabe3aa353cebabRomain Guy data[kPerspective1] = 0.0f; 212807daf7df615b60ce6fc41355aabe3aa353cebabRomain Guy data[kPerspective2] = 1.0f; 213807daf7df615b60ce6fc41355aabe3aa353cebabRomain Guy 214807daf7df615b60ce6fc41355aabe3aa353cebabRomain Guy mSimpleMatrix = false; 215302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy mIsIdentity = false; 216807daf7df615b60ce6fc41355aabe3aa353cebabRomain Guy} 217807daf7df615b60ce6fc41355aabe3aa353cebabRomain Guy 21808ae317c21ec3086b5017672bba87420cc38a407Romain Guyvoid Matrix4::loadRotate(float angle, float x, float y, float z) { 219af28b514964861d81b48902f942f706050936d38Romain Guy data[kPerspective0] = 0.0f; 220af28b514964861d81b48902f942f706050936d38Romain Guy data[kPerspective1] = 0.0f; 221af28b514964861d81b48902f942f706050936d38Romain Guy data[11] = 0.0f; 222af28b514964861d81b48902f942f706050936d38Romain Guy data[kTranslateX] = 0.0f; 223af28b514964861d81b48902f942f706050936d38Romain Guy data[kTranslateY] = 0.0f; 224af28b514964861d81b48902f942f706050936d38Romain Guy data[kTranslateZ] = 0.0f; 225af28b514964861d81b48902f942f706050936d38Romain Guy data[kPerspective2] = 1.0f; 2267ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy 2277ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy angle *= float(M_PI / 180.0f); 2287ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy float c = cosf(angle); 2297ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy float s = sinf(angle); 2307ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy 2317ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy const float length = sqrtf(x * x + y * y + z * z); 232889f8d1403761d5668115ced6cbb3f767cfe966dRomain Guy float recipLen = 1.0f / length; 233889f8d1403761d5668115ced6cbb3f767cfe966dRomain Guy x *= recipLen; 234889f8d1403761d5668115ced6cbb3f767cfe966dRomain Guy y *= recipLen; 235889f8d1403761d5668115ced6cbb3f767cfe966dRomain Guy z *= recipLen; 236889f8d1403761d5668115ced6cbb3f767cfe966dRomain Guy 2377ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy const float nc = 1.0f - c; 2387ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy const float xy = x * y; 2397ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy const float yz = y * z; 2407ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy const float zx = z * x; 2417ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy const float xs = x * s; 2427ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy const float ys = y * s; 2437ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy const float zs = z * s; 2447ae7ac48aa2b53453c9805075171ecd5bcafd7deRomain Guy 245af28b514964861d81b48902f942f706050936d38Romain Guy data[kScaleX] = x * x * nc + c; 246af28b514964861d81b48902f942f706050936d38Romain Guy data[kSkewX] = xy * nc - zs; 247af28b514964861d81b48902f942f706050936d38Romain Guy data[8] = zx * nc + ys; 248af28b514964861d81b48902f942f706050936d38Romain Guy data[kSkewY] = xy * nc + zs; 249af28b514964861d81b48902f942f706050936d38Romain Guy data[kScaleY] = y * y * nc + c; 250af28b514964861d81b48902f942f706050936d38Romain Guy data[9] = yz * nc - xs; 251af28b514964861d81b48902f942f706050936d38Romain Guy data[2] = zx * nc - ys; 252af28b514964861d81b48902f942f706050936d38Romain Guy data[6] = yz * nc + xs; 253af28b514964861d81b48902f942f706050936d38Romain Guy data[kScaleZ] = z * z * nc + c; 254af28b514964861d81b48902f942f706050936d38Romain Guy 255af28b514964861d81b48902f942f706050936d38Romain Guy mSimpleMatrix = false; 256302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy mIsIdentity = false; 25708ae317c21ec3086b5017672bba87420cc38a407Romain Guy} 25808ae317c21ec3086b5017672bba87420cc38a407Romain Guy 25908ae317c21ec3086b5017672bba87420cc38a407Romain Guyvoid Matrix4::loadMultiply(const Matrix4& u, const Matrix4& v) { 26008ae317c21ec3086b5017672bba87420cc38a407Romain Guy for (int i = 0 ; i < 4 ; i++) { 26108ae317c21ec3086b5017672bba87420cc38a407Romain Guy float x = 0; 26208ae317c21ec3086b5017672bba87420cc38a407Romain Guy float y = 0; 26308ae317c21ec3086b5017672bba87420cc38a407Romain Guy float z = 0; 26408ae317c21ec3086b5017672bba87420cc38a407Romain Guy float w = 0; 26508ae317c21ec3086b5017672bba87420cc38a407Romain Guy 26608ae317c21ec3086b5017672bba87420cc38a407Romain Guy for (int j = 0 ; j < 4 ; j++) { 267c7d53494f1fbd9f9d74af89053ff9fdb1ccbac6cRomain Guy const float e = v.get(i, j); 26808ae317c21ec3086b5017672bba87420cc38a407Romain Guy x += u.get(j, 0) * e; 26908ae317c21ec3086b5017672bba87420cc38a407Romain Guy y += u.get(j, 1) * e; 27008ae317c21ec3086b5017672bba87420cc38a407Romain Guy z += u.get(j, 2) * e; 27108ae317c21ec3086b5017672bba87420cc38a407Romain Guy w += u.get(j, 3) * e; 27208ae317c21ec3086b5017672bba87420cc38a407Romain Guy } 27308ae317c21ec3086b5017672bba87420cc38a407Romain Guy 27408ae317c21ec3086b5017672bba87420cc38a407Romain Guy set(i, 0, x); 27508ae317c21ec3086b5017672bba87420cc38a407Romain Guy set(i, 1, y); 27608ae317c21ec3086b5017672bba87420cc38a407Romain Guy set(i, 2, z); 27708ae317c21ec3086b5017672bba87420cc38a407Romain Guy set(i, 3, w); 27808ae317c21ec3086b5017672bba87420cc38a407Romain Guy } 279af28b514964861d81b48902f942f706050936d38Romain Guy 280af28b514964861d81b48902f942f706050936d38Romain Guy mSimpleMatrix = u.mSimpleMatrix && v.mSimpleMatrix; 281302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy mIsIdentity = false; 28208ae317c21ec3086b5017672bba87420cc38a407Romain Guy} 28308ae317c21ec3086b5017672bba87420cc38a407Romain Guy 28408ae317c21ec3086b5017672bba87420cc38a407Romain Guyvoid Matrix4::loadOrtho(float left, float right, float bottom, float top, float near, float far) { 28508ae317c21ec3086b5017672bba87420cc38a407Romain Guy loadIdentity(); 286302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy 287af28b514964861d81b48902f942f706050936d38Romain Guy data[kScaleX] = 2.0f / (right - left); 288af28b514964861d81b48902f942f706050936d38Romain Guy data[kScaleY] = 2.0f / (top - bottom); 289af28b514964861d81b48902f942f706050936d38Romain Guy data[kScaleZ] = -2.0f / (far - near); 290af28b514964861d81b48902f942f706050936d38Romain Guy data[kTranslateX] = -(right + left) / (right - left); 291af28b514964861d81b48902f942f706050936d38Romain Guy data[kTranslateY] = -(top + bottom) / (top - bottom); 292af28b514964861d81b48902f942f706050936d38Romain Guy data[kTranslateZ] = -(far + near) / (far - near); 293302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy 294302a9df1d50373c82923bb84ff665dfce584fb22Romain Guy mIsIdentity = false; 29508ae317c21ec3086b5017672bba87420cc38a407Romain Guy} 29608ae317c21ec3086b5017672bba87420cc38a407Romain Guy 2970ba681bce12d522c5575dfccb5a6ca12f0fba746Romain Guy#define MUL_ADD_STORE(a, b, c) a = (a) * (b) + (c) 2980ba681bce12d522c5575dfccb5a6ca12f0fba746Romain Guy 2990ba681bce12d522c5575dfccb5a6ca12f0fba746Romain Guyvoid Matrix4::mapPoint(float& x, float& y) const { 3000ba681bce12d522c5575dfccb5a6ca12f0fba746Romain Guy if (mSimpleMatrix) { 3010ba681bce12d522c5575dfccb5a6ca12f0fba746Romain Guy MUL_ADD_STORE(x, data[kScaleX], data[kTranslateX]); 3020ba681bce12d522c5575dfccb5a6ca12f0fba746Romain Guy MUL_ADD_STORE(y, data[kScaleY], data[kTranslateY]); 3030ba681bce12d522c5575dfccb5a6ca12f0fba746Romain Guy return; 3040ba681bce12d522c5575dfccb5a6ca12f0fba746Romain Guy } 3050ba681bce12d522c5575dfccb5a6ca12f0fba746Romain Guy 3060ba681bce12d522c5575dfccb5a6ca12f0fba746Romain Guy float dx = x * data[kScaleX] + y * data[kSkewX] + data[kTranslateX]; 3070ba681bce12d522c5575dfccb5a6ca12f0fba746Romain Guy float dy = x * data[kSkewY] + y * data[kScaleY] + data[kTranslateY]; 3080ba681bce12d522c5575dfccb5a6ca12f0fba746Romain Guy float dz = x * data[kPerspective0] + y * data[kPerspective1] + data[kPerspective2]; 3090ba681bce12d522c5575dfccb5a6ca12f0fba746Romain Guy if (dz) dz = 1.0f / dz; 3100ba681bce12d522c5575dfccb5a6ca12f0fba746Romain Guy 3110ba681bce12d522c5575dfccb5a6ca12f0fba746Romain Guy x = dx * dz; 3120ba681bce12d522c5575dfccb5a6ca12f0fba746Romain Guy y = dy * dz; 3130ba681bce12d522c5575dfccb5a6ca12f0fba746Romain Guy} 3140ba681bce12d522c5575dfccb5a6ca12f0fba746Romain Guy 3159d5316e3f56d138504565ff311145ac01621dff4Romain Guyvoid Matrix4::mapRect(Rect& r) const { 316af28b514964861d81b48902f942f706050936d38Romain Guy if (mSimpleMatrix) { 317af28b514964861d81b48902f942f706050936d38Romain Guy MUL_ADD_STORE(r.left, data[kScaleX], data[kTranslateX]); 318af28b514964861d81b48902f942f706050936d38Romain Guy MUL_ADD_STORE(r.right, data[kScaleX], data[kTranslateX]); 319af28b514964861d81b48902f942f706050936d38Romain Guy MUL_ADD_STORE(r.top, data[kScaleY], data[kTranslateY]); 320af28b514964861d81b48902f942f706050936d38Romain Guy MUL_ADD_STORE(r.bottom, data[kScaleY], data[kTranslateY]); 3215b3b35296e8b2c8d3f07d32bb645d5414db41a1dRomain Guy 3225b3b35296e8b2c8d3f07d32bb645d5414db41a1dRomain Guy if (r.left > r.right) { 3235b3b35296e8b2c8d3f07d32bb645d5414db41a1dRomain Guy float x = r.left; 3245b3b35296e8b2c8d3f07d32bb645d5414db41a1dRomain Guy r.left = r.right; 3255b3b35296e8b2c8d3f07d32bb645d5414db41a1dRomain Guy r.right = x; 3265b3b35296e8b2c8d3f07d32bb645d5414db41a1dRomain Guy } 3275b3b35296e8b2c8d3f07d32bb645d5414db41a1dRomain Guy 3285b3b35296e8b2c8d3f07d32bb645d5414db41a1dRomain Guy if (r.top > r.bottom) { 3295b3b35296e8b2c8d3f07d32bb645d5414db41a1dRomain Guy float y = r.top; 3305b3b35296e8b2c8d3f07d32bb645d5414db41a1dRomain Guy r.top = r.bottom; 3315b3b35296e8b2c8d3f07d32bb645d5414db41a1dRomain Guy r.bottom = y; 3325b3b35296e8b2c8d3f07d32bb645d5414db41a1dRomain Guy } 3335b3b35296e8b2c8d3f07d32bb645d5414db41a1dRomain Guy 334af28b514964861d81b48902f942f706050936d38Romain Guy return; 335af28b514964861d81b48902f942f706050936d38Romain Guy } 336af28b514964861d81b48902f942f706050936d38Romain Guy 337af28b514964861d81b48902f942f706050936d38Romain Guy float vertices[] = { 3381d83e1981c8b89da93dff37a4f8b2b1ad8480b44Romain Guy r.left, r.top, 3391d83e1981c8b89da93dff37a4f8b2b1ad8480b44Romain Guy r.right, r.top, 3401d83e1981c8b89da93dff37a4f8b2b1ad8480b44Romain Guy r.right, r.bottom, 3411d83e1981c8b89da93dff37a4f8b2b1ad8480b44Romain Guy r.left, r.bottom 342af28b514964861d81b48902f942f706050936d38Romain Guy }; 343af28b514964861d81b48902f942f706050936d38Romain Guy 344af28b514964861d81b48902f942f706050936d38Romain Guy float x, y, z; 3459d5316e3f56d138504565ff311145ac01621dff4Romain Guy 346af28b514964861d81b48902f942f706050936d38Romain Guy for (int i = 0; i < 8; i+= 2) { 347af28b514964861d81b48902f942f706050936d38Romain Guy float px = vertices[i]; 348af28b514964861d81b48902f942f706050936d38Romain Guy float py = vertices[i + 1]; 3499d5316e3f56d138504565ff311145ac01621dff4Romain Guy 350af28b514964861d81b48902f942f706050936d38Romain Guy x = px * data[kScaleX] + py * data[kSkewX] + data[kTranslateX]; 351af28b514964861d81b48902f942f706050936d38Romain Guy y = px * data[kSkewY] + py * data[kScaleY] + data[kTranslateY]; 352af28b514964861d81b48902f942f706050936d38Romain Guy z = px * data[kPerspective0] + py * data[kPerspective1] + data[kPerspective2]; 353af28b514964861d81b48902f942f706050936d38Romain Guy if (z) z = 1.0f / z; 354af28b514964861d81b48902f942f706050936d38Romain Guy 355af28b514964861d81b48902f942f706050936d38Romain Guy vertices[i] = x * z; 356af28b514964861d81b48902f942f706050936d38Romain Guy vertices[i + 1] = y * z; 357af28b514964861d81b48902f942f706050936d38Romain Guy } 358af28b514964861d81b48902f942f706050936d38Romain Guy 359af28b514964861d81b48902f942f706050936d38Romain Guy r.left = r.right = vertices[0]; 360af28b514964861d81b48902f942f706050936d38Romain Guy r.top = r.bottom = vertices[1]; 361af28b514964861d81b48902f942f706050936d38Romain Guy 362af28b514964861d81b48902f942f706050936d38Romain Guy for (int i = 2; i < 8; i += 2) { 363af28b514964861d81b48902f942f706050936d38Romain Guy x = vertices[i]; 364af28b514964861d81b48902f942f706050936d38Romain Guy y = vertices[i + 1]; 365af28b514964861d81b48902f942f706050936d38Romain Guy 366af28b514964861d81b48902f942f706050936d38Romain Guy if (x < r.left) r.left = x; 367af28b514964861d81b48902f942f706050936d38Romain Guy else if (x > r.right) r.right = x; 368af28b514964861d81b48902f942f706050936d38Romain Guy if (y < r.top) r.top = y; 369af28b514964861d81b48902f942f706050936d38Romain Guy else if (y > r.bottom) r.bottom = y; 370af28b514964861d81b48902f942f706050936d38Romain Guy } 3719d5316e3f56d138504565ff311145ac01621dff4Romain Guy} 3729d5316e3f56d138504565ff311145ac01621dff4Romain Guy 37308ae317c21ec3086b5017672bba87420cc38a407Romain Guyvoid Matrix4::dump() const { 3745baa3a62a97544669fba6d65a11c07f252e654ddSteve Block ALOGD("Matrix4[simple=%d", mSimpleMatrix); 3755baa3a62a97544669fba6d65a11c07f252e654ddSteve Block ALOGD(" %f %f %f %f", data[kScaleX], data[kSkewX], data[8], data[kTranslateX]); 3765baa3a62a97544669fba6d65a11c07f252e654ddSteve Block ALOGD(" %f %f %f %f", data[kSkewY], data[kScaleY], data[9], data[kTranslateY]); 3775baa3a62a97544669fba6d65a11c07f252e654ddSteve Block ALOGD(" %f %f %f %f", data[2], data[6], data[kScaleZ], data[kTranslateZ]); 3785baa3a62a97544669fba6d65a11c07f252e654ddSteve Block ALOGD(" %f %f %f %f", data[kPerspective0], data[kPerspective1], data[11], data[kPerspective2]); 3795baa3a62a97544669fba6d65a11c07f252e654ddSteve Block ALOGD("]"); 38008ae317c21ec3086b5017672bba87420cc38a407Romain Guy} 38108ae317c21ec3086b5017672bba87420cc38a407Romain Guy 3829d5316e3f56d138504565ff311145ac01621dff4Romain Guy}; // namespace uirenderer 3839d5316e3f56d138504565ff311145ac01621dff4Romain Guy}; // namespace android 384