diff --git a/src/merge_path_calc.cpp b/src/merge_path_calc.cpp index afa2aa8..f764ce0 100755 --- a/src/merge_path_calc.cpp +++ b/src/merge_path_calc.cpp @@ -177,9 +177,9 @@ namespace custom_planner { // Các hằng số chung cho cả START và GOAL static const double MAX_DISTANCE = 1.0; // Ngưỡng khoảng cách tối đa (m) static const double MIN_DISTANCE = 0.1; // Khoảng cách tối thiểu (m) - static const double MIN_SCALE = 0.2; // Giá trị tối thiểu của hệ số + static const double MIN_SCALE = 0.5; // Giá trị tối thiểu của hệ số static const double MAX_SCALE = 1.0; // Giá trị tối đa của hệ số - static const double MAX_ANGLE_THRESHOLD = 0.77 * M_PI; // Ngưỡng góc tối đa + static const double MAX_ANGLE_THRESHOLD = 0.95 * M_PI; // Ngưỡng góc tối đa int nearest_idx = 0; @@ -218,7 +218,7 @@ namespace custom_planner { (MAX_DISTANCE - MIN_DISTANCE); // === BƯỚC 3: TÍNH TOÁN NGƯỠNG GÓC === - double angle_threshold = (0.5 + std::abs(scale)) * 0.5 * M_PI; + double angle_threshold = (1.0 + std::abs(scale)) * 0.5 * M_PI; if(angle_threshold >= MAX_ANGLE_THRESHOLD) angle_threshold = MAX_ANGLE_THRESHOLD;