GY-95T IMU在ROS2 Humble下的完整数据采集与发布实战（含串口权限、brltty冲突解决）

GY-95T IMU在ROS2 Humble下的完整数据采集与发布实战指南

当你在淘宝上淘到一款性价比极高的GY-95T惯性测量单元(IMU)，准备将其接入ROS2 Humble环境时，可能会遇到一系列令人头疼的系统配置问题。本文将以Ubuntu 22.04为操作系统，详细解析从硬件连接到数据发布的完整流程，特别针对新手最容易遇到的系统级问题进行深度剖析。

1. 硬件连接与系统识别

将GY-95T通过USB线连接到电脑后，第一件事就是确认系统是否识别到了设备。打开终端，执行以下命令：

lsusb

你应该能看到类似这样的输出：

Bus 001 Device 003: ID 1a86:7523 QinHeng Electronics CH340 serial converter

这表明系统已经识别到了IMU使用的CH340串口芯片。接下来需要确认设备被映射到的具体端口：

ls /dev/ttyUSB*

正常情况下会返回/dev/ttyUSB0这样的设备节点。如果没有任何输出，或者设备节点不存在，那么你可能遇到了第一个常见问题。

提示：如果使用虚拟机，请确保USB设备已正确传递给虚拟机系统。在VMware中，可以通过"可移动设备"菜单选择连接IMU。

2. 解决串口驱动冲突问题

2.1 brltty服务冲突

在Ubuntu 22.04中，一个常见的问题是brltty服务会占用串口设备。这个服务主要为视障人士提供盲文支持，但对大多数开发者来说并不需要。检查是否存在冲突：

sudo dmesg | grep brltty

如果看到类似usbfs: interface 0 claimed by ch341 while 'brltty' sets config #1的信息，说明存在冲突。解决方法很简单：

sudo apt remove brltty

卸载后重新插拔USB设备即可。这个操作对系统其他功能没有影响，除非你确实需要使用盲文支持。

2.2 串口权限问题

即使设备节点存在，普通用户也可能没有访问权限。解决方法是修改设备节点的权限：

sudo chmod 666 /dev/ttyUSB0

为了让这个设置永久生效（避免每次插拔后都要重新设置），可以创建udev规则：

sudo nano /etc/udev/rules.d/99-imu.rules

添加以下内容：

KERNEL=="ttyUSB*", ATTRS{idVendor}=="1a86", ATTRS{idProduct}=="7523", MODE="0666"

然后重新加载udev规则：

sudo udevadm control --reload-rules sudo udevadm trigger

3. 验证串口通信

在编写ROS2节点之前，建议先用简单工具验证串口通信是否正常。安装minicom：

sudo apt install minicom

然后以正确的波特率连接串口（GY-95T通常使用115200波特率）：

minicom -D /dev/ttyUSB0 -b 115200

如果看到有规律的数据流（可能是十六进制格式），说明硬件连接和串口通信正常。按Ctrl+A，然后按X退出minicom。

4. ROS2环境配置与数据发布

4.1 安装必要的ROS2包

确保已安装ROS2 Humble基础版本，并额外安装以下包：

sudo apt install ros-humble-rclpy ros-humble-sensor-msgs

由于ROS2 Humble默认不包含Python serial库，需要单独安装：

sudo apt install python3-serial

4.2 创建ROS2包

在工作空间的src目录下创建新包：

ros2 pkg create --build-type ament_python imu_publisher

进入包目录，创建节点文件：

cd imu_publisher/imu_publisher touch imu_node.py chmod +x imu_node.py

4.3 编写IMU数据发布节点

以下是完整的IMU数据发布节点代码，包含详细的注释：

