map_loader package#

This package provides the features of loading various maps.

pointcloud_map_loader#

Feature#

pointcloud_map_loader provides pointcloud maps to the other Autoware nodes in various configurations. Currently, it supports the following two types:

Publish raw pointcloud map
Publish downsampled pointcloud map
Send partial pointcloud map loading via ROS 2 service
Send differential pointcloud map loading via ROS 2 service

Prerequisites#

Prerequisites on pointcloud map file(s)#

You may provide either a single .pcd file or multiple .pcd files. If you are using multiple PCD data and either of enable_partial_load, enable_differential_load or enable_selected_load are set true, it MUST obey the following rules:

It must be divided by straight lines parallel to the x-axis and y-axis. The system does not support division by diagonal lines or curved lines.
The division size along each axis should be equal.
The division size should be about 20m x 20m. Particularly, care should be taken as using too large division size (for example, more than 100m) may have adverse effects on dynamic map loading features in ndt_scan_matcher and compare_map_segmentation.
All the split maps should not overlap with each other.
Metadata file should also be provided. The metadata structure description is provided below.

Note that these rules are not applicable when enable_partial_load, enable_differential_load and enable_selected_load are all set false. In this case, however, you also need to disable dynamic map loading mode for other nodes as well (ndt_scan_matcher and compare_map_segmentation as of June 2023).

Metadata structure#

The metadata should look like this:

x_resolution: 20.0
y_resolution: 20.0
A.pcd: [1200, 2500] # -> 1200 < x < 1220, 2500 < y < 2520
B.pcd: [1220, 2500] # -> 1220 < x < 1240, 2500 < y < 2520
C.pcd: [1200, 2520] # -> 1200 < x < 1220, 2520 < y < 2540
D.pcd: [1240, 2520] # -> 1240 < x < 1260, 2520 < y < 2540

where,

x_resolution and y_resolution
A.pcd, B.pcd, etc, are the names of PCD files.
List such as [1200, 2500] are the values indicate that for this PCD file, x coordinates are between 1200 and 1220 (x_resolution + x_coordinate) and y coordinates are between 2500 and 2520 (y_resolution + y_coordinate).

You may use pointcloud_divider from MAP IV for dividing pointcloud map as well as generating the compatible metadata.yaml.

Directory structure of these files#

If you only have one pointcloud map, Autoware will assume the following directory structure by default.

sample-map-rosbag
├── lanelet2_map.osm
├── pointcloud_map.pcd

If you have multiple rosbags, an example directory structure would be as follows. Note that you need to have a metadata when you have multiple pointcloud map files.

sample-map-rosbag
├── lanelet2_map.osm
├── pointcloud_map.pcd
│ ├── A.pcd
│ ├── B.pcd
│ ├── C.pcd
│ └── ...
└── pointcloud_map_metadata.yaml

Specific features#

Publish raw pointcloud map (ROS 2 topic)#

The node publishes the raw pointcloud map loaded from the .pcd file(s).

Publish downsampled pointcloud map (ROS 2 topic)#

The node publishes the downsampled pointcloud map loaded from the .pcd file(s). You can specify the downsample resolution by changing the leaf_size parameter.

Publish metadata of pointcloud map (ROS 2 topic)#

The node publishes the pointcloud metadata attached with an ID. Metadata is loaded from the .yaml file. Please see the description of PointCloudMapMetaData.msg for details.

Send partial pointcloud map (ROS 2 service)#

Here, we assume that the pointcloud maps are divided into grids.

Given a query from a client node, the node sends a set of pointcloud maps that overlaps with the queried area. Please see the description of GetPartialPointCloudMap.srv for details.

Send differential pointcloud map (ROS 2 service)#

Here, we assume that the pointcloud maps are divided into grids.

Given a query and set of map IDs, the node sends a set of pointcloud maps that overlap with the queried area and are not included in the set of map IDs. Please see the description of GetDifferentialPointCloudMap.srv for details.

Send selected pointcloud map (ROS 2 service)#

Here, we assume that the pointcloud maps are divided into grids.

Given IDs query from a client node, the node sends a set of pointcloud maps (each of which attached with unique ID) specified by query. Please see the description of GetSelectedPointCloudMap.srv for details.

Parameters#

Name	Type	Description	Default value
enable_whole_load	bool	A flag to enable raw pointcloud map publishing	true
enable_downsampled_whole_load	bool	A flag to enable downsampled pointcloud map publishing	false
enable_partial_load	bool	A flag to enable partial pointcloud map server	false
enable_differential_load	bool	A flag to enable differential pointcloud map server	false
enable_selected_load	bool	A flag to enable selected pointcloud map server	false
leaf_size	float	Downsampling leaf size (only used when enable_downsampled_whole_load is set true)	3.0
pcd_paths_or_directory	std::string	Path(s) to pointcloud map file or directory
pcd_metadata_path	std::string	Path to pointcloud metadata file

Interfaces#

output/pointcloud_map (sensor_msgs/msg/PointCloud2) : Raw pointcloud map
output/pointcloud_map_metadata (autoware_map_msgs/msg/PointCloudMapMetaData) : Metadata of pointcloud map
output/debug/downsampled_pointcloud_map (sensor_msgs/msg/PointCloud2) : Downsampled pointcloud map
service/get_partial_pcd_map (autoware_map_msgs/srv/GetPartialPointCloudMap) : Partial pointcloud map
service/get_differential_pcd_map (autoware_map_msgs/srv/GetDifferentialPointCloudMap) : Differential pointcloud map
service/get_selected_pcd_map (autoware_map_msgs/srv/GetSelectedPointCloudMap) : Selected pointcloud map
pointcloud map file(s) (.pcd)
metadata of pointcloud map(s) (.yaml)

lanelet2_map_loader#

Feature#

lanelet2_map_loader loads Lanelet2 file and publishes the map data as autoware_auto_mapping_msgs/HADMapBin message. The node projects lan/lon coordinates into MGRS coordinates.

How to run#

ros2 run map_loader lanelet2_map_loader --ros-args -p lanelet2_map_path:=path/to/map.osm

Published Topics#

~output/lanelet2_map (autoware_auto_mapping_msgs/HADMapBin) : Binary data of loaded Lanelet2 Map

lanelet2_map_visualization#

Feature#

lanelet2_map_visualization visualizes autoware_auto_mapping_msgs/HADMapBin messages into visualization_msgs/MarkerArray. There are 3 types of map can be loaded in autoware. Please make sure you selected the correct lanelet2_map_projector_type when you launch this package.

MGRS
UTM
local

How to Run#

ros2 run map_loader lanelet2_map_visualization

Subscribed Topics#

~input/lanelet2_map (autoware_auto_mapping_msgs/HADMapBin) : binary data of Lanelet2 Map

Published Topics#

~output/lanelet2_map_marker (visualization_msgs/MarkerArray) : visualization messages for RViz

Parameters#

Name	Type	Description	Default value
lanelet2_map_projector_type	std::string	The type of the map projector using, can be MGRS, UTM, local	MGRS
latitude	double	Latitude of map_origin, only using in UTM map projector	0.0
longitude	double	Longitude of map_origin, only using in UTM map projector	0.0
center_line_resolution	double	Define the resolution of the lanelet center line	5.0
lanelet2_map_path	std::string	The lanelet2 map path	None