協(xié)方差參數(shù)的設(shè)置

主要確定mpu6050和odom編碼器協(xié)方差參數(shù)的設(shè)置

參考：turtlebot_node協(xié)方差的設(shè)置

mpu605參數(shù)的設(shè)置

參考：https://github.com/Arkapravo/turtlebot/blob/master/turtlebot_node/src/turtlebot_node/gyro.py

self.imu_data.orientation_covariance = [1e6, 0, 0, 0, 1e6, 0, 0, 0, 1e-6]

self.imu_data.angular_velocity_covariance = [1e6, 0, 0, 0, 1e6, 0, 0, 0, 1e-6]

self.imu_data.linear_acceleration_covariance = [-1,0,0,0,0,0,0,0,0]

odom參數(shù)的設(shè)置

參考：

https://github.com/Arkapravo/turtlebot/blob/master/turtlebot_node/src/turtlebot_node/covariances.py

https://github.com/Arkapravo/turtlebot/blob/master/turtlebot_node/nodes/turtlebot_node.py

有兩組協(xié)方差，在底盤運(yùn)動時(shí)，取第一組數(shù)據(jù)；在底盤靜止時(shí)，取第二組數(shù)據(jù)。

ODOM_POSE_COVARIANCE =[1e-3, 0, 0, 0, 0, 0,

0, 1e-3, 0, 0, 0, 0,

0, 0, 1e6, 0, 0, 0,

0, 0, 0, 1e6, 0, 0,

0, 0, 0, 0, 1e6, 0,

0, 0, 0, 0, 0, 1e3]

ODOM_POSE_COVARIANCE2 =[1e-9, 0, 0, 0, 0, 0,

0, 1e-3, 1e-9, 0, 0, 0,

0, 0, 1e6, 0, 0, 0,

0, 0, 0, 1e6, 0, 0,

0, 0, 0, 0, 1e6, 0,

0, 0, 0, 0, 0, 1e-9]

ODOM_TWIST_COVARIANCE =[1e-3, 0, 0, 0, 0, 0,

0, 1e-3, 0, 0, 0, 0,

0, 0, 1e6, 0, 0, 0,

0, 0, 0, 1e6, 0, 0,

0, 0, 0, 0, 1e6, 0,

0, 0, 0, 0, 0, 1e3]

ODOM_TWIST_COVARIANCE2 =[1e-9, 0, 0, 0, 0, 0,

0, 1e-3, 1e-9, 0, 0, 0,

0, 0, 1e6, 0, 0, 0,

0, 0, 0, 1e6, 0, 0,

0, 0, 0, 0, 1e6, 0,

0, 0, 0, 0, 0, 1e-9]

if sensor_state.requested_right_velocity == 0 and \

sensor_state.requested_left_velocity == 0 and \

sensor_state.distance == 0:

odom.pose.covariance = ODOM_POSE_COVARIANCE2

odom.twist.covariance = ODOM_TWIST_COVARIANCE2

else:

odom.pose.covariance = ODOM_POSE_COVARIANCE

odom.twist.covariance = ODOM_TWIST_COVARIANCE

配置robot_pose_ekf

robot_pose_ekf.launch內(nèi)容如下

"robot_pose_ekf" type="robot_pose_ekf" name="robot_pose_ekf">

from="imu_data" to="imu" />

默認(rèn)監(jiān)聽topic: imu_data、odom和vo

發(fā)布robot_pose_ekf/odom_combined和坐標(biāo)系轉(zhuǎn)換

運(yùn)行

roslaunch mpu6050_serial_to_imu demo.launch

roslaunch dashgo_bringup robot_pose_ekf.launch

rostopic echo /robot_pose_ekf/odom_combined

問題

imu不生效

https://chidambaramsethu.wordpress.com/2013/07/15/a-beginners-guide-to-the-the-ros-robot_pose_ekf-package/

robot_localization

另外一個(gè)： http://wiki.ros.org/robot_localization

ROSCon 2015 Hamburg: Day 2 - Tom Moore: Working with the robot localization Package

總結(jié)

以上是生活随笔為你收集整理的ekf pose使用方法 ros_robot_pose_ekf 使用说明的全部內(nèi)容，希望文章能夠幫你解決所遇到的問題。

如果覺得生活随笔網(wǎng)站內(nèi)容還不錯(cuò)，歡迎將生活随笔推薦給好友。