Robotics StackExchange | Archived questions

AMCL will not update initialpose via RViz

(Using Indigo.) While navigating around a map using AMCL the pose estimate diverges occasionally. Attempting to set 2D pose estimate via RViz does not affect /amcl_pose even though the /initial_pose topic echos the new estimate. For example, the amcl_pose is at (45, 53) and I want to update it to (47, 56) but the pose remains unchanged. Switching the Rviz frame from base_link to map didn't do anything either.

Below is the topic data. /initialpose

header:
  seq: 5
  stamp:
    secs: 1644976407
    nsecs: 564884800
  frame_id: "base_link"
pose:
  pose:
    position:
      x: -5.15022659302
      y: 5.65622138977
      z: 0.0
    orientation:
      x: 0.0
      y: 0.0
      z: 0.963518141998
      w: 0.267643027258
---
header:
  seq: 6
  stamp:
    secs: 1644977033
    nsecs: 789705700
  frame_id: "map"
pose:
  pose:
    position:
      x: 47.3962020874
      y: 56.4524917603
      z: 0.0
    orientation:
      x: 0.0
      y: 0.0
      z: 0.748176221643
      w: 0.663500068854

/amcl_pose

header:
  seq: 259
  stamp:
    secs: 1644977104
    nsecs: 659635481
  frame_id: "map"
pose:
  pose:
    position:
      x: 45.3278345494
      y: 53.8831794907
      z: 0.0
    orientation:
      x: 0.0
      y: 0.0
      z: -0.672860984397
      w: 0.739768947494

Asked by bscout on 2022-02-15 21:31:07 UTC

Comments

Answers