Only update goal pose markers when dragging