}
if (ser.isOpen())
{
RCLCPP\_INFO(this->get\_logger(), "Serial Port initialized");
}
else
{
RCLCPP\_INFO(this->get\_logger(), "Serial Port ???");
return;
}
pub_imu = this->create\_publisher<sensor\_msgs::msg::Imu>("/imu\_data", 20);
//<sensor\_msgs::msg::Imu>消息数据类型可自行查看对应文件,消息队列长度设20
pub_imu_offline = this->create\_publisher<sensor\_msgs::msg::Imu>("/imu\_offline\_data", 20);
// 这里创建了两个话题,一个是/imu\_data,一个是/imu\_offline\_data
// imu = transform\_imu();//初始化对象
// ser.flush();
// int size;
printf("Process working\_1\n");
timer_ = this->create\_wall\_timer(500ms, std::bind(&publisher_imu_node::timer_callback, this));//std::chrono::milliseconds timer\_ms{output\_hz}; // 换算成ms
printf("Process working\_2\n");
}
public:
void timer_callback()
{
int count = ser.available(); // 读取到缓存区数据的字节数
if (count != 0)
{
// ROS_INFO_ONCE(“Data received from serial port.”);
int num;
rclcpp::Time now = this->get_clock()->now(); // 获取时间戳
std::vector read_buf(count);//这里定义无符号,是应为read函数的形参是无符号
//unsigned char read_buf[count]; // 开辟数据缓冲区,注意这里是无符号类型
num = ser.read(&read_buf[0], count); // 读出缓存区缓存的数据,返回值为读到的数据字节数
std::vector<char> read\_buf\_char(count);//vector转char类型
for(int i = 0;i < count;i++)
{
read_buf_char[i] = (char)read_buf[i];
}
imu_fetch.FetchData(read_buf_char, num);
sensor_msgs::msg::Imu imu_data; //
sensor_msgs::msg::Imu imu_offline_data; //
//------------------imu data----------------
imu_data.header.stamp = now;
imu_data.header.frame_id = "imu\_frame";
imu_data.linear_acceleration.x = imu_fetch.acc.x;
imu_data.linear_acceleration.y = imu_fetch.acc.y;
imu_data.linear_acceleration.z = imu_fetch.acc.z;
imu_data.angular_velocity.x = imu_fetch.angle.r \* 180.0 / M_PI;
imu_data.angular_velocity.y = imu_fetch.angle.p \* 180.0 / M_PI;
imu_data.angular_velocity.z = imu_fetch.angle.y \* 180.0 / M_PI;//数据结构里没有储存欧拉角的变量名称,用angular\_velocity.z凑合
tf2::Quaternion curr_quater;
curr_quater.setRPY(imu_fetch.angle.r, imu_fetch.angle.p, imu_fetch.angle.y);
// 欧拉角换算四元数
RCLCPP\_INFO(this->get\_logger(), "Publishing: '");
//RCLCPP\_INFO(this->get\_logger(), "angle: x=%f, y=%f, z=%f",imu.angle.r, imu.angle.p, imu.angle.y);
imu_data.orientation.x = curr_quater.x();
imu_data.orientation.y = curr_quater.y();
imu_data.orientation.z = curr_quater.z();
imu_data.orientation.w = curr_quater.w();
// RCLCPP\_INFO(this->get\_logger(), "Quaternion: x=%f, y=%f, z=%f, w=%f",
// imu\_data.orientation.x, imu\_data.orientation.y, imu\_data.orientation.z, imu\_data.orientation.w);
//---------------imu offline data--------------
imu_offline_data.header.stamp = now;
// imu\_offline\_data.header.frame\_id = imu\_frame;
imu_offline_data.linear_acceleration.x = imu_fetch.acc.x;
imu_offline_data.linear_acceleration.y = imu_fetch.acc.y;
imu_offline_data.linear_acceleration.z = imu_fetch.acc.z;
imu_offline_data.angular_velocity.x = imu_fetch.gyro.x;
imu_offline_data.angular_velocity.y = imu_fetch.gyro.y;
imu_offline_data.angular_velocity.z = imu_fetch.gyro.z;
imu_offline_data.orientation.x = curr_quater.x();
imu_offline_data.orientation.y = curr_quater.y();
imu_offline_data.orientation.z = curr_quater.z();
imu_offline_data.orientation.w = curr_quater.w();
pub_imu->publish(imu_data);
pub_imu_offline->publish(imu_offline_data); // 发布话题,往两个话题放数据
}
}
rclcpp::TimerBase::SharedPtr timer_;
rclcpp::Publisher<sensor_msgs::msg::Imu>::SharedPtr pub_imu;
rclcpp::Publisher<sensor_msgs::msg::Imu>::SharedPtr pub_imu_offline;
};
int main(int argc, char *argv[])
{
rclcpp::init(argc, argv);
rclcpp::spin(std::make_shared<publisher_imu_node>()); // 单线程,调用所有可触发的回调函数,将进入循环,不会返回
printf(“Process exit\n”);
rclcpp::shutdown();
return 0;
}
这里需要注意的是,**sensor\_msgs::msg::Imu**数据类型里面没有储存角度的变量名(如果没看错的话,大火可以自己点进去看看),所以我把欧拉角放进**imu\_data.angular\_velocity**里面。
## 6.编写sub\_imu.cpp
写订阅话题的节点就比较简单,代码如下:
#include
#include “std_msgs/msg/string.hpp”
#include “sensor_msgs/msg/imu.hpp”
#include “sensor_msgs/msg/magnetic_field.hpp”
#include “tf2/LinearMath/Quaternion.h”
#include “tf2_ros/transform_broadcaster.h”
#include “tf2_ros/static_transform_broadcaster.h”
#include “nav_msgs/msg/odometry.hpp”
#include “rclcpp/rclcpp.hpp”
#include “std_msgs/msg/string.hpp”
using std::placeholders::_1;
class Imu_subscriber : public rclcpp::Node
{
public:
Imu_subscriber()
: Node(“sub_imu_node”)
{
subscription_1 = this->create_subscription<sensor_msgs::msg::Imu>(
“/imu_data”, 20, std::bind(&Imu_subscriber::topic_callback, this, _1));
subscription_2 = this->create_subscription<sensor_msgs::msg::Imu>(
“/imu_offline_data”, 20, std::bind(&Imu_subscriber::topic_callback, this, _1));
}//创建接收信息节点
private:
void topic_callback(const sensor_msgs::msg::Imu::SharedPtr imu_msg) const//注意上面有两次回调,所以打印出来/imu_data之后就是/imu_data_offline
{
RCLCPP_INFO(this->get_logger(), “加速度(x,y,z): ‘%lf’‘%lf’‘%lf’”, imu_msg->linear_acceleration.x,
imu_msg->linear_acceleration.y,imu_msg->linear_acceleration.z);
RCLCPP_INFO(this->get_logger(), “欧拉角(r,p,y): ‘%lf’‘%lf’‘%lf’”, imu_msg->angular_velocity.x,
imu_msg->angular_velocity.y,imu_msg->angular_velocity.z);//指针类型要用->
}
rclcpp::Subscription<sensor_msgs::msg::Imu>::SharedPtr subscription_1;
rclcpp::Subscription<sensor_msgs::msg::Imu>::SharedPtr subscription_2;
};
int main(int argc, char * argv[])
{
rclcpp::init(argc, argv);
rclcpp::spin(std::make_shared<Imu_subscriber>());
rclcpp::shutdown();
return 0;
}
## 7.CMakelist.txt和xml文件的配置
CMakelist.txt和package.xml文件的配置如下:
cmake_minimum_required(VERSION 3.5)
project(imu_get)
Default to C99
if(NOT CMAKE_C_STANDARD)
set(CMAKE_C_STANDARD 99)
endif()
Default to C++14
if(NOT CMAKE_CXX_STANDARD)
set(CMAKE_CXX_STANDARD 14)
endif()
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(serial REQUIRED)
find_package(sensor_msgs REQUIRED)
find_package(rosidl_default_generators REQUIRED)
#find_package(geometry_msgs)
find_package(nav_msgs REQUIRED)
find_package(tf2_ros REQUIRED)
find_package(tf2_msgs REQUIRED)
find_package(tf2_geometry_msgs REQUIRED)
uncomment the following section in order to fill in
further dependencies manually.
find_package( REQUIRED)
add_executable(publisher_imu_node src/publisher_imu.cpp src/transform.hpp)
ament_target_dependencies(publisher_imu_node rclcpp std_msgs)
ament_target_dependencies(publisher_imu_node rclcpp serial)
ament_target_dependencies(publisher_imu_node rclcpp sensor_msgs)
ament_target_dependencies(publisher_imu_node rclcpp rosidl_default_generators)
ament_target_dependencies(publisher_imu_node rclcpp nav_msgs)
ament_target_dependencies(publisher_imu_node rclcpp tf2_ros)
ament_target_dependencies(publisher_imu_node rclcpp tf2_msgs)
ament_target_dependencies(publisher_imu_node rclcpp tf2_geometry_msgs)
install(TARGETS
publisher_imu_node
DESTINATION lib/${PROJECT_NAME})
add_executable(sub_imu_node src/sub_imu.cpp)
ament_target_dependencies(sub_imu_node rclcpp std_msgs)
ament_target_dependencies(sub_imu_node rclcpp std_msgs)
ament_target_dependencies(sub_imu_node rclcpp serial)
ament_target_dependencies(sub_imu_node rclcpp sensor_msgs)
ament_target_dependencies(sub_imu_node rclcpp rosidl_default_generators)
ament_target_dependencies(sub_imu_node rclcpp nav_msgs)
ament_target_dependencies(sub_imu_node rclcpp tf2_ros)
ament_target_dependencies(sub_imu_node rclcpp tf2_msgs)
ament_target_dependencies(sub_imu_node rclcpp tf2_geometry_msgs)
install(TARGETS
sub_imu_node
DESTINATION lib/${PROJECT_NAME})
if(BUILD_TESTING)
find_package(ament_lint_auto REQUIRED)
ament_lint_auto_find_test_dependencies()
endif()
ament_package()
![在这里插入图片描述](https://img-blog.csdnimg.cn/8a2dfc44b89a458b8e92e76de9cf0fd7.png#pic_center)
## 8.构建功能包运行并可视化
在imu\_test\_ws目录下执行下面命令:
colcon build --packages-select imu_get
构建成功后,我们需要对串口开放权限,再运行节点,终端输入下面命令:
sudo chmod 777 /dev/ttyUSB0
**/dev/ttyUSB0**是我的串口号,前面有说明如何查串口号,自行修改就行,**每次运行都要授权串口**。
打开两个终端,分别输入下面命令运行节点
source install/setup.bash
ros2 run imu_get publisher_imu_node
source install/setup.bash
ros2 run imu_get sub_imu_node
通过订阅话题的形式,到这里就完成了imu数据的解析与获取,如果想看到更多的数据,可以在订阅节点多打印几个变量,或打开一个新的终端输入下面命令:
ros2 topic echo /imu_data
/imu\_data是话题名称,我其实还发布了一个/imu\_offline\_data的话题,大火可以自行修改,效果图如下:
![在这里插入图片描述](https://img-blog.csdnimg.cn/145361c4e78449afa2da00683b9c7b72.png#pic_center)covariance是协方差,这里是一个3x3的矩阵,我这里没有用到,**注意这里imu\_data.angular\_velocity的xyz对应roll、pitch、yaw**。
因为原生的rviz2没有可视化imu支持,所以启动rviz2之前,我们需要安装rviz\_imu\_plugin插件,安装方式:
sudo apt-get install ros-foxy-imu-tools
上面foxy是我的ros2版本,把命令替换成你使用的版本酒醒。安装完成之后在新的终端输入:
rviz2
自我介绍一下,小编13年上海交大毕业,曾经在小公司待过,也去过华为、OPPO等大厂,18年进入阿里一直到现在。
深知大多数Linux运维工程师,想要提升技能,往往是自己摸索成长或者是报班学习,但对于培训机构动则几千的学费,着实压力不小。自己不成体系的自学效果低效又漫长,而且极易碰到天花板技术停滞不前!
因此收集整理了一份《2024年Linux运维全套学习资料》,初衷也很简单,就是希望能够帮助到想自学提升又不知道该从何学起的朋友,同时减轻大家的负担。
既有适合小白学习的零基础资料,也有适合3年以上经验的小伙伴深入学习提升的进阶课程,基本涵盖了95%以上Linux运维知识点,真正体系化!
由于文件比较大,这里只是将部分目录大纲截图出来,每个节点里面都包含大厂面经、学习笔记、源码讲义、实战项目、讲解视频,并且后续会持续更新
如果你觉得这些内容对你有帮助,可以添加VX:vip1024b (备注Linux运维获取)
最全的Linux教程,Linux从入门到精通
======================
-
linux从入门到精通(第2版)
-
Linux系统移植
-
Linux驱动开发入门与实战
-
LINUX 系统移植 第2版
-
Linux开源网络全栈详解 从DPDK到OpenFlow
第一份《Linux从入门到精通》466页
====================
内容简介
====
本书是获得了很多读者好评的Linux经典畅销书**《Linux从入门到精通》的第2版**。本书第1版出版后曾经多次印刷,并被51CTO读书频道评为“最受读者喜爱的原创IT技术图书奖”。本书第﹖版以最新的Ubuntu 12.04为版本,循序渐进地向读者介绍了Linux 的基础应用、系统管理、网络应用、娱乐和办公、程序开发、服务器配置、系统安全等。本书附带1张光盘,内容为本书配套多媒体教学视频。另外,本书还为读者提供了大量的Linux学习资料和Ubuntu安装镜像文件,供读者免费下载。
本书适合广大Linux初中级用户、开源软件爱好者和大专院校的学生阅读,同时也非常适合准备从事Linux平台开发的各类人员。
需要《Linux入门到精通》、《linux系统移植》、《Linux驱动开发入门实战》、《Linux开源网络全栈》电子书籍及教程的工程师朋友们劳烦您转发+评论
一个人可以走的很快,但一群人才能走的更远。不论你是正从事IT行业的老鸟或是对IT行业感兴趣的新人,都欢迎扫码加入我们的的圈子(技术交流、学习资源、职场吐槽、大厂内推、面试辅导),让我们一起学习成长!
s://img-blog.csdnimg.cn/img_convert/9d4aefb6a92edea27b825e59aa1f2c54.png)
本书适合广大Linux初中级用户、开源软件爱好者和大专院校的学生阅读,同时也非常适合准备从事Linux平台开发的各类人员。
需要《Linux入门到精通》、《linux系统移植》、《Linux驱动开发入门实战》、《Linux开源网络全栈》电子书籍及教程的工程师朋友们劳烦您转发+评论
一个人可以走的很快,但一群人才能走的更远。不论你是正从事IT行业的老鸟或是对IT行业感兴趣的新人,都欢迎扫码加入我们的的圈子(技术交流、学习资源、职场吐槽、大厂内推、面试辅导),让我们一起学习成长!
[外链图片转存中…(img-ZyLjTKAe-1712760241964)]