Pixhawk中通過(guò)Mavlink向外發(fā)送IMU數(shù)據(jù)的方法有兩個(gè):
在GCS_MAVLink / GCS_Common.cpp中:
send_raw_imu()和send_scaled_imu()拉一,具體如下圖:
send_raw_imu
send_scaled_imu
MavRos中接收該Mavlink消息拢操,并解析數(shù)據(jù)和轉(zhuǎn)換格式后那婉,再添加協(xié)方差,通過(guò)publisher發(fā)布ROS數(shù)據(jù)出去:
MavRos