-
Notifications
You must be signed in to change notification settings - Fork 1
/
planarline.cpp
67 lines (57 loc) · 1.54 KB
/
planarline.cpp
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
#include "planarline.h"
PlanarLine::PlanarLine()
{
}
PlanarLine::PlanarLine(const Complex & p1, const Complex & p2)
{
if (p1 == p2)
{
throw(QString("Error in PlanarLine::PlanarLine: identical endpoints"));
}
point = p1;
direction = p1 - p2;
}
void PlanarLine::getPointAndDirection(Complex & point, Complex & direction) const
{
point = this->point;
direction = this->direction;
}
void PlanarLine::setPointAndDirection(Complex & point, Complex & direction)
{
if (direction == 0.0)
{
throw(QString("Error in PlanarLine::setPointAndDirection: direction cannot be zero"));
}
this->point = point;
this->direction = direction;
}
void PlanarLine::setPerpendicularBisector(const Complex &z1, const Complex &z2)
{
if (z1 == z2)
{
throw(QString("Error in PlanarLine::setPerpendicularBisector: identical points"));
}
point = (z1 + z2) / 2.0;
direction = I*(z1 - z2) / 2.0;
}
bool PlanarLine::contains(const Complex & z) const
{
return (imag((z - point) / direction) == 0);
}
Complex PlanarLine::getDirection() const
{
return direction;
}
bool intersectionPlanarLines(const PlanarLine & l1, const PlanarLine & l2, Complex & output)
{
Complex p1, p2, d1, d2;
l1.getPointAndDirection(p1,d1);
l2.getPointAndDirection(p2,d2);
if (imag(d1 / d2) == 0.0 && !l2.contains(p1))
{
return false;
}
double t = ((real(d1)*imag(p1 - p2)) + (imag(d1)*real(p1 - p2))) / ((real(d1)*imag(d2)) - (imag(d1)*real(d2)));
output = p2 + t*d2;
return true;
}