#!/usr/bin/env python3 import rclpy from rclpy.node import Node from sensor_msgs.msg import Imu import serial import struct import binascii class IMUPublisher(Node): def __init__(self): super().__init__('imu_publisher') self.publisher_ = self.create_publisher(Imu, 'imu_data', 10) # 串口初始化参数 self.serial_port = '/dev/ttyUSB0' self.baudrate = 115200 self.timeout = 0.001 # IMU数据变量初始化 self.accel_x = 0.0 self.accel_y = 0.0 self.accel_z = 0.0 self.gyro_x = 0.0 self.gyro_y = 0.0 self.gyro_z = 0.0 self.q0 = 0.0 self.q1 = 0.0 self.q2 = 0.0 self.q3 = 0.0 # 初始化串口连接 self.setup_serial() # 创建定时器，以100Hz频率发布数据 self.timer = self.create_timer(0.01, self.timer_callback) def setup_serial(self): """初始化串口连接""" try: self.ser = serial.Serial( port=self.serial_port, baudrate=self.baudrate, timeout=self.timeout ) if self.ser.isOpen(): self.get_logger().info(f"成功打开串口 {self.serial_port}") # 发送读取指令 self.send_read_command() else: self.get_logger().error("串口打开失败") except Exception as e: self.get_logger().error(f"串口初始化错误: {str(e)}") def send_read_command(self): """发送读取IMU数据的指令""" # 指令格式: [帧头, 功能码, 起始寄存器, 寄存器数量, 校验和] command = [0xA4, 0x03, 0x08, 0x23, 0xD2] try: self.ser.write(struct.pack('5B', *command)) except Exception as e: self.get_logger().error(f"发送指令失败: {str(e)}") def parse_imu_data(self, data): """解析IMU原始数据""" if len(data) < 40: return False # 检查帧头和功能码 if data[0] != 0xA4 or data[1] != 0x03: return False # 校验和检查 checksum = sum(data[:-1]) & 0xFF if checksum != data[-1]: self.get_logger().warn("校验和错误") return False # 解析数据 (小端格式) unpacked = struct.unpack('<9hB9h', data[4:-1]) # 加速度计数据 (转换为m/s²) g = 9.8 self.accel_x = unpacked[0] / 2048 * g self.accel_y = unpacked[1] / 2048 * g self.accel_z = unpacked[2] / 2048 * g # 陀螺仪数据 (转换为rad/s) deg_to_rad = 3.1415926 / 180.0 self.gyro_x = unpacked[3] / 16.4 * deg_to_rad self.gyro_y = unpacked[4] / 16.4 * deg_to_rad self.gyro_z = unpacked[5] / 16.4 * deg_to_rad # 四元数数据 self.q0 = unpacked[14] / 10000.0 self.q1 = unpacked[15] / 10000.0 self.q2 = unpacked[16] / 10000.0 self.q3 = unpacked[17] / 10000.0 return True def timer_callback(self): """定时器回调函数，读取并发布IMU数据""" if self.ser.in_waiting >= 40: data = self.ser.read(40) if self.parse_imu_data(data): # 创建并填充Imu消息 imu_msg = Imu() imu_msg.header.stamp = self.get_clock().now().to_msg() imu_msg.header.frame_id = 'imu_link' # 设置加速度 imu_msg.linear_acceleration.x = self.accel_x imu_msg.linear_acceleration.y = self.accel_y imu_msg.linear_acceleration.z = self.accel_z # 设置角速度 imu_msg.angular_velocity.x = self.gyro_x imu_msg.angular_velocity.y = self.gyro_y imu_msg.angular_velocity.z = self.gyro_z # 设置方向四元数 imu_msg.orientation.x = self.q1 imu_msg.orientation.y = self.q2 imu_msg.orientation.z = self.q3 imu_msg.orientation.w = self.q0 # 发布消息 self.publisher_.publish(imu_msg) def main(args=None): rclpy.init(args=args) imu_publisher = IMUPublisher() rclpy.spin(imu_publisher) imu_publisher.destroy_node() rclpy.shutdown() if __name__ == '__main__': main()

4.4 配置package.xml和setup.py

在package.xml中添加依赖：

<exec_depend>rclpy</exec_depend> <exec_depend>sensor_msgs</exec_depend>

在setup.py中确保有正确的入口点：

entry_points={ 'console_scripts': [ 'imu_node = imu_publisher.imu_node:main', ], },

5. 数据可视化与验证

5.1 安装可视化工具

安装imu-tools用于数据可视化：

sudo apt install ros-humble-imu-tools

5.2 启动节点和可视化

首先构建并运行IMU节点：

colcon build --packages-select imu_publisher source install/setup.bash ros2 run imu_publisher imu_node

在新的终端中启动RViz2：

rviz2

在RViz2中：

1. 点击左下角的"Add"按钮
2. 选择"By topic"选项卡
3. 找到/imu_data话题并添加其中的Imu显示
4. 在左侧面板中，确保Fixed Frame设置为imu_link

你应该能看到一个3D模型，随着IMU的移动而旋转，同时可以查看加速度和角速度的数值变化。

5.3 使用rqt_plot查看数据曲线

另一种可视化方式是使用rqt_plot查看数据曲线：

rqt_plot

然后添加以下话题：

• /imu_data/linear_acceleration/x
• /imu_data/linear_acceleration/y
• /imu_data/linear_acceleration/z
• /imu_data/angular_velocity/x
• /imu_data/angular_velocity/y
• /imu_data/angular_velocity/z

6. 常见问题排查

6.1 串口数据不完整或乱码

可能原因和解决方案：

• 波特率不匹配：确认GY-95T和代码中的波特率设置一致（通常是115200）
• 电磁干扰：尝试使用带屏蔽的USB线，远离强电磁场
• 供电不足：使用带电源的USB集线器，或尝试不同的USB端口

6.2 ROS2节点无法发布数据

检查步骤：

1. 确认节点正在运行：ros2 node list
2. 检查话题是否存在：ros2 topic list
3. 查看话题数据：ros2 topic echo /imu_data

6.3 四元数方向不正确

如果发现RViz中的模型方向与实际不符：

• 检查四元数的顺序（w,x,y,z）
• 可能需要调整坐标系定义
• 某些IMU需要四元数归一化

7. 性能优化建议

1. 调整发布频率：根据应用需求，在create_timer中设置合适的发布间隔
2. 添加协方差数据：完善Imu消息中的协方差矩阵，提高数据可靠性
3. 实现校准功能：添加自动校准例程，消除零偏和比例因子误差
4. 使用自定义消息：如果需要更多原始数据，可以定义自定义消息类型
5. 添加TF支持：发布IMU坐标系到基坐标系的变换，便于与其他传感器融合

在实际项目中，我发现GY-95T在静态情况下表现尚可，但在快速运动时噪声较大。对于要求较高的应用，建议考虑更高性能的IMU，或通过滤波算法（如卡尔曼滤波）改善数据质量。