分享

imu_odom_error_carto_down

 海漩涡 2018-01-05
F0105 11:13:05.804167  3661 pose_tracker.cc:48] Check failed: rotation_vector. norm() < 3.14159265358979323846 / 2. (1464.46 vs. 1.5708) Sigma point is far from the mean, recovered delta may be incorrect.
[FATAL] [/cartographer_node:ScopedRosLogSink::send-63]:F0105 11:13:05.000000 3661 pose_tracker.cc:48] Check failed: rotation_vector.norm() < 3. 14159265358979323846 / 2. (1464.46 vs. 1.5708) Sigma point is far from the mean, recovered delta may be incorrect.
*** Check failure stack trace: ***
Q_to_E:--- roll:[0.000000] pitch:[-0.000000] yaw:[199.399997] ---seq[233725]
Q_to_E:--- roll:[0.000000] pitch:[-0.000000] yaw:[198.599997] ---seq[233726]
Q_to_E:--- roll:[0.000000] pitch:[0.000000] yaw:[17.099994] ---seq[233727]
Q_to_E:--- roll:[0.000000] pitch:[-0.000000] yaw:[196.899997] ---seq[233728]
Q_to_E:--- roll:[0.000000] pitch:[-0.000000] yaw:[196.099997] ---seq[233729]
=====================================================================================
---------imu
header: seq: 233726
  stamp: secs: 1515044477
    nsecs: 930958246 frame_id: gyro_link orientation: x: -0.0
  y: 0.0
  z: 0.986855721184
  w: -0.161603791928 orientation_covariance: [1.7976931348623157e+308, 0.0, 0.0, 0.0, 1. 7976931348623157e+308, 0.0, 0.0, 0.0, 0.05]
angular_velocity: x: 0.0
  y: 0.0
  z: -0.349065844444 angular_velocity_covariance: [1.7976931348623157e+308, 0.0, 0.0, 0.0, 1. 7976931348623157e+308, 0.0, 0.0, 0.0, 0.05]
linear_acceleration: x: 0.0
  y: 0.0
  z: 0.0 linear_acceleration_covariance: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0]
--- header: seq: 233727
  stamp: secs: 1515044477
    nsecs: 972999331 frame_id: gyro_link orientation: x: 0.0
  y: -0.0
  z: -0.148672378385
  w: -0.98888650709 orientation_covariance: [1.7976931348623157e+308, 0.0, 0.0, 0.0, 1. 7976931348623157e+308, 0.0, 0.0, 0.0, 0.05]
angular_velocity: x: 0.0
  y: 0.0
  z: 342.328873647 angular_velocity_covariance: [1.7976931348623157e+308, 0.0, 0.0, 0.0, 1. 7976931348623157e+308, 0.0, 0.0, 0.0, 0.05]
linear_acceleration: x: 0.0
  y: 0.0
  z: 0.0 linear_acceleration_covariance: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0]
--- header: seq: 233728
  stamp: secs: 1515044478
    nsecs:  14423072 frame_id: gyro_link orientation: x: -0.0
  y: 0.0
  z: 0.989144479108
  w: -0.146946246807 orientation_covariance: [1.7976931348623157e+308, 0.0, 0.0, 0.0, 1. 7976931348623157e+308, 0.0, 0.0, 0.0, 0.05]
angular_velocity: x: 0.0
  y: 0.0
  z: -0.331612552222 angular_velocity_covariance: [1.7976931348623157e+308, 0.0, 0.0, 0.0, 1. 7976931348623157e+308, 0.0, 0.0, 0.0, 0.05]
linear_acceleration: x: 0.0
  y: 0.0
  z: 0.0 linear_acceleration_covariance: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0]
---
===============================================================================
-------- odom
header: seq: 233726
  stamp: secs: 1515044477
    nsecs: 930892044 frame_id: odom child_frame_id: base_footprint pose: pose: position: x: -26.05
      y: -18.52
      z: 0.0 orientation: x: 0.0
      y: 0.0
      z: 0.710799464386
      w: 0.703394712397 covariance: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0 , 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0 .0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0]
twist: twist: linear: x: 0.005
      y: 0.0
      z: 0.0 angular: x: 0.0
      y: 0.0
      z: -0.31415926 covariance: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0 , 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0 .0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0]
--- header: seq: 233727
  stamp: secs: 1515044477
    nsecs: 972963168 frame_id: odom child_frame_id: base_footprint pose: pose: position: x: -26.05
      y: -15099512.92
      z: 0.0 orientation: x: 0.0
      y: 0.0
      z: 0.0
      w: 1.0 covariance: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0 , 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0 .0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0]
twist: twist: linear: x: -31.731
      y: 0.257
      z: 0.0 angular: x: 0.0
      y: 0.0
      z: 11.6064393278 covariance: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0 , 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0 .0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0]
--- header: seq: 233728
  stamp: secs: 1515044478
    nsecs:  14358607 frame_id: odom child_frame_id: base_footprint pose: pose: position: x: -26.05
      y: -18.52
      z: 0.0 orientation: x: 0.0
      y: 0.0
      z: 0.701531416319
      w: 0.71263852823 covariance: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0 , 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0 .0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0]
twist: twist: linear: x: 0.003
      y: -0.001
      z: 0.0 angular: x: 0.0
      y: 0.0
      z: -0.349065844444 covariance: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0 , 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0 .0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0]
--- header: seq: 233729
  stamp: secs: 1515044478
    nsecs:  55467950 frame_id: odom child_frame_id: base_footprint pose: pose: position: x: -26.05
      y: -18.52
      z: 0.0 orientation: x: 0.0
      y: 0.0
      z: 0.696539205515
      w: 0.717518735073 covariance: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0 , 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0 .0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0]
twist: twist: linear: x: 0.001
      y: 0.0
      z: 0.0 angular: x: 0.0
      y: 0.0
      z: -0.296705967778 covariance: [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0 , 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0 .0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0]

    本站是提供个人知识管理的网络存储空间,所有内容均由用户发布,不代表本站观点。请注意甄别内容中的联系方式、诱导购买等信息,谨防诈骗。如发现有害或侵权内容,请点击一键举报。
    转藏 分享 献花(0

    0条评论

    发表

    请遵守用户 评论公约

    类似文章 更多