Home

Awesome

Plane Seg CI

ANYmal climbing a real staircase

Plane Seg is a library for fitting planes to LIDAR, depth camera data or elevation maps. It uses robust estimation to fit planes by clustering planar points with similar normals.

We assume the ROS build system (e.g. Melodic). The core library (plane-seg) is only dependent on PCL. The ROS application (plane-seg-ros) can process PointCloud2 and GridMap data types.

The edge detection package depends on Rviz Visual Tools and on the Locomotion Viewer library.

Using It

Run-Time Application: A sample application (for ANYmal) can be run and visualized (in Rviz) as follows:

roslaunch plane_seg_ros anymal.launch
roslaunch plane_seg_ros view_plane_seg.launch

Test program: reads example point clouds (PCDs), processes them and executes the fitting algorithm:

roslaunch plane_seg_ros test.launch
roslaunch plane_seg_ros view_plane_seg.launch

Run edge detection:

rosrun edge_detection_ros edge_detection_ros

Input

Input should be a point cloud or elevation map in the robot's odometry frame as well as the pose of the robot in the odometry frame. The elevation map is assumed to be at a 1-2 Hz.

Output

  1. A series of planar convex hulls published to ROS at 1-2 Hz
  1. A series of line segments (edges) of published to ROS at 1-2 Hz. The minimum lenght of the edges can be adjusted, as much as the minimum height required to detect a new step.

Performance

Authors

Originally Developed as part of the DARPA Robotics Challenge project at MIT. Subsequent improvements and conversion to ROS was carried out at the DRS Group in Oxford during the MEMMO EU H2020 Project.

Maintainers: DRS Group at Oxford Robotics Institute<br /> Original Author: Matt Antone (then at MIT)

The source code is released under a BSD 3-Clause license.

Citing this work

If you use this work in an academic context, please use the following:

Other Images

Segmenting the DARPA Robotics Challenge terrain:

drc terrain segmentation

Actual DRC Finals terrain (not quite the same scene):

drc terrain photo

Video of ANYmal climbing a simulated staircase in Gazebo:

ANYmal climbing a simulated staircase in Gazebo