|
| 1 | +diff --git a/detect_aruco_markers_behavior/src/detect_aruco_markers_behavior.cpp b/detect_aruco_markers_behavior/src/detect_aruco_markers_behavior.cpp |
| 2 | +index ce4a7522..640e5a3a 100644 |
| 3 | +--- a/detect_aruco_markers_behavior/src/detect_aruco_markers_behavior.cpp |
| 4 | ++++ b/detect_aruco_markers_behavior/src/detect_aruco_markers_behavior.cpp |
| 5 | +@@ -85,8 +85,9 @@ void DetectArucoMarkersBehavior::loadParameters() |
| 6 | + RCLCPP_INFO(get_logger(), "Params: aruco_size: %.3f m", aruco_size_); |
| 7 | + |
| 8 | + // TODO(david): Load dictionary from param |
| 9 | +- aruco_dict_ = cv::aruco::getPredefinedDictionary(cv::aruco::DICT_6X6_250); |
| 10 | ++ //aruco_dict_ = cv::aruco::getPredefinedDictionary(cv::aruco::DICT_6X6_250); |
| 11 | + // aruco_dict_ = cv::aruco::getPredefinedDictionary(cv::aruco::DICT_5X5_1000); |
| 12 | ++ aruco_dict_ = cv::makePtr<cv::aruco::Dictionary>(cv::aruco::getPredefinedDictionary(cv::aruco::DICT_6X6_250)); |
| 13 | + } |
| 14 | + |
| 15 | + // SIMULATION |
| 16 | +@@ -161,7 +162,8 @@ void DetectArucoMarkersBehavior::imageCallback(const sensor_msgs::msg::Image::Sh |
| 17 | + // init ArUco detection |
| 18 | + std::vector<int> marker_ids; |
| 19 | + std::vector<std::vector<cv::Point2f>> marker_corners, rejected_candidates; |
| 20 | +- cv::Ptr<cv::aruco::DetectorParameters> detector_params = cv::aruco::DetectorParameters::create(); |
| 21 | ++ //cv::Ptr<cv::aruco::DetectorParameters> detector_params = cv::aruco::DetectorParameters::create(); |
| 22 | ++ cv::Ptr<cv::aruco::DetectorParameters> detector_params = cv::makePtr<cv::aruco::DetectorParameters>(); |
| 23 | + |
| 24 | + // detect markers on the fisheye, it's no worth it to detect over the rectified image |
| 25 | + cv::aruco::detectMarkers( |
| 26 | +diff --git a/CMakeLists.txt b/CMakeLists.txt |
| 27 | +index 643ca101..612f51c3 100644 |
| 28 | +--- a/CMakeLists.txt |
| 29 | ++++ b/CMakeLists.txt |
| 30 | +@@ -35,6 +35,7 @@ set(PROJECT_DEPENDENCIES |
| 31 | + foreach(DEPENDENCY ${PROJECT_DEPENDENCIES}) |
| 32 | + find_package(${DEPENDENCY} REQUIRED) |
| 33 | + endforeach() |
| 34 | ++find_package(GeographicLib REQUIRED) |
| 35 | + |
| 36 | + # List of behaviors |
| 37 | + set(BEHAVIORS_LIST |
0 commit comments