1 Star 1 Fork 0

AxIMMS_ROS / laser_line_extraction

加入 Gitee
与超过 1200万 开发者一起发现、参与优秀开源项目,私有仓库也完全免费 :)
免费加入
克隆/下载
贡献代码
同步代码
取消
提示: 由于 Git 不支持空文件夾,创建文件夹后会生成空的 .keep 文件
Loading...
README
BSD-3-Clause

Laser Line Extraction

Laser Line Extraction is a Robot Operating System (ROS) package that extracts line segments form LaserScan messages. Created by Marc Gallant, originally for use in the Mining Systems Laboratory. Here is what the Laser Line Extraction package looks like in action:

Laser line extraction

In the above image, the white dots are points in a LaserScan message, and the red lines are what is extracted by Laser Line Extraction. This data was collected by driving a robot through Beamish-Munro Hall at Queen's University. A SICK LMS111 laser scanner was mounted to the robot. The extraction algorithm is very configurable; the above image used the parameters configured in the example.launch launch file.

After applying some filters to remove outlying points, Laser Line Extraction implements a split-and-merge algorithm to determine which points belong to lines. Next, it implements the weighted line fitting algorithm by Pfister et al. [1] to find the best fit lines and their respective covariance matrices.

Usage

I recommend making a copy of example.launch in the launch directory and configuring the parameters until you reach a desirable outcome. The parameters in example.launch are a good starting point. Then simply use roslaunch, e.g.,

roslaunch laser_line_extraction example.launch

Messages

Laser Line Extraction has two messages types:

LineSegment.msg

float32 radius
float32 angle
float32[4] covariance
float32[2] start
float32[2] end

radius (m) and angle (rad) are the polar parameterization of the line segment. covariance is the 2x2 covariance matrix of radius and angle (listed in row-major order). Finally start and end are the (x, y) coordinates of the start and end of the line segment.

LineSegmentList.msg

Header header
LineSegment[] line_segments

An array of LineSegment.msg with a header.

Topics

Laser Line Extraction subscribes to a single topic and publishes one or two topics.

Subscribed topics

Published topics

  • /line_segments (laser_line_extraction/LineSegmentList)
    • A list of line segments extracted from a laser scan.
  • /line_markers (visualization_msgs/Marker)
    • (optional) Markers so that the extracted lines can be visualized in rviz (see above image). Can be toggled (see Parameters).

Parameters

The parameters are listed in alphabetical order.

  • bearing_std_dev (default: 0.001)
    • The standard deviation of bearing uncertainty in the laser scans (rad).
  • frame_id (default: "laser")
    • The frame in which the line segments are published.
  • least_sq_angle_thresh (default: 0.0001)
    • Change in angle (rad) threshold to stop iterating least squares (least_sq_radius_thresh must also be met).
  • least_sq_radius_thresh (default: 0.0001)
    • Change in radius (m) threshold to stop iterating least squares (least_sq_angle_thresh must also be met).
  • max_line_gap (default: 0.4)
    • The maximum distance between two points in the same line (m).
  • min_line_length (default: 0.5)
    • Lines shorter than this are not published (m).
  • min_line_points (default: 9)
    • Lines with fewer points than this are not published.
  • min_range (default: 0.4)
    • Points closer than this are ignored (m).
  • min_split_dist (default: 0.05)
    • When performing "split" step of split and merge, a split between two points results when the two points are at least this far apart (m).
  • outlier_dist (default: 0.05)
    • Points who are at least this distance from all their neighbours are considered outliers (m).
  • publish_markers (default: false)
    • Whether or not markers are published.
  • range_std_dev (default: 0.02)
    • The standard deviation of range uncertainty in the laser scans (m).
  • scan_topic (default: "scan")
    • The LaserScan topic.

References

[1] S. T. Pfister, S. I. Roumeliotis, and J. W. Burdick, "Weighted line fitting algorithms for mobile robot map building and efficient data representation" in Proc. IEEE Intl. Conf. on Robotics and Automation (ICRA), Taipei, Taiwan, 14-19 Sept., 2003.

Copyright (c) 2014, Marc Gallant All rights reserved. Redistribution and use in source and binary forms, with or without modification, are permitted provided that the following conditions are met: * Redistributions of source code must retain the above copyright notice, this list of conditions and the following disclaimer. * Redistributions in binary form must reproduce the above copyright notice, this list of conditions and the following disclaimer in the documentation and/or other materials provided with the distribution. * Neither the name of the {organization} nor the names of its contributors may be used to endorse or promote products derived from this software without specific prior written permission. THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.

简介

暂无描述 展开 收起
BSD-3-Clause
取消

发行版

暂无发行版

贡献者

全部

近期动态

加载更多
不能加载更多了
1
https://gitee.com/IMMS_ROS/laser_line_extraction.git
git@gitee.com:IMMS_ROS/laser_line_extraction.git
IMMS_ROS
laser_line_extraction
laser_line_extraction
master

搜索帮助