Create 2d-line-intersection.cpp

algorithms/computational-geometry/2d-line-intersection.cpp

@@ -0,0 +1,25 @@
+#include <vector>
+
+// Equation of 2D line is in form ax +by +c =0
+std::vector<float> line_intersection_2d(float a1, float b1, float c1, 
+    float a2, float b2, float c2, float slopeTol = 0.01)
+{
+    std::vector<float> intersectonPt;
+
+    float slopeDiff = ((a1/b1)-(a2/b2));
+    if(slopeDiff<0)
+    {
+        slopeDiff *=-1;
+    }
+    //Checking if lines are parallel
+    if(slopeDiff < slopeTol )
+    {
+        //if parallel, return empty vector
+        return intersectonPt;
+    }
+    float x = (b1*c2-b2*c1)/(a1*b2-a2*b1);
+    float y = (c1*a2-c2*a1)/(a1*b2-a2*b1);
+    intersectonPt.push_back(x);
+    intersectonPt.push_back(y);
+    return intersectonPt;
+}