2 * Copyright (c) 2021 Samsung Electronics Co., Ltd. All rights reserved.
4 * Permission is hereby granted, free of charge, to any person obtaining a copy
5 * of this software and associated documentation files (the "Software"), to deal
6 * in the Software without restriction, including without limitation the rights
7 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
8 * copies of the Software, and to permit persons to whom the Software is
9 * furnished to do so, subject to the following conditions:
11 * The above copyright notice and this permission notice shall be included in all
12 * copies or substantial portions of the Software.
14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
17 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
18 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
19 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
25 #define _USE_MATH_DEFINES
29 #include "tvgCommon.h"
32 static inline bool mathZero(float a)
34 return (fabsf(a) < FLT_EPSILON) ? true : false;
38 static inline bool mathEqual(float a, float b)
40 return (fabsf(a - b) < FLT_EPSILON);
44 static inline bool mathRightAngle(const Matrix* m)
46 auto radian = fabsf(atan2(m->e21, m->e11));
47 if (radian < FLT_EPSILON || mathEqual(radian, float(M_PI_2)) || mathEqual(radian, float(M_PI))) return true;
52 static inline bool mathIdentity(const Matrix* m)
54 if (!mathEqual(m->e11, 1.0f) || !mathZero(m->e12) || !mathZero(m->e13) ||
55 !mathZero(m->e21) || !mathEqual(m->e22, 1.0f) || !mathZero(m->e23) ||
56 !mathZero(m->e31) || !mathZero(m->e32) || !mathEqual(m->e33, 1.0f)) {
63 static inline bool mathInverse(const Matrix* m, Matrix* out)
65 auto det = m->e11 * (m->e22 * m->e33 - m->e32 * m->e23) -
66 m->e12 * (m->e21 * m->e33 - m->e23 * m->e31) +
67 m->e13 * (m->e21 * m->e32 - m->e22 * m->e31);
69 if (mathZero(det)) return false;
71 auto invDet = 1 / det;
73 out->e11 = (m->e22 * m->e33 - m->e32 * m->e23) * invDet;
74 out->e12 = (m->e13 * m->e32 - m->e12 * m->e33) * invDet;
75 out->e13 = (m->e12 * m->e23 - m->e13 * m->e22) * invDet;
76 out->e21 = (m->e23 * m->e31 - m->e21 * m->e33) * invDet;
77 out->e22 = (m->e11 * m->e33 - m->e13 * m->e31) * invDet;
78 out->e23 = (m->e21 * m->e13 - m->e11 * m->e23) * invDet;
79 out->e31 = (m->e21 * m->e32 - m->e31 * m->e22) * invDet;
80 out->e32 = (m->e31 * m->e12 - m->e11 * m->e32) * invDet;
81 out->e33 = (m->e11 * m->e22 - m->e21 * m->e12) * invDet;
87 static inline void mathIdentity(Matrix* m)
101 static inline void mathScale(Matrix* m, float scale)
108 static inline void mathTranslate(Matrix* m, float x, float y)
115 static inline void mathRotate(Matrix* m, float degree)
117 auto radian = degree / 180.0f * M_PI;
118 auto cosVal = cosf(radian);
119 auto sinVal = sinf(radian);
121 m->e12 = m->e11 * -sinVal;
123 m->e21 = m->e22 * sinVal;
128 static inline void mathMultiply(Point* pt, const Matrix* transform)
130 auto tx = pt->x * transform->e11 + pt->y * transform->e12 + transform->e13;
131 auto ty = pt->x * transform->e21 + pt->y * transform->e22 + transform->e23;
137 static inline Matrix mathMultiply(const Matrix* lhs, const Matrix* rhs)
141 m.e11 = lhs->e11 * rhs->e11 + lhs->e12 * rhs->e21 + lhs->e13 * rhs->e31;
142 m.e12 = lhs->e11 * rhs->e12 + lhs->e12 * rhs->e22 + lhs->e13 * rhs->e32;
143 m.e13 = lhs->e11 * rhs->e13 + lhs->e12 * rhs->e23 + lhs->e13 * rhs->e33;
145 m.e21 = lhs->e21 * rhs->e11 + lhs->e22 * rhs->e21 + lhs->e23 * rhs->e31;
146 m.e22 = lhs->e21 * rhs->e12 + lhs->e22 * rhs->e22 + lhs->e23 * rhs->e32;
147 m.e23 = lhs->e21 * rhs->e13 + lhs->e22 * rhs->e23 + lhs->e23 * rhs->e33;
149 m.e31 = lhs->e31 * rhs->e11 + lhs->e32 * rhs->e21 + lhs->e33 * rhs->e31;
150 m.e32 = lhs->e31 * rhs->e12 + lhs->e32 * rhs->e22 + lhs->e33 * rhs->e32;
151 m.e33 = lhs->e31 * rhs->e13 + lhs->e32 * rhs->e23 + lhs->e33 * rhs->e33;
157 #endif //_TVG_MATH_H_