diff --git a/ros_midterm/CMakeLists.txt b/ros_midterm/CMakeLists.txt new file mode 100644 index 0000000..1e41834 --- /dev/null +++ b/ros_midterm/CMakeLists.txt @@ -0,0 +1,27 @@ +cmake_minimum_required(VERSION 3.8) +project(ros_midterm) + +if(CMAKE_COMPILER_IS_GNUCXX OR CMAKE_CXX_COMPILER_ID MATCHES "Clang") + add_compile_options(-Wall -Wextra -Wpedantic) +endif() + +# find dependencies +find_package(ament_cmake REQUIRED) +find_package(rclcpp REQUIRED) +find_package(std_msgs REQUIRED) +find_package(sensor_msgs REQUIRED) +find_package(geometry_msgs REQUIRED) + +if(BUILD_TESTING) + find_package(ament_lint_auto REQUIRED) + # the following line skips the linter which checks for copyrights + # comment the line when a copyright and license is added to all source files + set(ament_cmake_copyright_FOUND TRUE) + # the following line skips cpplint (only works in a git repo) + # comment the line when this package is in a git repo and when + # a copyright and license is added to all source files + set(ament_cmake_cpplint_FOUND TRUE) + ament_lint_auto_find_test_dependencies() +endif() + +ament_package() diff --git a/ros_midterm/package.xml b/ros_midterm/package.xml new file mode 100644 index 0000000..9639303 --- /dev/null +++ b/ros_midterm/package.xml @@ -0,0 +1,23 @@ + + + + ros_midterm + 0.0.0 + TODO: Package description + ros + TODO: License declaration + + ament_cmake + + rclcpp + std_msgs + sensor_msgs + geometry_msgs + + ament_lint_auto + ament_lint_common + + + ament_cmake + + diff --git a/ros_midterm/src/imu_sub.cpp b/ros_midterm/src/imu_sub.cpp new file mode 100644 index 0000000..42bdd74 --- /dev/null +++ b/ros_midterm/src/imu_sub.cpp @@ -0,0 +1,31 @@ +#include "rclcpp/rclcpp.hpp" +#include "sensor_msgs/msg/imu.hpp" + +class ImuSubscriber : public rclcpp::Node +{ +public: + ImuSubscriber() : Node("imu_sub") + { + subscription_ = this->create_subscription( + "/imu", 10, std::bind(&ImuSubscriber::imu_callback, this, std::placeholders::_1)); + + RCLCPP_INFO(this->get_logger(), "IMU Subscriber node started"); + } + +private: + void imu_callback(const sensor_msgs::msg::Imu::SharedPtr msg) + { + RCLCPP_INFO(this->get_logger(), "Angular Velocity Z: %.4f rad/s", + msg->angular_velocity.z); + } + + rclcpp::Subscription::SharedPtr subscription_; +}; + +int main(int argc, char * argv[]) +{ + rclcpp::init(argc, argv); + rclcpp::spin(std::make_shared()); + rclcpp::shutdown(); + return 0; +}