This directory is part of a subtree fetched from https://github.com/CPFL/sick_ldmrs_laser on the Autoware branch, a fork from the original https://github.com/SICKAG/sick_ldmrs_laser
This repo adds specific functions for Autoware. If you need to modify any file inside this folder structure, please use the following commands to either push or fetch changes from the subtree. All the commands written here will suppose you're in the root of Autoware path.
Bring latest commits from https://github.com/CPFL/sick_ldmrs_laser
git subtree pull --prefix ros/src/sensing/drivers/lidar/packages/sick/ldmrs/sick_ldmrs_laser https://github.com/CPFL/sick_ldmrs_laser Autoware --squash
If you made any modification to the subtree you are encouraged to commit and publish your changes to the fork. You can do with the following command.
git subtree push --prefix ros/src/sensing/drivers/lidar/packages/sick/ldmrs/sick_ldmrs_laser https://github.com/CPFL/sick_ldmrs_laser Autoware
Original README below
This stack provides a ROS driver for the SICK LD-MRS series of laser scanners. The SICK LD-MRS is a multi-layer, multi-echo 3D laser scanner that is geared towards rough outdoor environments and also provides object tracking. The driver also works for the identical devices from IBEO.
This driver should work with all of the following products. However, it has only been tested and confirmed working on the LD-MRS800001S01 so far. If you try any of the other scanners and run into trouble, please open an issue.
| device name | identical to | part no. | description | tested? |
|---|---|---|---|---|
| LD-MRS400001 | 1045046 | 4 layer (standard) | ✔ | |
| LD-MRS400001S01 | IBEO LUX Standard | 1052960 | 4 layer (standard, includes object tracking) | ✔ |
| LD-MRS400102 HD | 1047145 | 4 layer (heavy duty) | ✔ | |
| LD-MRS400102S01 HD | IBEO LUX HD | 1052961 | 4 layer (heavy duty, includes object tracking) | |
| LD-MRS800001S01 | IBEO LUX 8L | 1069408 | 8 layer (standard) | ✔ |
In the following instructions, replace <rosdistro> with the name of your ROS distro (e.g., indigo).
The driver has not been released yet. But once that happens, you can install it directly by typing:
sudo apt-get install ros-<rosdistro>-sick-ldmrs-laser
source /opt/ros/<rosdistro>/setup.bash
mkdir -p ~/ros_catkin_ws/src/
cd ~/ros_catkin_ws/src/
git clone https://github.com/SICKAG/libsick_ldmrs.git
git clone -b <rosdistro> https://github.com/SICKAG/sick_ldmrs_laser.git
cd ..
catkin_make_isolated --install -DCMAKE_BUILD_TYPE=Release
source ~/ros_catkin_ws/install_isolated/setup.bashroslaunch sick_ldmrs_tools sick_ldmrs_demo.launch
rosrun rviz rviz -d $(rospack find sick_ldmrs_tools)/config/sick_ldmrs.rviz
rosrun rqt_reconfigure rqt_reconfigure
rosrun rqt_robot_monitor rqt_robot_monitor-
sick_ldmrs_driver: This package provides the main driver node,
sick_ldmrs_node. -
sick_ldmrs_description: This package provides an URDF description of the scanner along with the corresponding mesh.
-
sick_ldmrs_msgs: This package provides ROS message definitions for the scanner's object tracking functionality and a PCL point type used in the PointCloud2 topic.
-
sick_ldmrs_tools: This package provides example nodes that demonstrate how to subscribe to the topics provided by the scanner and use the data:
sick_ldmrs_filter_first: Filters the point cloud and only output the first echo of each beam.sick_ldmrs_filter_last: Filters the point cloud and only output the last echo of each beam.sick_ldmrs_filter_layer: Filters the point cloud and only output points from the second layer.sick_ldmrs_object_marker: Subscribes to theobjectstopic and publishes the object tracking information as visualization_msgs/MarkerArray for visualization in RViz.sick_ldmrs_all_layer_assembler: Subscribes to the point cloud, transforms it into a fixed frame and assembles one point clouds of the lower four layers and one of the upper four layers into a point cloud of all eight layers.sick_ldmrs_make_organized: Subscribes to the point cloud and turns it into an organized point cloud.sick_ldmrs_remove_background: Removes static background points from an organized input point cloud, assuming the scanner is stationary.sick_ldmrs_print_resolution: Subscribes to the point cloud and prints the angular resolution sectors. Useful to verify that the FocusedRes / FlexRes features are working as expected.
cloud (sensor_msgs/PointCloud2)
- The published point cloud. The meaning of the fields is documented in sick_ldmrs_point_type.h.
objects (sick_ldmrs_msgs/ObjectArray)
- The output of the object tracking functionality of the scanner. See ObjectArray.msg and Object.msg.
diagnostics (diagnostic_msgs/DiagnosticArray)
- ROS diagnostics information.
See the dynamic_reconfigure package for details on dynamically reconfigurable parameters.
~frame_id (str, default: ldmrs)
- The TF frame in which point clouds will be returned.
~start_angle (double, default: 0.872664625997)
- The angle of the first range measurement [rad]. Range: -1.04610672041 to 0.872664625997
~end_angle (double, default: -1.0471975512)
- The angle of the last range measurement [rad]. Range: -1.0471975512 to 0.871573795215
~scan_frequency (int, default: 0)
- Scan frequency. Possible values are: ScanFreq1250 (0): Scan frequency 12.5 Hz, ScanFreq2500 (1): Scan frequency 25.0 Hz, ScanFreq5000 (2): Scan frequency 50.0 Hz.
~sync_angle_offset (double, default: 0.0)
- Angle under which the LD-MRS measures at the time of the sync pulse [rad]. Range: -3.14159265359 to 3.1410472382
~angular_resolution_type (int, default: 1)
- Angular resolution type. Possible values are: FocusedRes (0): Focused resolution, ConstantRes (1): Constant resolution (0.25° @ 12.5 Hz / 0.25° @ 25.0 Hz / 0.5° @ 50.0 Hz), FlexRes (2): Flexible resolution
~layer_range_reduction (int, default: 0)
- Possible values are: RangeFull (0): All layers full range, RangeLowerReduced (1): Lower 4 layers reduced range, RangeUpperReduced (2): Upper 4 layers reduced range, RangeAllReduced (3): All 8 layers reduced range.
~ignore_near_range (bool, default: False)
- Ignore scan points up to 15m. Requires
layer_range_reduction= RangeLowerReduced.
~sensitivity_control (bool, default: False)
- Reduce the sensitivity automatically in case of extraneous light.
~flexres_start_angle1 (double, default: 0.872664625997)
- FlexRes: start angle of sector 1. Range: -1.04610672041 to 0.872664625997
~flexres_start_angle2 (double, default: 0.610865238198)
- FlexRes: start angle of sector 2. Range: -1.04610672041 to 0.872664625997
~flexres_start_angle3 (double, default: 0.523598775598)
- FlexRes: start angle of sector 3. Range: -1.04610672041 to 0.872664625997
~flexres_start_angle4 (double, default: 0.349065850399)
- FlexRes: start angle of sector 4. Range: -1.04610672041 to 0.872664625997
~flexres_start_angle5 (double, default: 0.0)
- FlexRes: start angle of sector 5. Range: -1.04610672041 to 0.872664625997
~flexres_start_angle6 (double, default: -0.349065850399)
- FlexRes: start angle of sector 6. Range: -1.04610672041 to 0.872664625997
~flexres_start_angle7 (double, default: -0.523598775598)
- FlexRes: start angle of sector 7. Range: -1.04610672041 to 0.872664625997
~flexres_start_angle8 (double, default: -0.698131700798)
- FlexRes: start angle of sector 8. Range: -1.04610672041 to 0.872664625997
~flexres_resolution1 (int, default: 32)
- FlexRes: angular resolution of sector 1. Possible values are: Res0125 (4): Angular resolution 0.125 degrees, Res0250 (8): Angular resolution 0.25 degrees, Res0500 (16): Angular resolution 0.5 degrees, Res1000 (32): Angular resolution 1.0 degrees
~flexres_resolution2 (int, default: 16)
- FlexRes: angular resolution of sector 2. Possible values are: Res0125 (4): Angular resolution 0.125 degrees, Res0250 (8): Angular resolution 0.25 degrees, Res0500 (16): Angular resolution 0.5 degrees, Res1000 (32): Angular resolution 1.0 degrees
~flexres_resolution3 (int, default: 8)
- FlexRes: angular resolution of sector 3. Possible values are: Res0125 (4): Angular resolution 0.125 degrees, Res0250 (8): Angular resolution 0.25 degrees, Res0500 (16): Angular resolution 0.5 degrees, Res1000 (32): Angular resolution 1.0 degrees
~flexres_resolution4 (int, default: 4)
- FlexRes: angular resolution of sector 4. Possible values are: Res0125 (4): Angular resolution 0.125 degrees, Res0250 (8): Angular resolution 0.25 degrees, Res0500 (16): Angular resolution 0.5 degrees, Res1000 (32): Angular resolution 1.0 degrees
~flexres_resolution5 (int, default: 8)
- FlexRes: angular resolution of sector 5. Possible values are: Res0125 (4): Angular resolution 0.125 degrees, Res0250 (8): Angular resolution 0.25 degrees, Res0500 (16): Angular resolution 0.5 degrees, Res1000 (32): Angular resolution 1.0 degrees
~flexres_resolution6 (int, default: 16)
- FlexRes: angular resolution of sector 6. Possible values are: Res0125 (4): Angular resolution 0.125 degrees, Res0250 (8): Angular resolution 0.25 degrees, Res0500 (16): Angular resolution 0.5 degrees, Res1000 (32): Angular resolution 1.0 degrees
~flexres_resolution7 (int, default: 32)
- FlexRes: angular resolution of sector 7. Possible values are: Res0125 (4): Angular resolution 0.125 degrees, Res0250 (8): Angular resolution 0.25 degrees, Res0500 (16): Angular resolution 0.5 degrees, Res1000 (32): Angular resolution 1.0 degrees
~flexres_resolution8 (int, default: 16)
- FlexRes: angular resolution of sector 8. Possible values are: Res0125 (4): Angular resolution 0.125 degrees, Res0250 (8): Angular resolution 0.25 degrees, Res0500 (16): Angular resolution 0.5 degrees, Res1000 (32): Angular resolution 1.0 degrees
~contour_point_density (int, default: 2)
- Contour point density. Possible values are: ClosestPointOnly (0): Closest point only, LowDensity (1): Low density, HighDensity(2): High density
~min_object_age (int, default: 0)
- Minimum tracking age (number of scans) of an object to be transmitted. Range: 0 to 65535
~max_prediction_age (int, default: 0)
- Maximum prediction age (number of scans) of an object to be transmitted. Range: 0 to 65535
~hostname (string, default: "192.168.0.1")
- The host name or IP address of the laser scanner.
Please observe the following constraints when setting the FlexRes parameters (user-defined sectors of angular resolution):
- The start angles of each sector have to be given in decreasing order (i.e.,
flexres_start_angle1 > flexres_start_angle2etc.) - The sectors with a resolution of 0.125° must not sum up to more than 20°.
- The number of shots per scan must be at most 440. (This corresponds to an average angular resolution of 0.25° over the full 110° range.)
The reason for the last two constraints is that the scanner increases the shooting frequency when increasing angular resolution. To avoid overheating the scanner and limit the amount of data to be processed, it's not possible to use 0.125° angular resolution for the full range.
The scanner provides a number of parameters that are not exposed via the ROS API. Specifically:
- A number of vehicle-related parameters (vehicle velocity, axis lengths, mounting position of the scanner). The "ROS way" of handling this is to use URDF to specify the position of the scanner and other forms of localization to provide the transform between world and scanner coordinates.
- The
upside_downparameter. In ROS, this is also better handled by specifying the scanner mounting position in the URDF. This driver will print a warning if theupside_downparameter was set externally. - SOPAS fields and eval cases.
- Setting the TCP/IP configuration of the scanner. Not supported by this driver to avoid accidentally making the scanner unaccessible; use the software provided with the scanner instead.
