Matrix.cpp revision 889f8d1403761d5668115ced6cbb3f767cfe966d
1/* 2 * Copyright (C) 2010 The Android Open Source Project 3 * 4 * Licensed under the Apache License, Version 2.0 (the "License"); 5 * you may not use this file except in compliance with the License. 6 * You may obtain a copy of the License at 7 * 8 * http://www.apache.org/licenses/LICENSE-2.0 9 * 10 * Unless required by applicable law or agreed to in writing, software 11 * distributed under the License is distributed on an "AS IS" BASIS, 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 13 * See the License for the specific language governing permissions and 14 * limitations under the License. 15 */ 16 17#define LOG_TAG "OpenGLRenderer" 18 19#include <math.h> 20#include <stdlib.h> 21#include <string.h> 22 23#include <utils/Log.h> 24 25#include <SkMatrix.h> 26 27#include "Matrix.h" 28 29namespace android { 30namespace uirenderer { 31 32void Matrix4::loadIdentity() { 33 data[0] = 1.0f; 34 data[1] = 0.0f; 35 data[2] = 0.0f; 36 data[3] = 0.0f; 37 38 data[4] = 0.0f; 39 data[5] = 1.0f; 40 data[6] = 0.0f; 41 data[7] = 0.0f; 42 43 data[8] = 0.0f; 44 data[9] = 0.0f; 45 data[10] = 1.0f; 46 data[11] = 0.0f; 47 48 data[12] = 0.0f; 49 data[13] = 0.0f; 50 data[14] = 0.0f; 51 data[15] = 1.0f; 52} 53 54void Matrix4::load(const float* v) { 55 memcpy(data, v, sizeof(data)); 56} 57 58void Matrix4::load(const Matrix4& v) { 59 memcpy(data, v.data, sizeof(data)); 60} 61 62void Matrix4::load(const SkMatrix& v) { 63 memset(data, 0, sizeof(data)); 64 65 data[0] = v[SkMatrix::kMScaleX]; 66 data[4] = v[SkMatrix::kMSkewX]; 67 data[12] = v[SkMatrix::kMTransX]; 68 69 data[1] = v[SkMatrix::kMSkewY]; 70 data[5] = v[SkMatrix::kMScaleY]; 71 data[13] = v[SkMatrix::kMTransY]; 72 73 data[3] = v[SkMatrix::kMPersp0]; 74 data[7] = v[SkMatrix::kMPersp1]; 75 data[15] = v[SkMatrix::kMPersp2]; 76 77 data[10] = 1.0f; 78} 79 80void Matrix4::copyTo(SkMatrix& v) const { 81 v.reset(); 82 83 v.set(SkMatrix::kMScaleX, data[0]); 84 v.set(SkMatrix::kMSkewX, data[4]); 85 v.set(SkMatrix::kMTransX, data[12]); 86 87 v.set(SkMatrix::kMSkewY, data[1]); 88 v.set(SkMatrix::kMScaleY, data[5]); 89 v.set(SkMatrix::kMTransY, data[13]); 90 91 v.set(SkMatrix::kMPersp0, data[3]); 92 v.set(SkMatrix::kMPersp1, data[7]); 93 v.set(SkMatrix::kMPersp2, data[15]); 94} 95 96void Matrix4::loadInverse(const Matrix4& v) { 97 double scale = 1.0 / 98 (v.data[0] * ((double) v.data[5] * v.data[15] - (double) v.data[13] * v.data[7]) + 99 v.data[4] * ((double) v.data[13] * v.data[3] - (double) v.data[1] * v.data[15]) + 100 v.data[12] * ((double) v.data[1] * v.data[7] - (double) v.data[5] * v.data[3])); 101 102 data[0] = (v.data[5] * v.data[15] - v.data[13] * v.data[7]) * scale; 103 data[4] = (v.data[12] * v.data[7] - v.data[4] * v.data[15]) * scale; 104 data[12] = (v.data[4] * v.data[13] - v.data[12] * v.data[5]) * scale; 105 106 data[1] = (v.data[13] * v.data[3] - v.data[1] * v.data[15]) * scale; 107 data[5] = (v.data[0] * v.data[15] - v.data[12] * v.data[3]) * scale; 108 data[13] = (v.data[12] * v.data[1] - v.data[0] * v.data[13]) * scale; 109 110 data[3] = (v.data[1] * v.data[7] - v.data[5] * v.data[3]) * scale; 111 data[7] = (v.data[4] * v.data[3] - v.data[0] * v.data[7]) * scale; 112 data[15] = (v.data[0] * v.data[5] - v.data[4] * v.data[1]) * scale; 113} 114 115void Matrix4::copyTo(float* v) const { 116 memcpy(v, data, sizeof(data)); 117} 118 119float Matrix4::getTranslateX() { 120 return data[12]; 121} 122 123float Matrix4::getTranslateY() { 124 return data[13]; 125} 126 127void Matrix4::loadTranslate(float x, float y, float z) { 128 loadIdentity(); 129 data[12] = x; 130 data[13] = y; 131 data[14] = z; 132} 133 134void Matrix4::loadScale(float sx, float sy, float sz) { 135 loadIdentity(); 136 data[0] = sx; 137 data[5] = sy; 138 data[10] = sz; 139} 140 141void Matrix4::loadRotate(float angle, float x, float y, float z) { 142 data[3] = 0.0f; 143 data[7] = 0.0f; 144 data[11] = 0.0f; 145 data[12] = 0.0f; 146 data[13] = 0.0f; 147 data[14] = 0.0f; 148 data[15] = 1.0f; 149 150 angle *= float(M_PI / 180.0f); 151 float c = cosf(angle); 152 float s = sinf(angle); 153 154 const float length = sqrtf(x * x + y * y + z * z); 155 float recipLen = 1.0f / length; 156 x *= recipLen; 157 y *= recipLen; 158 z *= recipLen; 159 160 const float nc = 1.0f - c; 161 const float xy = x * y; 162 const float yz = y * z; 163 const float zx = z * x; 164 const float xs = x * s; 165 const float ys = y * s; 166 const float zs = z * s; 167 168 data[0] = x * x * nc + c; 169 data[4] = xy * nc - zs; 170 data[8] = zx * nc + ys; 171 data[1] = xy * nc + zs; 172 data[5] = y * y * nc + c; 173 data[9] = yz * nc - xs; 174 data[2] = zx * nc - ys; 175 data[6] = yz * nc + xs; 176 data[10] = z * z * nc + c; 177} 178 179void Matrix4::loadMultiply(const Matrix4& u, const Matrix4& v) { 180 for (int i = 0 ; i < 4 ; i++) { 181 float x = 0; 182 float y = 0; 183 float z = 0; 184 float w = 0; 185 186 for (int j = 0 ; j < 4 ; j++) { 187 const float e = v.get(i, j); 188 x += u.get(j, 0) * e; 189 y += u.get(j, 1) * e; 190 z += u.get(j, 2) * e; 191 w += u.get(j, 3) * e; 192 } 193 194 set(i, 0, x); 195 set(i, 1, y); 196 set(i, 2, z); 197 set(i, 3, w); 198 } 199} 200 201void Matrix4::loadOrtho(float left, float right, float bottom, float top, float near, float far) { 202 loadIdentity(); 203 data[0] = 2.0f / (right - left); 204 data[5] = 2.0f / (top - bottom); 205 data[10] = -2.0f / (far - near); 206 data[12] = -(right + left) / (right - left); 207 data[13] = -(top + bottom) / (top - bottom); 208 data[14] = -(far + near) / (far - near); 209} 210 211#define MUL_ADD_STORE(a, b, c) a = (a) * (b) + (c) 212 213void Matrix4::mapRect(Rect& r) const { 214 const float sx = data[0]; 215 const float sy = data[5]; 216 217 const float tx = data[12]; 218 const float ty = data[13]; 219 220 MUL_ADD_STORE(r.left, sx, tx); 221 MUL_ADD_STORE(r.right, sx, tx); 222 MUL_ADD_STORE(r.top, sy, ty); 223 MUL_ADD_STORE(r.bottom, sy, ty); 224} 225 226void Matrix4::dump() const { 227 LOGD("Matrix4["); 228 LOGD(" %f %f %f %f", data[0], data[4], data[ 8], data[12]); 229 LOGD(" %f %f %f %f", data[1], data[5], data[ 9], data[13]); 230 LOGD(" %f %f %f %f", data[2], data[6], data[10], data[14]); 231 LOGD(" %f %f %f %f", data[3], data[7], data[11], data[15]); 232 LOGD("]"); 233} 234 235}; // namespace uirenderer 236}; // namespace android 237