DuongTD/common_msgs
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

add file nav_msgs

Browse Source
This commit is contained in:
duongtd
2025-11-13 16:51:49 +07:00
parent d06cb812ee
commit 4c8e350dac
7 changed files with 93 additions and 47 deletions
Download Patch File Download Diff File Expand all files Collapse all files

32
sensor_msgs/test/main.cpp
View File

@@ -2,38 +2,6 @@
#include "sensor_msgs/JoyFeedbackArray.h"
#include "sensor_msgs/PointCloud2.h"
#include <iostream>
// #include <yaml-cpp/yaml.h>
// bool getParams()
// {
// try {
// YAML::Node config = YAML::LoadFile("../cfg/config.yaml");
// double cost_scaling_factor = config["inflation_layer"]["cost_scaling_factor"].as<double>();
// double inflation_radius = config["inflation_layer"]["inflation_radius"].as<double>();
// bool enabled = config["inflation_layer"]["enabled"].as<bool>();
// bool inflate_unknown = config["inflation_layer"]["inflate_unknown"].as<bool>();
// double distance = config["obstacle_layer"]["distance"].as<double>();
// std::cout << "Inflation Layer Parameters:" << std::endl;
// std::cout << " Cost Scaling Factor: " << cost_scaling_factor << std::endl;
// std::cout << " Inflation Radius: " << inflation_radius << std::endl;
// std::cout << " Enabled: " << (enabled ? "true" : "false") << std::endl;
// std::cout << " Inflate Unknown: " << (inflate_unknown ? "true" : "false") << std::endl;
// std::cout << "Obstacle Layer Parameters:" << std::endl;
// std::cout << " Distance: " << distance << std::endl;
// }
// catch (const YAML::BadFile& e) {
// std::cerr << "Cannot open YAML file: " << e.what() << std::endl;
// return false;
// }
// return true;
// }
int main()
{