xiaoyan159/vtm
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

add GeometryUtils.squareSegmentDistance()

Browse Source
This commit is contained in:
Hannes Janetzek 2014-01-25 10:05:33 +01:00
parent 44fc754b6f
commit 7ae8ee4405
1 changed files with 28 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

28
vtm/src/org/oscim/utils/GeometryUtils.java
View File

@ -76,4 +76,32 @@ public final class GeometryUtils {
return (area < 0 ? -area : area) * 0.5f;
}
/** square distance from a point a to a segment b,c */
// modified from https://github.com/ekeneijeoma/simplify-java
public static float squareSegmentDistance(float[] p, int a, int b, int c) {
float x = p[b];
float y = p[b + 1];
float dx = p[c] - x;
float dy = p[c + 1] - y;
if (dx != 0 || dy != 0) {
float t = ((p[a] - x) * dx + (p[a + 1] - y) * dy) / (dx * dx + dy * dy);
if (t > 1) {
x = p[c];
y = p[c + 1];
} else if (t > 0) {
x += dx * t;
y += dy * t;
}
}
dx = p[a] - x;
dy = p[a + 1] - y;
return dx * dx + dy * dy;
}
}