From 46eca414921300daea297b905b313679d6155591 Mon Sep 17 00:00:00 2001 From: Ruixiang Du Date: Thu, 2 Apr 2020 11:49:52 +0800 Subject: [PATCH] removed deprecated source --- scout_base/src/imu_broadcast_node.cpp | 72 --------------------------- 1 file changed, 72 deletions(-) delete mode 100644 scout_base/src/imu_broadcast_node.cpp diff --git a/scout_base/src/imu_broadcast_node.cpp b/scout_base/src/imu_broadcast_node.cpp deleted file mode 100644 index 93169fa..0000000 --- a/scout_base/src/imu_broadcast_node.cpp +++ /dev/null @@ -1,72 +0,0 @@ -/* - * imu_broadcast_node.cpp - * - * Created on: Oct 02, 2019 19:09 - * Description: - * - * Copyright (c) 2019 Ruixiang Du (rdu) - */ - -#include - -#include -#include "lcmtypes/wescore.hpp" - -#include -#include - -ros::Publisher imu_pub; - -struct MessageBroadcaster -{ - void IMULCMCallback(const lcm::ReceiveBuffer *rbuf, const std::string &chan, const wescore_lcm_msgs::IMU *msg) - { - static uint64_t count = 0; - // std::cout << "imu msg received" << std::endl; - sensor_msgs::Imu imu_msg; - imu_msg.header.frame_id = "imu_link"; - imu_msg.header.stamp = ros::Time::now(); - imu_msg.header.seq = count++; - - imu_msg.angular_velocity.x = msg->angular_velocity.x; - imu_msg.angular_velocity.y = msg->angular_velocity.y; - imu_msg.angular_velocity.z = msg->angular_velocity.z; - - imu_msg.linear_acceleration.x = msg->linear_acceleration.x; - imu_msg.linear_acceleration.y = msg->linear_acceleration.y; - imu_msg.linear_acceleration.z = msg->linear_acceleration.z; - - for (int i = 0; i < 9; ++i) - { - imu_msg.orientation_covariance[i] = msg->orientation_covariance[i]; - imu_msg.angular_velocity_covariance[i] = msg->angular_velocity_covariance[i]; - imu_msg.linear_acceleration_covariance[i] = msg->linear_acceleration_covariance[i]; - } - - imu_pub.publish(imu_msg); - } -}; - -int main(int argc, char **argv) -{ - // setup LCM - lcm::LCM lcm; - - if (!lcm.good()) - return 1; - MessageBroadcaster mb; - lcm.subscribe("sensor_hub_raw_imu", &MessageBroadcaster::IMULCMCallback, &mb); - - // setup ROS node - ros::init(argc, argv, "imu_broadcast_node"); - ros::NodeHandle nh; - imu_pub = nh.advertise("imu", 1000); - - ROS_INFO("Started broadcasting"); - while (ros::ok()) - { - lcm.handleTimeout(5); - } - - return 0; -} \ No newline at end of file