Solve find angle todo

diff --git a/src/psp.cc b/src/psp.cc
index 7f1f2b7d28f05c6046d1db2abfab5dd3565041f2..6fa3d1861173c6b9127b0d74211990c6eef17978 100644 (file)
--- a/src/psp.cc
+++ b/src/psp.cc
@@ -394,7 +394,11 @@ void PSPlanner::fe_parallel()
                         xf = std::get<3>(clif);
                         yf = std::get<4>(clif);
                 }
-                // TODO find angle: intersection, ccl, p1
+                double af = ::intersection(
+                        xf, yf,
+                        cclx, ccly,
+                        this->ps().x1(), this->ps().y1()
+                );
                 // TODO rotate by such angle
         }
 }