【画图】读取无人机IMU数据并打印成log用matlab分析

后厂村路钢铁侠2024-05-06 12:32

一、修改IMU频率

原来的imu没有加速度信息，查看加速度信息的指令为：

复制代码

rostopic echo /mavros/imu/data

修改imu频率，分别修改的是

原始IMU数据话题 /mavros/imu/data_raw。
飞控计算过后的IMU数据 /mavros/imu/data

rosrun mavros mavcmd long 511 105 10000 0 0 0 0 0
rosrun mavros mavcmd long 511 31 10000 0 0 0 0 0

但是这个每次都要启动执行这句话，很麻烦，把他添加到脚本里，这样每次就不用手动输入了。

定义一个回调函数，回调函数是当新消息到达主题时被调用的函数。它应该接收一个参数，即到达的消息，常见格式：

复制代码

def imu_data(data):  
    ...

我们需要的信息：

样例：

复制代码

def imu_data(msg):
    global imu_acc
    imu_acc=msg.linear_acceleration

常见格式：

复制代码

rospy.Subscriber('my_topic', String, callback)

在这里，'my_topic' 是你要订阅的主题名，String 是你期望接收的消息类型，callback 是上面定义的回调函数。

为了查看消息类型，可以这样执行：

复制代码

rostopic type /mavros/imu/data

返回值：
sensor_msgs/Imu

所以，可以这样写订阅：

复制代码

rospy.Subscriber("mavros/imu/data", Imu, imu_data)#yhl

但是在此之前，还要安装一个包，让ros能识别Imu消息类型

复制代码

from sensor_msgs.msg import Imu  # 导入sensor_msgs包中的Imu消息类型

复制代码

print("imu_acc:{}".format(imu_acc))#yhl

可以看到，打印了加速度数据

未完待续。。。