#include <localization_node.hpp>

Inheritance diagram for autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >:

[legend]

Collaboration diagram for autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >:

[legend]

Public Types
using	LocalizerBase = localization_common::RelativeLocalizerBase< ObservationMsgT, MapMsgT, typename LocalizerT::RegistrationSummary >

using	LocalizerBasePtr = std::unique_ptr< LocalizerBase >

using	Cloud = sensor_msgs::msg::PointCloud2

using	PoseWithCovarianceStamped = typename LocalizerBase::PoseWithCovarianceStamped

using	TransformStamped = typename LocalizerBase::Transform

using	RegistrationSummary = typename LocalizerT::RegistrationSummary

Public Member Functions
	RelativeLocalizerNode (const std::string &node_name, const std::string &name_space, const TopicQoS &observation_sub_config, const TopicQoS &map_sub_config, const TopicQoS &pose_pub_config, const TopicQoS &initial_pose_sub_config, const PoseInitializerT &pose_initializer, LocalizerPublishMode publish_tf=LocalizerPublishMode::NO_PUBLISH_TF)

	RelativeLocalizerNode (const std::string &node_name, const rclcpp::NodeOptions &options, const PoseInitializerT &pose_initializer)

	RelativeLocalizerNode (const std::string &node_name, const std::string &name_space, const PoseInitializerT &pose_initializer)

const rclcpp::Publisher< PoseWithCovarianceStamped >::ConstSharedPtr	get_publisher ()
	Get a const pointer of the output publisher. Can be used for matching against subscriptions. More...

Protected Member Functions
void	set_localizer (LocalizerBasePtr &&localizer_ptr)

virtual void	on_bad_registration (std::exception_ptr eptr)
	Handle the exceptions during registration. More...

virtual void	on_bad_map (std::exception_ptr eptr)
	Handle the exceptions during map setting. More...

void	on_exception (std::exception_ptr eptr, const std::string &error_source)

virtual void	on_observation_with_invalid_map (typename ObservationMsgT::ConstSharedPtr)
	Default behavior when an observation is received with no valid existing map. More...

virtual void	on_invalid_output (PoseWithCovarianceStamped &pose)

virtual bool	validate_output (const RegistrationSummary &summary, const PoseWithCovarianceStamped &pose, const TransformStamped &guess)

Detailed Description

template<typename ObservationMsgT, typename MapMsgT, typename LocalizerT, typename PoseInitializerT>
class autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >

Base relative localizer node that publishes map->base_link relative transform messages for a given observation source and map.

Template Parameters

ObservationMsgT	Message type to register against a map.
MapMsgT	Map type
LocalizerT	Localizer type.
PoseInitializerT	Pose initializer type.

Member Typedef Documentation

◆ Cloud

template<typename ObservationMsgT , typename MapMsgT , typename LocalizerT , typename PoseInitializerT >

using autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >::Cloud = sensor_msgs::msg::PointCloud2

◆ LocalizerBase

template<typename ObservationMsgT , typename MapMsgT , typename LocalizerT , typename PoseInitializerT >

using autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >::LocalizerBase = localization_common::RelativeLocalizerBase<ObservationMsgT, MapMsgT, typename LocalizerT::RegistrationSummary>

◆ LocalizerBasePtr

template<typename ObservationMsgT , typename MapMsgT , typename LocalizerT , typename PoseInitializerT >

using autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >::LocalizerBasePtr = std::unique_ptr<LocalizerBase>

◆ PoseWithCovarianceStamped

template<typename ObservationMsgT , typename MapMsgT , typename LocalizerT , typename PoseInitializerT >

using autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >::PoseWithCovarianceStamped = typename LocalizerBase::PoseWithCovarianceStamped

◆ RegistrationSummary

template<typename ObservationMsgT , typename MapMsgT , typename LocalizerT , typename PoseInitializerT >

using autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >::RegistrationSummary = typename LocalizerT::RegistrationSummary

◆ TransformStamped

template<typename ObservationMsgT , typename MapMsgT , typename LocalizerT , typename PoseInitializerT >

using autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >::TransformStamped = typename LocalizerBase::Transform

Constructor & Destructor Documentation

◆ RelativeLocalizerNode() [1/3]

template<typename ObservationMsgT , typename MapMsgT , typename LocalizerT , typename PoseInitializerT >

autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >::RelativeLocalizerNode	(	const std::string &	node_name,
		const std::string &	name_space,
		const TopicQoS &	observation_sub_config,
		const TopicQoS &	map_sub_config,
		const TopicQoS &	pose_pub_config,
		const TopicQoS &	initial_pose_sub_config,
		const PoseInitializerT &	pose_initializer,
		LocalizerPublishMode	publish_tf = `LocalizerPublishMode::NO_PUBLISH_TF`
	)

inline

Constructor

Parameters

