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