fix: plan from cur_pt when ssep search succeed.
fix: wbca boundary bug.
fix: crash issue.
fix: esdf_map=nullptr
fix: lon_decision, using prediction for v > 8km/h