node_name	Name of node
name_space	Namespace of node
observation_sub_config	topic and QoS setting for the observation subscription.
map_sub_config	topic and QoS setting for the map subscription.
pose_pub_config	topic and QoS setting for the output pose publisher.
initial_pose_sub_config	topic and QoS setting for the initialpose subscription.
pose_initializer	Pose initializer.
publish_tf	Whether to publish to the `tf` topic. This can be used to publish transform messages when the relative localizer is the only source of localization.

◆ RelativeLocalizerNode() [2/3]

template<typename ObservationMsgT , typename MapMsgT , typename LocalizerT , typename PoseInitializerT >

autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >::RelativeLocalizerNode	(	const std::string &	node_name,
		const rclcpp::NodeOptions &	options,
		const PoseInitializerT &	pose_initializer
	)

inline

◆ RelativeLocalizerNode() [3/3]

template<typename ObservationMsgT , typename MapMsgT , typename LocalizerT , typename PoseInitializerT >

autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >::RelativeLocalizerNode	(	const std::string &	node_name,
		const std::string &	name_space,
		const PoseInitializerT &	pose_initializer
	)

inline

Constructor using ros parameters

Parameters

node_name	Node name
name_space	Node namespace
pose_initializer	Pose initializer

Member Function Documentation

◆ get_publisher()

template<typename ObservationMsgT , typename MapMsgT , typename LocalizerT , typename PoseInitializerT >

const rclcpp::Publisher<PoseWithCovarianceStamped>::ConstSharedPtr autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >::get_publisher ( )

inline

Get a const pointer of the output publisher. Can be used for matching against subscriptions.

◆ on_bad_map()

template<typename ObservationMsgT , typename MapMsgT , typename LocalizerT , typename PoseInitializerT >

virtual void autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >::on_bad_map ( std::exception_ptr eptr )

inlineprotectedvirtual

Handle the exceptions during map setting.

◆ on_bad_registration()

template<typename ObservationMsgT , typename MapMsgT , typename LocalizerT , typename PoseInitializerT >

virtual void autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >::on_bad_registration ( std::exception_ptr eptr )

inlineprotectedvirtual

Handle the exceptions during registration.

◆ on_exception()

template<typename ObservationMsgT , typename MapMsgT , typename LocalizerT , typename PoseInitializerT >

void autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >::on_exception	(	std::exception_ptr	eptr,
		const std::string &	error_source
	)

inlineprotected

◆ on_invalid_output()

template<typename ObservationMsgT , typename MapMsgT , typename LocalizerT , typename PoseInitializerT >

virtual void autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >::on_invalid_output ( PoseWithCovarianceStamped & pose )

inlineprotectedvirtual

Default behavior when hte pose output is evaluated to be invalid.

Parameters

pose	Pose output.

◆ on_observation_with_invalid_map()

template<typename ObservationMsgT , typename MapMsgT , typename LocalizerT , typename PoseInitializerT >

virtual void autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >::on_observation_with_invalid_map ( typename ObservationMsgT::ConstSharedPtr )

inlineprotectedvirtual

Default behavior when an observation is received with no valid existing map.

◆ set_localizer()

template<typename ObservationMsgT , typename MapMsgT , typename LocalizerT , typename PoseInitializerT >

void autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >::set_localizer ( LocalizerBasePtr && localizer_ptr )

inlineprotected

Set the localizer.

Parameters

localizer_ptr rvalue to the localizer to set.

◆ validate_output()

template<typename ObservationMsgT , typename MapMsgT , typename LocalizerT , typename PoseInitializerT >

virtual bool autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >::validate_output	(	const RegistrationSummary &	summary,
		const PoseWithCovarianceStamped &	pose,
		const TransformStamped &	guess
	)

inlineprotectedvirtual

Validate the pose estimate given the registration summary and the initial guess. This function by default returns true.

Parameters

summary	Registration summary.
pose	Pose estimate.
guess	Initial guess.

Returns: True if the estimate is valid and can be published.

The documentation for this class was generated from the following file:

localization_node.hpp

Public Types

Public Member Functions

Protected Member Functions

Detailed Description

template<typename ObservationMsgT, typename MapMsgT, typename LocalizerT, typename PoseInitializerT> class autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >

Member Typedef Documentation

◆ Cloud

◆ LocalizerBase

◆ LocalizerBasePtr

◆ PoseWithCovarianceStamped

◆ RegistrationSummary

◆ TransformStamped

Constructor & Destructor Documentation

◆ RelativeLocalizerNode() [1/3]

◆ RelativeLocalizerNode() [2/3]

◆ RelativeLocalizerNode() [3/3]

Member Function Documentation

◆ get_publisher()

◆ on_bad_map()

◆ on_bad_registration()

◆ on_exception()

◆ on_invalid_output()

◆ on_observation_with_invalid_map()

◆ set_localizer()

◆ validate_output()

template<typename ObservationMsgT, typename MapMsgT, typename LocalizerT, typename PoseInitializerT>
class autoware::localization::localization_nodes::RelativeLocalizerNode< ObservationMsgT, MapMsgT, LocalizerT, PoseInitializerT >