From 3630a720c2af961bb8066d8c24d651b7cb7288fa Mon Sep 17 00:00:00 2001 From: Jiri Vlasak Date: Fri, 3 Jul 2020 14:56:34 +0200 Subject: [PATCH] Add todo --- src/psp.cc | 2 ++ 1 file changed, 2 insertions(+) diff --git a/src/psp.cc b/src/psp.cc index 3489606..2dd06c0 100644 --- 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) -- 2.39.2