Add todo

diff --git a/src/psp.cc b/src/psp.cc
index 348960691829d2c5234f4fc4bd30f9033c444168..2dd06c0623fc16f9efc3d48bd43c0f39094b01c0 100644 (file)
--- a/src/psp.cc
+++ b/src/psp.cc
@@ -438,11 +438,13 @@ void PSPlanner::fe_parallel()
                         } else {
                             continue;
                         }
+                        // TODO if cc.h < ps.h --> continue
                 } else if (this->ps().right() && this->cc().sp() > 0) {
                         std::cerr << "forw " << iter_cntr << std::endl;
                         double ccrx = this->cc().ccr().x();
                         double ccry = this->cc().ccr().y();
 
+                        // TODO can I park by moving forward?
                         double r1 = sqrt(
                             pow(this->cc().rfy() - ccry, 2)
                             + pow(this->cc().rfx() - ccrx, 2)