1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
|
/*
* vim: ts=4 sw=4 et tw=0 wm=0
*
* libavoid - Fast, Incremental, Object-avoiding Line Router
*
* Copyright (C) 2004-2011 Monash University
*
* --------------------------------------------------------------------
* Much of the code in this module is based on code published with
* and/or described in "Computational Geometry in C" (Second Edition),
* Copyright (C) 1998 Joseph O'Rourke <orourke@cs.smith.edu>
* --------------------------------------------------------------------
* The segmentIntersectPoint function is based on code published and
* described in Franklin Antonio, Faster Line Segment Intersection,
* Graphics Gems III, p. 199-202, code: p. 500-501.
* --------------------------------------------------------------------
*
* This library is free software; you can redistribute it and/or
* modify it under the terms of the GNU Lesser General Public
* License as published by the Free Software Foundation; either
* version 2.1 of the License, or (at your option) any later version.
* See the file LICENSE.LGPL distributed with the library.
*
* Licensees holding a valid commercial license may use this file in
* accordance with the commercial license agreement provided with the
* library.
*
* This library is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
*
* Author(s): Michael Wybrow
*/
#ifndef AVOID_GEOMETRY_H
#define AVOID_GEOMETRY_H
#include "libavoid/geomtypes.h"
#include "libavoid/assertions.h"
namespace Avoid {
extern double euclideanDist(const Point& a, const Point& b);
extern double manhattanDist(const Point& a, const Point& b);
extern double totalLength(const Polygon& poly);
extern double angle(const Point& a, const Point& b, const Point& c);
extern bool segmentIntersect(const Point& a, const Point& b,
const Point& c, const Point& d);
extern bool segmentShapeIntersect(const Point& e1, const Point& e2,
const Point& s1, const Point& s2, bool& seenIntersectionAtEndpoint);
extern bool inPoly(const Polygon& poly, const Point& q, bool countBorder = true);
extern bool inPolyGen(const PolygonInterface& poly, const Point& q);
extern bool inValidRegion(bool IgnoreRegions, const Point& a0,
const Point& a1, const Point& a2, const Point& b);
extern int cornerSide(const Point &c1, const Point &c2, const Point &c3,
const Point& p);
extern bool pointOnLine(const Point& a, const Point& b, const Point& c,
const double tolerance = 0.0);
extern bool colinear(const Point& a, const Point& b, const Point& c,
const double tolerance = 0.0);
// To be used only when the points are known to be colinear.
extern bool inBetween(const Point& a, const Point& b, const Point& c);
// Direction from vector.
// Looks at the position of point c from the directed segment ab and
// returns the following:
// 1 counterclockwise
// 0 collinear
// -1 clockwise
//
// Based on the code of 'AreaSign'.
//
// The 'maybeZero' argument can be used to adjust the tolerance of the
// function. It will be most accurate when 'maybeZero' == 0.0, the default.
//
static inline int vecDir(const Point& a, const Point& b, const Point& c,
const double maybeZero = 0.0)
{
COLA_ASSERT(maybeZero >= 0);
double area2 = ((b.x - a.x) * (c.y - a.y)) -
((c.x - a.x) * (b.y - a.y));
if (area2 < (-maybeZero))
{
return -1;
}
else if (area2 > maybeZero)
{
return 1;
}
return 0;
}
// Finds the projection point of (a,b) onto (a,c)
static inline Point projection(const Point& a, const Point& b, const Point& c)
{
double ux = c.x - a.x,
uy = c.y - a.y,
vx = b.x - a.x,
vy = b.y - a.y,
scalarProj = ux * vx + uy * vy;
scalarProj /= ux * ux + uy * uy;
Point p;
p.x = scalarProj * ux + a.x;
p.y = scalarProj * uy + a.y;
return p;
}
// Line Segment Intersection
// Original code by Franklin Antonio
//
static const int DONT_INTERSECT = 0;
static const int DO_INTERSECT = 1;
static const int PARALLEL = 3;
extern int segmentIntersectPoint(const Point& a1, const Point& a2,
const Point& b1, const Point& b2, double *x, double *y);
extern int rayIntersectPoint(const Point& a1, const Point& a2,
const Point& b1, const Point& b2, double *x, double *y);
extern double rotationalAngle(const Point& p);
}
#endif
|