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