Matrix.cpp revision 8ce00301a023eecaeb8891ce906f67b513ebb42a
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 "utils/Compare.h" 28#include "Matrix.h" 29 30namespace android { 31namespace uirenderer { 32 33/////////////////////////////////////////////////////////////////////////////// 34// Defines 35/////////////////////////////////////////////////////////////////////////////// 36 37static const float EPSILON = 0.0000001f; 38 39/////////////////////////////////////////////////////////////////////////////// 40// Matrix 41/////////////////////////////////////////////////////////////////////////////// 42 43void Matrix4::loadIdentity() { 44 data[kScaleX] = 1.0f; 45 data[kSkewY] = 0.0f; 46 data[2] = 0.0f; 47 data[kPerspective0] = 0.0f; 48 49 data[kSkewX] = 0.0f; 50 data[kScaleY] = 1.0f; 51 data[6] = 0.0f; 52 data[kPerspective1] = 0.0f; 53 54 data[8] = 0.0f; 55 data[9] = 0.0f; 56 data[kScaleZ] = 1.0f; 57 data[11] = 0.0f; 58 59 data[kTranslateX] = 0.0f; 60 data[kTranslateY] = 0.0f; 61 data[kTranslateZ] = 0.0f; 62 data[kPerspective2] = 1.0f; 63 64 mType = kTypeIdentity | kTypeRectToRect; 65} 66 67static bool isZero(float f) { 68 return fabs(f) <= EPSILON; 69} 70 71uint32_t Matrix4::getType() const { 72 if (mType & kTypeUnknown) { 73 mType = kTypeIdentity; 74 75 if (data[kPerspective0] != 0.0f || data[kPerspective1] != 0.0f || 76 data[kPerspective2] != 1.0f) { 77 mType |= kTypePerspective; 78 } 79 80 if (data[kTranslateX] != 0.0f || data[kTranslateY] != 0.0f) { 81 mType |= kTypeTranslate; 82 } 83 84 float m00 = data[kScaleX]; 85 float m01 = data[kSkewX]; 86 float m10 = data[kSkewY]; 87 float m11 = data[kScaleY]; 88 89 if (m01 != 0.0f || m10 != 0.0f) { 90 mType |= kTypeAffine; 91 } 92 93 if (m00 != 1.0f || m11 != 1.0f) { 94 mType |= kTypeScale; 95 } 96 97 // The following section determines whether the matrix will preserve 98 // rectangles. For instance, a rectangle transformed by a pure 99 // translation matrix will result in a rectangle. A rectangle 100 // transformed by a 45 degrees rotation matrix is not a rectangle. 101 // If the matrix has a perspective component then we already know 102 // it doesn't preserve rectangles. 103 if (!(mType & kTypePerspective)) { 104 if ((isZero(m00) && isZero(m11) && !isZero(m01) && !isZero(m10)) || 105 (isZero(m01) && isZero(m10) && !isZero(m00) && !isZero(m11))) { 106 mType |= kTypeRectToRect; 107 } 108 } 109 } 110 return mType; 111} 112 113uint32_t Matrix4::getGeometryType() const { 114 return getType() & sGeometryMask; 115} 116 117bool Matrix4::rectToRect() const { 118 return getType() & kTypeRectToRect; 119} 120 121bool Matrix4::changesBounds() const { 122 return getType() & (kTypeScale | kTypeAffine | kTypePerspective); 123} 124 125bool Matrix4::isPureTranslate() const { 126 return getGeometryType() == kTypeTranslate; 127} 128 129bool Matrix4::isSimple() const { 130 return getGeometryType() <= (kTypeScale | kTypeTranslate); 131} 132 133bool Matrix4::isIdentity() const { 134 return getGeometryType() == kTypeIdentity; 135} 136 137bool Matrix4::isPerspective() const { 138 return getType() & kTypePerspective; 139} 140 141void Matrix4::load(const float* v) { 142 memcpy(data, v, sizeof(data)); 143 mType = kTypeUnknown; 144} 145 146void Matrix4::load(const Matrix4& v) { 147 memcpy(data, v.data, sizeof(data)); 148 mType = v.getType(); 149} 150 151void Matrix4::load(const SkMatrix& v) { 152 memset(data, 0, sizeof(data)); 153 154 data[kScaleX] = v[SkMatrix::kMScaleX]; 155 data[kSkewX] = v[SkMatrix::kMSkewX]; 156 data[kTranslateX] = v[SkMatrix::kMTransX]; 157 158 data[kSkewY] = v[SkMatrix::kMSkewY]; 159 data[kScaleY] = v[SkMatrix::kMScaleY]; 160 data[kTranslateY] = v[SkMatrix::kMTransY]; 161 162 data[kPerspective0] = v[SkMatrix::kMPersp0]; 163 data[kPerspective1] = v[SkMatrix::kMPersp1]; 164 data[kPerspective2] = v[SkMatrix::kMPersp2]; 165 166 data[kScaleZ] = 1.0f; 167 168 // NOTE: The flags are compatible between SkMatrix and this class. 169 // However, SkMatrix::getType() does not return the flag 170 // kRectStaysRect. The return value is masked with 0xF 171 // so we need the extra rectStaysRect() check 172 mType = v.getType(); 173 if (v.rectStaysRect()) { 174 mType |= kTypeRectToRect; 175 } 176} 177 178void Matrix4::copyTo(SkMatrix& v) const { 179 v.reset(); 180 181 v.set(SkMatrix::kMScaleX, data[kScaleX]); 182 v.set(SkMatrix::kMSkewX, data[kSkewX]); 183 v.set(SkMatrix::kMTransX, data[kTranslateX]); 184 185 v.set(SkMatrix::kMSkewY, data[kSkewY]); 186 v.set(SkMatrix::kMScaleY, data[kScaleY]); 187 v.set(SkMatrix::kMTransY, data[kTranslateY]); 188 189 v.set(SkMatrix::kMPersp0, data[kPerspective0]); 190 v.set(SkMatrix::kMPersp1, data[kPerspective1]); 191 v.set(SkMatrix::kMPersp2, data[kPerspective2]); 192} 193 194void Matrix4::loadInverse(const Matrix4& v) { 195 double scale = 1.0 / 196 (v.data[kScaleX] * ((double) v.data[kScaleY] * v.data[kPerspective2] - 197 (double) v.data[kTranslateY] * v.data[kPerspective1]) + 198 v.data[kSkewX] * ((double) v.data[kTranslateY] * v.data[kPerspective0] - 199 (double) v.data[kSkewY] * v.data[kPerspective2]) + 200 v.data[kTranslateX] * ((double) v.data[kSkewY] * v.data[kPerspective1] - 201 (double) v.data[kScaleY] * v.data[kPerspective0])); 202 203 data[kScaleX] = (v.data[kScaleY] * v.data[kPerspective2] - 204 v.data[kTranslateY] * v.data[kPerspective1]) * scale; 205 data[kSkewX] = (v.data[kTranslateX] * v.data[kPerspective1] - 206 v.data[kSkewX] * v.data[kPerspective2]) * scale; 207 data[kTranslateX] = (v.data[kSkewX] * v.data[kTranslateY] - 208 v.data[kTranslateX] * v.data[kScaleY]) * scale; 209 210 data[kSkewY] = (v.data[kTranslateY] * v.data[kPerspective0] - 211 v.data[kSkewY] * v.data[kPerspective2]) * scale; 212 data[kScaleY] = (v.data[kScaleX] * v.data[kPerspective2] - 213 v.data[kTranslateX] * v.data[kPerspective0]) * scale; 214 data[kTranslateY] = (v.data[kTranslateX] * v.data[kSkewY] - 215 v.data[kScaleX] * v.data[kTranslateY]) * scale; 216 217 data[kPerspective0] = (v.data[kSkewY] * v.data[kPerspective1] - 218 v.data[kScaleY] * v.data[kPerspective0]) * scale; 219 data[kPerspective1] = (v.data[kSkewX] * v.data[kPerspective0] - 220 v.data[kScaleX] * v.data[kPerspective1]) * scale; 221 data[kPerspective2] = (v.data[kScaleX] * v.data[kScaleY] - 222 v.data[kSkewX] * v.data[kSkewY]) * scale; 223 224 mType = kTypeUnknown; 225} 226 227void Matrix4::copyTo(float* v) const { 228 memcpy(v, data, sizeof(data)); 229} 230 231float Matrix4::getTranslateX() { 232 return data[kTranslateX]; 233} 234 235float Matrix4::getTranslateY() { 236 return data[kTranslateY]; 237} 238 239void Matrix4::multiply(float v) { 240 for (int i = 0; i < 16; i++) { 241 data[i] *= v; 242 } 243 mType = kTypeUnknown; 244} 245 246void Matrix4::loadTranslate(float x, float y, float z) { 247 loadIdentity(); 248 249 data[kTranslateX] = x; 250 data[kTranslateY] = y; 251 data[kTranslateZ] = z; 252 253 mType = kTypeTranslate | kTypeRectToRect; 254} 255 256void Matrix4::loadScale(float sx, float sy, float sz) { 257 loadIdentity(); 258 259 data[kScaleX] = sx; 260 data[kScaleY] = sy; 261 data[kScaleZ] = sz; 262 263 mType = kTypeScale | kTypeRectToRect; 264} 265 266void Matrix4::loadSkew(float sx, float sy) { 267 loadIdentity(); 268 269 data[kScaleX] = 1.0f; 270 data[kSkewX] = sx; 271 data[kTranslateX] = 0.0f; 272 273 data[kSkewY] = sy; 274 data[kScaleY] = 1.0f; 275 data[kTranslateY] = 0.0f; 276 277 data[kPerspective0] = 0.0f; 278 data[kPerspective1] = 0.0f; 279 data[kPerspective2] = 1.0f; 280 281 mType = kTypeUnknown; 282} 283 284void Matrix4::loadRotate(float angle) { 285 angle *= float(M_PI / 180.0f); 286 float c = cosf(angle); 287 float s = sinf(angle); 288 289 loadIdentity(); 290 291 data[kScaleX] = c; 292 data[kSkewX] = -s; 293 294 data[kSkewY] = s; 295 data[kScaleY] = c; 296 297 mType = kTypeUnknown; 298} 299 300void Matrix4::loadRotate(float angle, float x, float y, float z) { 301 data[kPerspective0] = 0.0f; 302 data[kPerspective1] = 0.0f; 303 data[11] = 0.0f; 304 data[kTranslateX] = 0.0f; 305 data[kTranslateY] = 0.0f; 306 data[kTranslateZ] = 0.0f; 307 data[kPerspective2] = 1.0f; 308 309 angle *= float(M_PI / 180.0f); 310 float c = cosf(angle); 311 float s = sinf(angle); 312 313 const float length = sqrtf(x * x + y * y + z * z); 314 float recipLen = 1.0f / length; 315 x *= recipLen; 316 y *= recipLen; 317 z *= recipLen; 318 319 const float nc = 1.0f - c; 320 const float xy = x * y; 321 const float yz = y * z; 322 const float zx = z * x; 323 const float xs = x * s; 324 const float ys = y * s; 325 const float zs = z * s; 326 327 data[kScaleX] = x * x * nc + c; 328 data[kSkewX] = xy * nc - zs; 329 data[8] = zx * nc + ys; 330 data[kSkewY] = xy * nc + zs; 331 data[kScaleY] = y * y * nc + c; 332 data[9] = yz * nc - xs; 333 data[2] = zx * nc - ys; 334 data[6] = yz * nc + xs; 335 data[kScaleZ] = z * z * nc + c; 336 337 mType = kTypeUnknown; 338} 339 340void Matrix4::loadMultiply(const Matrix4& u, const Matrix4& v) { 341 for (int i = 0 ; i < 4 ; i++) { 342 float x = 0; 343 float y = 0; 344 float z = 0; 345 float w = 0; 346 347 for (int j = 0 ; j < 4 ; j++) { 348 const float e = v.get(i, j); 349 x += u.get(j, 0) * e; 350 y += u.get(j, 1) * e; 351 z += u.get(j, 2) * e; 352 w += u.get(j, 3) * e; 353 } 354 355 set(i, 0, x); 356 set(i, 1, y); 357 set(i, 2, z); 358 set(i, 3, w); 359 } 360 361 mType = kTypeUnknown; 362} 363 364void Matrix4::loadOrtho(float left, float right, float bottom, float top, float near, float far) { 365 loadIdentity(); 366 367 data[kScaleX] = 2.0f / (right - left); 368 data[kScaleY] = 2.0f / (top - bottom); 369 data[kScaleZ] = -2.0f / (far - near); 370 data[kTranslateX] = -(right + left) / (right - left); 371 data[kTranslateY] = -(top + bottom) / (top - bottom); 372 data[kTranslateZ] = -(far + near) / (far - near); 373 374 mType = kTypeTranslate | kTypeScale | kTypeRectToRect; 375} 376 377#define MUL_ADD_STORE(a, b, c) a = (a) * (b) + (c) 378 379void Matrix4::mapPoint(float& x, float& y) const { 380 if (isSimple()) { 381 MUL_ADD_STORE(x, data[kScaleX], data[kTranslateX]); 382 MUL_ADD_STORE(y, data[kScaleY], data[kTranslateY]); 383 return; 384 } 385 386 float dx = x * data[kScaleX] + y * data[kSkewX] + data[kTranslateX]; 387 float dy = x * data[kSkewY] + y * data[kScaleY] + data[kTranslateY]; 388 float dz = x * data[kPerspective0] + y * data[kPerspective1] + data[kPerspective2]; 389 if (dz) dz = 1.0f / dz; 390 391 x = dx * dz; 392 y = dy * dz; 393} 394 395void Matrix4::mapRect(Rect& r) const { 396 if (isSimple()) { 397 MUL_ADD_STORE(r.left, data[kScaleX], data[kTranslateX]); 398 MUL_ADD_STORE(r.right, data[kScaleX], data[kTranslateX]); 399 MUL_ADD_STORE(r.top, data[kScaleY], data[kTranslateY]); 400 MUL_ADD_STORE(r.bottom, data[kScaleY], data[kTranslateY]); 401 402 if (r.left > r.right) { 403 float x = r.left; 404 r.left = r.right; 405 r.right = x; 406 } 407 408 if (r.top > r.bottom) { 409 float y = r.top; 410 r.top = r.bottom; 411 r.bottom = y; 412 } 413 414 return; 415 } 416 417 float vertices[] = { 418 r.left, r.top, 419 r.right, r.top, 420 r.right, r.bottom, 421 r.left, r.bottom 422 }; 423 424 float x, y, z; 425 426 for (int i = 0; i < 8; i+= 2) { 427 float px = vertices[i]; 428 float py = vertices[i + 1]; 429 430 x = px * data[kScaleX] + py * data[kSkewX] + data[kTranslateX]; 431 y = px * data[kSkewY] + py * data[kScaleY] + data[kTranslateY]; 432 z = px * data[kPerspective0] + py * data[kPerspective1] + data[kPerspective2]; 433 if (z) z = 1.0f / z; 434 435 vertices[i] = x * z; 436 vertices[i + 1] = y * z; 437 } 438 439 r.left = r.right = vertices[0]; 440 r.top = r.bottom = vertices[1]; 441 442 for (int i = 2; i < 8; i += 2) { 443 x = vertices[i]; 444 y = vertices[i + 1]; 445 446 if (x < r.left) r.left = x; 447 else if (x > r.right) r.right = x; 448 if (y < r.top) r.top = y; 449 else if (y > r.bottom) r.bottom = y; 450 } 451} 452 453void Matrix4::dump() const { 454 ALOGD("Matrix4[simple=%d, type=0x%x", isSimple(), getType()); 455 ALOGD(" %f %f %f %f", data[kScaleX], data[kSkewX], data[8], data[kTranslateX]); 456 ALOGD(" %f %f %f %f", data[kSkewY], data[kScaleY], data[9], data[kTranslateY]); 457 ALOGD(" %f %f %f %f", data[2], data[6], data[kScaleZ], data[kTranslateZ]); 458 ALOGD(" %f %f %f %f", data[kPerspective0], data[kPerspective1], data[11], data[kPerspective2]); 459 ALOGD("]"); 460} 461 462}; // namespace uirenderer 463}; // namespace android 464