autoware_pose_initializer

Purpose

The autoware_pose_initializer is the package to send an initial pose to ekf_localizer. It receives roughly estimated initial pose from GNSS/user. Passing the pose to ndt_scan_matcher, and it gets a calculated ego pose from ndt_scan_matcher via service. Finally, it publishes the initial pose to ekf_localizer. This node depends on the map height fitter library. See here for more details.

Interfaces

Parameters

{{ json_to_markdown(“localization/autoware_pose_initializer/schema/pose_initializer.schema.json”) }}

Services

Clients

Subscriptions

Publications

Diagnostics

pose_initializer_status

If the score of initial pose estimation result is lower than score threshold, ERROR message is output to the /diagnostics topic.

Connection with Default AD API

This autoware_pose_initializer is used via default AD API. For detailed description of the API description, please refer to the description of autoware_default_adapi.

Initialize pose via CLI

Using the GNSS estimated position

ros2 service call /localization/initialize tier4_localization_msgs/srv/InitializeLocalization

The GNSS estimated position is used as the initial guess, and the localization algorithm automatically estimates a more accurate position.

Using the input position

ros2 service call /localization/initialize tier4_localization_msgs/srv/InitializeLocalization "
pose_with_covariance:
  - header:
      frame_id: map
    pose:
      pose:
        position:
          x: 89571.1640625
          y: 42301.1875
          z: -3.1565165519714355
        orientation:
          x: 0.0
          y: 0.0
          z: 0.28072773940524687
          w: 0.9597874433062874
      covariance: [0.25, 0, 0, 0, 0, 0, 0, 0.25, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0.06853891909122467]
method: 0
"

The input position is used as the initial guess, and the localization algorithm automatically estimates a more accurate position.

Direct initial position set

ros2 service call /localization/initialize tier4_localization_msgs/srv/InitializeLocalization "
pose_with_covariance:
  - header:
      frame_id: map
    pose:
      pose:
        position:
          x: 89571.1640625
          y: 42301.1875
          z: -3.1565165519714355
        orientation:
          x: 0.0
          y: 0.0
          z: 0.28072773940524687
          w: 0.9597874433062874
      covariance: [0.25, 0, 0, 0, 0, 0, 0, 0.25, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0.06853891909122467]
method: 1
"

The initial position is set directly by the input position without going through localization algorithm.

Via ros2 topic pub

ros2 topic pub --once /initialpose geometry_msgs/msg/PoseWithCovarianceStamped "
header:
  frame_id: map
pose:
  pose:
    position:
      x: 89571.1640625
      y: 42301.1875
      z: 0.0
    orientation:
      x: 0.0
      y: 0.0
      z: 0.28072773940524687
      w: 0.9597874433062874
"

It behaves the same as “initialpose (from rviz)”. The position.z and the covariance will be overwritten by autoware_adapi_adaptors, so there is no need to input them.

Changelog for package autoware_pose_initializer

0.43.0 (2025-03-21)

