blob: deb04252579990e5a6270c8f7221a96a96222f96 [file] [log] [blame]
Satoshi Kataoka6b4a1d72012-08-10 15:42:56 +09001/*
2 * Copyright (C) 2012 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
Ken Wakasa507113a2012-08-13 11:36:41 +090017#ifndef LATINIME_GEOMETRY_UTILS_H
18#define LATINIME_GEOMETRY_UTILS_H
Satoshi Kataoka6b4a1d72012-08-10 15:42:56 +090019
20#include <cmath>
21
22#define MAX_DISTANCE 10000000
Satoshi Kataoka6b4a1d72012-08-10 15:42:56 +090023#define MAX_PATHS 2
24
25#define DEBUG_DECODER false
26
Ken Wakasabcec82d2012-08-12 11:10:48 +090027#define M_PI_F 3.14159265f
28
Satoshi Kataoka6b4a1d72012-08-10 15:42:56 +090029namespace latinime {
30
Ken Wakasa0fb95082012-08-13 17:31:46 +090031static inline float squareFloat(float x) {
Satoshi Kataoka6b4a1d72012-08-10 15:42:56 +090032 return x * x;
33}
34
Ken Wakasa0fb95082012-08-13 17:31:46 +090035static inline float getNormalizedSquaredDistanceFloat(float x1, float y1, float x2, float y2,
36 float scale) {
37 return squareFloat((x1 - x2) / scale) + squareFloat((y1 - y2) / scale);
Satoshi Kataoka6b4a1d72012-08-10 15:42:56 +090038}
39
Ken Wakasa0fb95082012-08-13 17:31:46 +090040static inline float getSquaredDistanceFloat(float x1, float y1, float x2, float y2) {
41 return squareFloat(x1 - x2) + squareFloat(y1 - y2);
42}
43
44static inline float getDistanceFloat(float x1, float y1, float x2, float y2) {
45 return hypotf(x1 - x2, y1 - y2);
Satoshi Kataoka6b4a1d72012-08-10 15:42:56 +090046}
47
Ken Wakasabcec82d2012-08-12 11:10:48 +090048static inline int getDistanceInt(int x1, int y1, int x2, int y2) {
Ken Wakasa0fb95082012-08-13 17:31:46 +090049 return static_cast<int>(getDistanceFloat(static_cast<float>(x1), static_cast<float>(y1),
50 static_cast<float>(x2), static_cast<float>(y2)));
Satoshi Kataoka6b4a1d72012-08-10 15:42:56 +090051}
52
53static inline float getAngle(int x1, int y1, int x2, int y2) {
Ken Wakasa507113a2012-08-13 11:36:41 +090054 const int dx = x1 - x2;
55 const int dy = y1 - y2;
Ken Wakasa0fb95082012-08-13 17:31:46 +090056 if (dx == 0 && dy == 0) return 0;
57 return atan2f(static_cast<float>(dy), static_cast<float>(dx));
Satoshi Kataoka6b4a1d72012-08-10 15:42:56 +090058}
59
Ken Wakasa0fb95082012-08-13 17:31:46 +090060static inline float getAngleDiff(float a1, float a2) {
Ken Wakasa507113a2012-08-13 11:36:41 +090061 const float diff = fabsf(a1 - a2);
Ken Wakasabcec82d2012-08-12 11:10:48 +090062 if (diff > M_PI_F) {
63 return 2.0f * M_PI_F - diff;
Satoshi Kataoka6b4a1d72012-08-10 15:42:56 +090064 }
65 return diff;
66}
67
Ken Wakasa0fb95082012-08-13 17:31:46 +090068// static float pointToLineSegSquaredDistanceFloat(
Ken Wakasabcec82d2012-08-12 11:10:48 +090069// float x, float y, float x1, float y1, float x2, float y2) {
70// float A = x - x1;
71// float B = y - y1;
72// float C = x2 - x1;
73// float D = y2 - y1;
Ken Wakasa507113a2012-08-13 11:36:41 +090074// return fabsf(A * D - C * B) / sqrtf(C * C + D * D);
Ken Wakasabcec82d2012-08-12 11:10:48 +090075// }
Satoshi Kataoka6b4a1d72012-08-10 15:42:56 +090076
Ken Wakasa0fb95082012-08-13 17:31:46 +090077static inline float pointToLineSegSquaredDistanceFloat(
Satoshi Kataoka6b4a1d72012-08-10 15:42:56 +090078 float x, float y, float x1, float y1, float x2, float y2) {
Ken Wakasa507113a2012-08-13 11:36:41 +090079 const float ray1x = x - x1;
80 const float ray1y = y - y1;
81 const float ray2x = x2 - x1;
82 const float ray2y = y2 - y1;
Satoshi Kataoka6b4a1d72012-08-10 15:42:56 +090083
Ken Wakasa507113a2012-08-13 11:36:41 +090084 const float dotProduct = ray1x * ray2x + ray1y * ray2y;
Ken Wakasa0fb95082012-08-13 17:31:46 +090085 const float lineLengthSqr = squareFloat(ray2x) + squareFloat(ray2y);
Ken Wakasa507113a2012-08-13 11:36:41 +090086 const float projectionLengthSqr = dotProduct / lineLengthSqr;
Satoshi Kataoka6b4a1d72012-08-10 15:42:56 +090087
Ken Wakasa507113a2012-08-13 11:36:41 +090088 float projectionX;
89 float projectionY;
90 if (projectionLengthSqr < 0.0f) {
Satoshi Kataoka6b4a1d72012-08-10 15:42:56 +090091 projectionX = x1;
92 projectionY = y1;
Ken Wakasa507113a2012-08-13 11:36:41 +090093 } else if (projectionLengthSqr > 1.0f) {
Satoshi Kataoka6b4a1d72012-08-10 15:42:56 +090094 projectionX = x2;
95 projectionY = y2;
96 } else {
Ken Wakasa507113a2012-08-13 11:36:41 +090097 projectionX = x1 + projectionLengthSqr * ray2x;
98 projectionY = y1 + projectionLengthSqr * ray2y;
Satoshi Kataoka6b4a1d72012-08-10 15:42:56 +090099 }
Ken Wakasa0fb95082012-08-13 17:31:46 +0900100 return getSquaredDistanceFloat(x, y, projectionX, projectionY);
Satoshi Kataoka6b4a1d72012-08-10 15:42:56 +0900101}
102} // namespace latinime
Ken Wakasa507113a2012-08-13 11:36:41 +0900103#endif // LATINIME_GEOMETRY_UTILS_H