Added Parallel tool + command processing.

[architektonas] / src / geometry.cpp

diff --git a/src/geometry.cpp b/src/geometry.cpp
index 31c5257d8d0aa9f39c5924224f11d40359191d7e..055c581a652a7505e9a42a97c220649385ccfe30 100644 (file)
--- a/src/geometry.cpp
+++ b/src/geometry.cpp
@@ -512,3 +512,15 @@ Point Geometry::NearestTo(Point point, Point p1, Point p2)
 
        return (l1 < l2 ? p1 : p2);
 }
+
+Vector Geometry::GetNormalOfPointAndLine(Point p, Line * l)
+{
+       Vector normal = Vector::Normal(l->p[0], l->p[1]);
+       normal.Unit();
+       double dir = Vector::Dot(p - l->p[0], normal);
+
+       if (dir < 0)
+               normal = -normal;
+
+       return normal;
+}