path_optimizer icon indicating copy to clipboard operation
path_optimizer copied to clipboard

Point is feasible or not in DP process

Open bryanibit opened this issue 3 years ago • 0 comments

I don't know the rule for choosing infeasible or feasible points in DP process as shown in function 'graphSearchDp(PathOptimizationNS::ReferencePath *)' of file named reference_path_smoother.cpp.

if ((ref_curvature < 0 && cur_l < ref_r) || (ref_curvature > 0 && cur_l > ref_r)
                || dp_point.dis_to_obs_ < search_threshold) {
                dp_point.is_feasible_ = false;
            }
            if (i == 0 && dp_point.lateral_index_ != start_lateral_index) dp_point.is_feasible_ = false;
            if (i == 0 && dp_point.lateral_index_ == start_lateral_index) {
                dp_point.is_feasible_ = true;
                dp_point.dir_ = start_state_.z;
                dp_point.cost_ = 0.0;
            }

Could you please explain that for me? Thank you so much!!

bryanibit avatar Jun 23 '22 16:06 bryanibit