|
65 | 65 | #include <ompl/geometric/PathGeometric.h> |
66 | 66 |
|
67 | 67 | // MAB-RRT planner |
68 | | -#include <ompl/geometric/planners/disassemblyrrt/MAB_RRT.h> |
69 | | -#include <ompl/geometric/planners/disassemblyrrt/MAB_RRT_DEBUG.h> |
| 68 | +#include <ompl/geometric/planners/rrt/MAB_RRT.h> |
70 | 69 |
|
71 | 70 | namespace ob = ompl::base; |
72 | 71 | namespace og = ompl::geometric; |
@@ -558,14 +557,12 @@ void runBugTrapDemo(const std::string& configPath, double timeout = 10.0, bool d |
558 | 557 | std::cout << "[INFO] Config file: " << configPath << std::endl; |
559 | 558 |
|
560 | 559 | std::shared_ptr<og::MAB_RRT> planner; |
561 | | - std::shared_ptr<og::MAB_RRT_DEBUG> debugPlanner; |
562 | 560 |
|
| 561 | + // Note: MAB_RRT_DEBUG is not available in this branch, using standard MAB_RRT |
563 | 562 | if (debug) { |
564 | | - debugPlanner = std::make_shared<og::MAB_RRT_DEBUG>(si, configPath); |
565 | | - planner = debugPlanner; // MAB_RRT_DEBUG inherits from MAB_RRT (note: class names not yet renamed) |
566 | | - } else { |
567 | | - planner = std::make_shared<og::MAB_RRT>(si, configPath); |
| 563 | + std::cout << "[WARNING] Debug mode requested but MAB_RRT_DEBUG not available. Using standard MAB_RRT." << std::endl; |
568 | 564 | } |
| 565 | + planner = std::make_shared<og::MAB_RRT>(si, configPath); |
569 | 566 |
|
570 | 567 | planner->setProblemDefinition(pdef); |
571 | 568 | planner->setup(); |
@@ -651,10 +648,9 @@ void runBugTrapDemo(const std::string& configPath, double timeout = 10.0, bool d |
651 | 648 | std::cout << "\n[STATS] Tree vertices: " << pdata.numVertices() << std::endl; |
652 | 649 | std::cout << "[STATS] Tree edges: " << pdata.numEdges() << std::endl; |
653 | 650 |
|
654 | | - // Export debug data if in debug mode (always to demos/disassembly/) |
655 | | - if (debug && debugPlanner) { |
656 | | - debugPlanner->exportSampleData("bugtrap_samples_debug.csv"); |
657 | | - std::cout << "[DEBUG] Sample data exported to: demos/disassembly/bugtrap_samples_debug.csv" << std::endl; |
| 651 | + // Export debug data if in debug mode (MAB_RRT_DEBUG not available in this branch) |
| 652 | + if (debug) { |
| 653 | + std::cout << "[WARNING] Debug data export not available - MAB_RRT_DEBUG not in this branch" << std::endl; |
658 | 654 | } |
659 | 655 |
|
660 | 656 | std::cout << "\n==================================================" << std::endl; |
@@ -754,17 +750,13 @@ void runOccupancyGridDemo(const std::string& configPath, |
754 | 750 | std::cout << "[INFO] Config file: " << configPath << std::endl; |
755 | 751 |
|
756 | 752 | std::shared_ptr<og::MAB_RRT> planner; |
757 | | - std::shared_ptr<og::MAB_RRT_DEBUG> debugPlanner; |
758 | 753 |
|
| 754 | + // Note: MAB_RRT_DEBUG is not available in this branch, using standard MAB_RRT |
759 | 755 | if (debug) { |
760 | | - std::cout << "[DEBUG] Creating MAB_RRT_DEBUG planner instance..." << std::endl; |
761 | | - debugPlanner = std::make_shared<og::MAB_RRT_DEBUG>(si, configPath); |
762 | | - planner = debugPlanner; |
763 | | - std::cout << "[DEBUG] MAB_RRT_DEBUG planner created successfully" << std::endl; |
764 | | - } else { |
765 | | - std::cout << "[INFO] Creating standard MAB_RRT planner (non-debug)" << std::endl; |
766 | | - planner = std::make_shared<og::MAB_RRT>(si, configPath); |
| 756 | + std::cout << "[WARNING] Debug mode requested but MAB_RRT_DEBUG not available. Using standard MAB_RRT." << std::endl; |
767 | 757 | } |
| 758 | + std::cout << "[INFO] Creating MAB_RRT planner..." << std::endl; |
| 759 | + planner = std::make_shared<og::MAB_RRT>(si, configPath); |
768 | 760 |
|
769 | 761 | planner->setProblemDefinition(pdef); |
770 | 762 | planner->setup(); |
@@ -831,11 +823,9 @@ void runOccupancyGridDemo(const std::string& configPath, |
831 | 823 | std::cout << "\n[STATS] Tree vertices: " << pdata.numVertices() << std::endl; |
832 | 824 | std::cout << "[STATS] Tree edges: " << pdata.numEdges() << std::endl; |
833 | 825 |
|
834 | | - // Export debug data if in debug mode |
835 | | - if (debug && debugPlanner) { |
836 | | - std::string samplesFile = "bugtrap_samples_debug.csv"; |
837 | | - debugPlanner->exportSampleData(samplesFile); |
838 | | - std::cout << "[DEBUG] Sample data exported to: " << samplesFile << std::endl; |
| 826 | + // Export debug data if in debug mode (MAB_RRT_DEBUG not available in this branch) |
| 827 | + if (debug) { |
| 828 | + std::cout << "[WARNING] Debug data export not available - MAB_RRT_DEBUG not in this branch" << std::endl; |
839 | 829 | } |
840 | 830 |
|
841 | 831 | std::cout << "\n==================================================" << std::endl; |
|
0 commit comments