Traversability Estimation

Overview

ROS2 Humble port for Traversability mapping for mobile rough terrain navigation.

The Traversability Estimation package has been tested under [ROS2] Humble and Ubuntu 22.04. This is research code, expect that it changes often and any fitness for a particular purpose is disclaimed.

Authors: Martin Wermelinger, Peter Fankhauser, Ralf Kaestner
Contact: Martin Wermelinger, [email protected]
Affiliation: Robotic Systems Lab, ETH Zurich

Installation

Dependencies

This software is built on the Robotic Operating System ([ROS2]), which needs to be installed first. Additionaly, the Traversability Estimation depends on following software:

• Robot Operating System (ROS) (middleware for robotics),
• Eigen (linear algebra library),
• kindr (kinematics and dynamics library for robotics),
• Grid Map (grid map library for mobile robots),
• Elevation Map (elevation mapping with a mobile robot),

Important Note:

• I have removed the dependency of ParamIO and use the default ROS2 functionality to get and set ROS2 Parameters.
• I have ported the elevation mapping package to ROS2 HUmble as well, it still needs some formatting will be sharing that soon.

Building

In order to install, clone the latest version from this repository into your catkin workspace and compile the package using

cd ws/src
git clone https://github.com/Muhammad540/traversability_estimation.git
cd ../
colcon build traversability_estimation

Unit Tests

No unit tests so far.

Basic Usage

In order to get the Traversability estimation to run with your robot, you will need to adapt a few parameters in the config-files. It is the easiest if you duplicate the file robot.yaml, robot_footprint.yaml, and filter_parameter.yaml in traversability_estimation/config and adapt all the parameters you need to change. Then, duplicate the launch-file traversability_estimation/launch/traversability_estimation.launch and change the entries to point at your files. You can then launch the traversability map node with

ros2 launch traversability_estimation traversability_estimation.launch

Proceed in the same way for the traversability map visualization by adapting the launch-file traversability_estimation/launch/visualization.launch. You can then launch the traversability map visualization node with

ros2 launch traversability_estimation visualization.launch

Use rviz2 to visualize the traversability map.

Nodes

traversability_estimation

This is the main Traversability Estimation node. It uses the elevation map and the traversability estimation filters to generate a traversability map.

Subscribed Topics

• /image_elevation ([sensor_msgs/Image])

    It is possible to subscribe to an image. The image is converted into a grayscale image and the values are mapped into an elevation map.
  

• ~/initial_elevation_map ([grid_map_msgs/GridMap])

  It is possible to subscribe to a grid map. The elevation layer of the input grid map is used to compute the traversability map.
  

Published Topics

• traversability_map ([grid_map_msgs/GridMap])

  The current traversability map. The traversability map can be configured with the traversability filters.

Services

• load_elevation_map ([grid_map_msgs/ProcessFile])

  Trigger the loading of an elevation map from a [rosbag] file. Trigger the loading of the map with

    rosservice call /traversability_estimation/load_elevation_map "file_path: '/home/user/your_elevation_bag.bag' topic_name: 'elevation_topic_name'"
  

• update_traversability ([grid_map_msgs/GetGridMapInfo])

  Forces an update of the traversability map, using the current elevation map. The update can be triggered with

    rosservice call /traversability_estimation/update_traversability
  

• get_traversability ([grid_map_msgs/GetGridMap])

  Request the current traversability map or a submap of it. For example, you can get the traversability submap at position (-1.0, 0.0) and size (2.5, 2.0) and safe it to a text file form the console with

    rosservice call -- /traversability_estimation/get_traversability -1.0 0.0 2.5 2.0 []
  

• check_footprint_path ([traversability_msgs/CheckFootprintPath])

  This service is used to check the traversability of a single footprint or a path of several footprints. The current traversability map is used to evaluate the footprints.

• update_parameters ([std_srvs/Empty])

  Use this service to update the parameters of the traversability estimation filters. It reloads the parameter file and sets the new parameters. Trigger the parameter update with

    rosservice call /traversability_estimation/update_parameters
  

• traversability_footprint ([std_srvs/Empty])

  Computes the traversability of a circular footprint at each map position and stores the values in an additional map layer. This service is intended for visualizing the traversability and debugging. Trigger the traversability computation with

    rosservice call /traversability_estimation/traversability_footprint
  

• save_traversability_map_to_bag ([grid_map_msgs/ProcessFile])

  Save all layers of the current traversability map to a [rosbag] file. Save the traversability map with

    rosservice call /traversability_estimation/save_traversability_map_to_bag "file_path: '/home/user/your_bag.bag' topic_name: 'traversability_map_topic_name'"
  

Parameters

• submap_service (string, default: "/elevation_mapping/get_grid_map")

  The name of the service to get the elevation submap.

• use_raw_map (bool, default: false)

  A boolean to update the traversability map either with the raw or fused elevation map.

• robot_frame_id (string, default: "base")

  The id of the robot tf frame.

• map_frame_id (string, default: "map")

  The id of the tf frame of the traversability map. This id must be the same as the input elevation submap.

• update_rate (double, default: 4.0)

  The update rate (in [Hz]) at which the traversability map is updated.

• map_center_x, map_center_y (double, default: 1.5, 0.0)

  The position of the traversability map (center) in the traversability map frame.

• map_length_x, map_length_y (double, default: 5.0)

  The size (in [m]) of the traversability map.

• traversability_map_filters: (filter_chain)

  Defines the different filters that are used to generate the traversability map.

• traversability_default (double, default: 0.5)

  Defines the default value for traversability of unknown regions in the traversability map.

• grid_map_to_initialize_traversability_map/enable (bool, default: false)

  Defines if the input topic ~/initial_elevation_map can be accepted to initialize the traversability map.

• grid_map_to_initialize_traversability_map/grid_map_topic_name (string, default: initial_elevation_map)

  Defines the input topic name for the grid map message to be used to initialize the traversability map.

Traversability Estimation Filters

The traversability estimation filters can be applied to an elevation map. Each filter adds an additional layer to the elevation map and computes a value for every cell of the map.

• Surface Normals Filter: Computes the surface normal of each cell of an elevation map. Each component of the surface normal is saved separatly.

• Slope Filter: Computes the slope traversability value based on an elevation map.

• Roughness Filter: Computes the roughness traversability value based on an elevation map.

• Step Filter: Compute the step traversability value based on an elevation map.

Bugs & Feature Requests

Please report bugs and request features using the Issue Tracker.