- odom.pose.covariance[0] = 1e-3 # x
- odom.pose.covariance[7] = 1e-3 # y
- odom.pose.covariance[14] = 1e6 # z
- odom.pose.covariance[21] = 1e6 # rotation about X axis
- odom.pose.covariance[28] = 1e6 # rotation about Y axis
- odom.pose.covariance[35] = 0.03 # rotation about Z axis
+ odom.pose.covariance[0] = self.odom_covar_xy # x
+ odom.pose.covariance[7] = self.odom_covar_xy # y
+ odom.pose.covariance[14] = 99999 # z
+ odom.pose.covariance[21] = 99999 # rotation about X axis
+ odom.pose.covariance[28] = 99999 # rotation about Y axis
+ odom.pose.covariance[35] = self.odom_covar_angle # rotation about Z axis