• Merge remote-tracking branch 'origin/main' into chore/bump-version-0.43
• chore: rename from [autoware.universe]{.title-ref} to [autoware_universe]{.title-ref} (#10306)
• Contributors: Hayato Mizushima, Yutaka Kondo

0.42.0 (2025-03-03)

• Merge remote-tracking branch 'origin/main' into tmp/bot/bump_version_base
• feat(autoware_utils): replace autoware_universe_utils with autoware_utils (#10191)
• Contributors: Fumiya Watanabe, 心刚

0.41.2 (2025-02-19)

• chore: bump version to 0.41.1 (#10088)
• Contributors: Ryohsuke Mitsudome

0.41.1 (2025-02-10)

0.41.0 (2025-01-29)

• Merge remote-tracking branch 'origin/main' into tmp/bot/bump_version_base
• feat: apply [autoware_]{.title-ref} prefix for [default_ad_api_helpers]{.title-ref} (#9965) Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]\@users.noreply.github.com> Co-authored-by: Takagi, Isamu <<isamu.takagi@tier4.jp>>
• feat(autoware_component_interface_specs_universe!): rename package (#9753)
• refactor(autoware_universe_utils): add missing 's' in the class of diagnostics_interface (#9777)
• feat!: move diagnostics_module from localization_util to unverse_utils (#9714)
  • feat!: move diagnostics_module from localization_util to unverse_utils
  • remove diagnostics module from localization_util
  • style(pre-commit): autofix
  • minor fix in pose_initializer
  • add test
  • style(pre-commit): autofix
  • remove unnecessary declaration
  • module -> interface
  • remove unnecessary equal expression
  • revert the remove of template function
  • style(pre-commit): autofix
  • use overload instead

  * include what you use -- test_diagnostics_interface.cpp ---------Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]\@users.noreply.github.com>

• Contributors: Fumiya Watanabe, Junya Sasaki, Ryohsuke Mitsudome, kminoda

0.40.0 (2024-12-12)

• Merge branch 'main' into release-0.40.0
• Revert "chore(package.xml): bump version to 0.39.0 (#9587)" This reverts commit c9f0f2688c57b0f657f5c1f28f036a970682e7f5.
• fix: fix ticket links in CHANGELOG.rst (#9588)
• chore(package.xml): bump version to 0.39.0 (#9587)
  • chore(package.xml): bump version to 0.39.0
  • fix: fix ticket links in CHANGELOG.rst

  * fix: remove unnecessary diff ---------Co-authored-by: Yutaka Kondo <<yutaka.kondo@youtalk.jp>>

• fix: fix ticket links in CHANGELOG.rst (#9588)
• fix(cpplint): include what you use - localization (#9567)
• 0.39.0
• update changelog
• Merge commit '6a1ddbd08bd' into release-0.39.0
• fix: fix ticket links to point to https://github.com/autowarefoundation/autoware_universe (#9304)
• fix: fix ticket links to point to https://github.com/autowarefoundation/autoware_universe (#9304)
• chore(package.xml): bump version to 0.38.0 (#9266) (#9284)
  • unify package.xml version to 0.37.0
  • remove system_monitor/CHANGELOG.rst
  • add changelog

  * 0.38.0

• refactor(component_interface_utils): prefix package and namespace with autoware (#9092)
• Contributors: Esteve Fernandez, Fumiya Watanabe, M. Fatih Cırıt, Ryohsuke Mitsudome, Yutaka Kondo

0.39.0 (2024-11-25)

• Merge commit '6a1ddbd08bd' into release-0.39.0
• fix: fix ticket links to point to https://github.com/autowarefoundation/autoware_universe (#9304)
• fix: fix ticket links to point to https://github.com/autowarefoundation/autoware_universe (#9304)
• chore(package.xml): bump version to 0.38.0 (#9266) (#9284)
  • unify package.xml version to 0.37.0
  • remove system_monitor/CHANGELOG.rst
  • add changelog

  * 0.38.0

• refactor(component_interface_utils): prefix package and namespace with autoware (#9092)
• Contributors: Esteve Fernandez, Yutaka Kondo

0.38.0 (2024-11-08)

• unify package.xml version to 0.37.0
• refactor(component_interface_specs): prefix package and namespace with autoware (#9094)
• feat(pose_initializer): check error initial pose and gnss pose, output diagnostics (#8947)
  • check initial pose error use GNSS pose
  • add pose_error_check_enabled parameter
  • fixed key value name
  • rename diagnostics key value
  • update README
  • fixed schema json
  • fixed type and default in schema json

  * rename key value ---------

• refactor(localization_util)!: prefix package and namespace with autoware (#8922) add autoware prefix to localization_util
• refactor(pose_initializer)!: prefix package and namespace with autoware (#8701)
  • add autoware_ prefix

  * fix link ---------Co-authored-by: SakodaShintaro <<shintaro.sakoda@tier4.jp>>

• Contributors: Esteve Fernandez, Masaki Baba, RyuYamamoto, Yutaka Kondo

0.26.0 (2024-04-03)