/full_coverage_path_planner

Full coverage path planning provides a move_base_flex plugin that can plan a path that will fully cover a given area

Primary LanguageC++Apache License 2.0Apache-2.0

Boustrophedon Full Coverage Path Planner (Modified)

Acknowledgement

This package is a modification of the Full Coverage Path Planner package from Nobleo.

It is modified such that a Boustrophedon Pattern is used to plan the path rather than a Spiral algorithm in the original package.

Refer to the original package here: http://wiki.ros.org/full_coverage_path_planner

Overview

This package provides an implementation of a Full Coverage Path Planner (FCPP) using the Boustrophedon Pattern. see [1] and [2].

This packages acts as a global planner plugin to the Move Base package (http://wiki.ros.org/move_base).

BSA

The user can configure robot radius and tool radius separately:

robot_plus_tool

Keywords: coverage path planning, move base

Authors

Apache 2.0

Package modified by Ethan Kim, ethanc.kim@uwaterloo.ca, MapaRobo Inc.

Author(s): Yury Brodskiy, Ferry Schoenmakers, Tim Clephas, Jerrel Unkel, Loy van Beek, Cesar lopez

Maintainer: Cesar Lopez, cesar.lopez@nobleo.nl

Affiliation: Nobleo Projects BV, Eindhoven, the Netherlands

The Modified package has been tested under [ROS] Noetic and Ubuntu 20.04.

Installation

Building from Source

Dependencies

Building

To build from source, clone the latest version from this repository into your workspace and compile the package using

cd catkin_workspace/src
git clone https://github.com/nobleo/full_coverage_path_planner.git
cd ../
catkin_make

Unit Tests

All tests can be run using:

catkin build full_coverage_path_planner --catkin-make-args run_tests

test_common

Unit test that checks the basic functions used by the repository

test_boustrophedon_stc

Unit test that checks the basis boustrophedon algorithm for full coverage. The test is performed for different situations to check that the algorithm coverage the accessible map cells. A test is also performed in randomly generated maps.

test_full_coverage_path_planner.test

ROS system test that checks the full coverage path planner together with a tracking pid. A simulation is run such that a robot moves to fully cover the accessible cells in a given map.

Usage

Run a full navigation example using:

roslaunch full_coverage_path_planner test_full_coverage_path_planner.launch

Give a 2D-goal in rviz to start path planning algorithm

Depends on:

mobile_robot_simulator that integrates /cmd_vel into a base_link TF-frame and an odometry publisher

tracking_pid Global path tracking controller

Launch files

test/full_coverage_path_planner/test_full_coverage_path_planner.launch

Runs the full_coverage_path_planner global planner in combination with tracking PID local planner. Moreover a coverage progress tracking node is launched to monitor the coverage progress. Mobile_robot_simulator is used to integrate cmd_vel output into TF and odometry.

Arguments:

  • map: path to a global costmap. Default: $(find full_coverage_path_planner)/maps/basement.yaml)
  • target_x_vel: target x velocity for use in interpolator. Default: 0.2
  • target_yaw_vel: target yaw velocity for use in interpolator. Default: 0.2
  • robot_radius: radius of the robot for use in the global planner. Default: 0.6
  • tool_radius: radius of the tool for use in the global planner. Default: 0.2

Start planning and tracking by giving a 2D nav goal.

Nodes

coverage_progress

The CoverageProgressNode keeps track of coverage progress. It does this by periodically looking up the position of the coverage disk in an occupancy grid. Cells within a radius from this position are 'covered'

Subscribed Topics

  • /tf ([tf2_msgs/TFMessage]) ros tf dynamic transformations
  • /tf_static ([tf2_msgs/TFMessage]) ros tf static transformations

Published Topics

  • /coverage_grid ([nav_msgs/OccupancyGrid]) occupancy grid to visualize coverage progress
  • /coverage_progress ([std_msgs/Float32]) monitors coverage (from 0 none to 1 full) on the given area

Services

  • /coverage_progress/reset ([std_srvs/SetBool]) resets coverage_progress node. For instance when robot position needs to be manually updated

Parameters

  • target_area/x: size in x of the target area to monitor
  • target_area/y: size in y of the target area to monitor
  • coverage_radius: radius of the tool to compute coverage progress

Plugins

full_coverage_path_planner/BoustrophedonSTC

For use in move_base(_flex) as "base_global_planner"="full_coverage_path_planner/BoustrophedonSTC". It uses global_cost_map and global_costmap/robot_radius.

Parameters

  • robot_radius: robot radius, which is used by the CPP algorithm to check for collisions with static map
  • tool_radius: tool radius, which is used by the CPP algorithm to discretize the space and find a full coverage plan

References

[1] Choset, Howie, and Philippe Pignon. "Coverage path planning: The boustrophedon cellular decomposition." Field and service robotics. Springer, London, 1998. [2] Zelinsky, Alexander, et al. "Planning paths of complete coverage of an unstructured environment by a mobile robot." Proceedings of international conference on advanced robotics. Vol. 13. 1993.

Acknowledgments from Original Authors

rosin_logo

Supported by ROSIN - ROS-Industrial Quality-Assured Robot Software Components. More information: rosin-project.eu

eu_flag

This project has received funding from the European Union’s Horizon 2020 research and innovation programme under grant agreement no. 732287.