sem/5g_drone_ROS2
1
0
Fork 0
Code Issues 1 Pull Requests 1 Actions Packages Projects Releases Wiki Activity

add imu data to message

Browse Source
This commit is contained in:
Sem van der Hoeven
2023-04-20 11:50:24 +02:00
parent cedff67864
commit 16192c6c8b
1 changed files with 11 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

13
src/object_detection/src/lidar_reader.cpp
View File

@@ -52,7 +52,7 @@ public:
: Node("lidar_reader") : Node("lidar_reader")
{ {
publisher_ = this->create_publisher<object_detection::msg::LidarReading>("drone/object_detection", 10); publisher_ = this->create_publisher<object_detection::msg::LidarReading>("drone/object_detection", 10);
timer_ = this->create_wall_timer(500ms, std::bind(&LidarReader::timer_callback, this)); timer_ = this->create_wall_timer(500ms, std::bind(&LidarReader::read_lidar_data, this));
ITerarangerTowerEvo::ImuMode mode(ITerarangerTowerEvo::QuaternionLinearAcc); ITerarangerTowerEvo::ImuMode mode(ITerarangerTowerEvo::QuaternionLinearAcc);
@@ -75,11 +75,20 @@ public:
} }
private: private:
void timer_callback() void read_lidar_data()
{ {
//TODO publish message with all data from lidar //TODO publish message with all data from lidar
std::cout << "Distance = " << tower->getDistance() << std::endl; std::cout << "Distance = " << tower->getDistance() << std::endl;
std::cout << "IMU = " << tower->getImuData() << std::endl; std::cout << "IMU = " << tower->getImuData() << std::endl;
auto message = object_detection::msg::LidarReading msg;
ImuData imu_data = tower->getImuData();
for (size_t i = 0; i < imu_data.data.size(); i++)
{
msg.imu_data.push_back(imu_data.data[i]);
}
} }
rclcpp::Publisher<object_detection::msg::LidarReading>::SharedPtr publisher_; rclcpp::Publisher<object_detection::msg::LidarReading>::SharedPtr publisher_;