sick_safetyscanners2

ROS2 Driver for the SICK safetyscanners

README

Sick_Safetyscanners ROS2 Driver

A ROS2 Driver which reads the raw data from the SICK Safety Scanners and publishes the data as a laser_scan msg.

The ROS1 Driver can be found here: https://github.com/SICKAG/sick_safetyscanners

Table of contents

Supported Hardware

Supported are all microScan3, nanoScan3 and outdoorScan3 variants with Ethernet connection.

Getting started

In the future the ROS2 driver will be released as a debian package, currently only build from source is supported.

Prerequisites

  • Linux

  • Working ROS-Distro

  • Correctly setup SICK Safety Scanner

  • Connected SICK Safety Scanner and a correctly setup ethernet network. Both the host and the sensor have to be in the same network.

Installation

Dependencies

Dependencies can be installed via

sudo apt-get install ros-<rosdistro>-sick-safetyscanners2-interfaces
sudo apt-get install ros-<rosdistro>-sick-safetyscanners-base

The sources can be found here:

  • sick_safetyscanners_base (https://github.com/SICKAG/sick_safetyscanners_base)

  • sick_safetyscanners2_interfaces (https://github.com/SICKAG/sick_safetyscanners2_interfaces)

From Source
source /opt/ros/<rosdistro>/setup.bash
mkdir -p ~/colcon_ws/src/
cd ~/colcon_ws/src/
git clone https://github.com/SICKAG/sick_safetyscanners2.git
cd ..
colcon build --symlink-install
source ~/colcon_ws/install/setup.sh

Starting

Classic Node

To start the driver the launch file has to be started. For the driver to work correctly, the sensor ip and host ip have to be defined. These parameters can be passed to the sensor as arguments via launch file.

ros2 launch sick_safetyscanners2 sick_safetyscanners2_launch.py

This will start the driver with the in launch file defined parameters.

Lifecycle Node

To start the driver within a lifecycle the launch file has to be started. For the driver to work correctly, the sensor ip and host ip have to be defined. These parameters can be passed to the sensor as arguments via launch file.

ros2 launch sick_safetyscanners2 sick_safetyscanners2_lifecycle_launch.py

This will start the driver with the in launch file defined parameters.

To configure and activate the lifecycle node the following commands have to be issued:

// Configure
ros2 lifecycle set /sick_safetyscanners2_lifecycle_node configure

//Activate
ros2 lifecycle set /sick_safetyscanners2_lifecycle_node activate
Visualization

To visualize the data start rviz2 and subscribe to the ~/scan topic. By default the frame_id is “scan” however this can be customized in the launch file

rviz2

Troubleshooting

  • Check if the sensor has power and is connected to the host.

  • Check if both sensor and host are in the same subnet e.g. 192.168.1

  • Check if the launch file is called with the correct parameters for IP-addresses and ports.

ROS2 API

Advertised ROS2 Topics

~/scan (type: sensor_msgs/msg/LaserScan)

Publishes a scan from the laserscanner

~/extended_laser_scan (type: sick_safetyscanners2_interfaces/msg/ExtendedLaserScan)

Extends the basic laser scan message by reflector data and intrusion data.

~/output_paths (type: sick_safetyscanners2_interfaces/msg/OutputPath)

Gives feedback of the current status of the output paths.

~/raw_data (type: sick_safetyscanners2_interfaces/msg/RawMicroScanData)

Publishes the raw data from the sensor as a ROS2 message.

~/diagnostics (type: diagnostic_msgs/msg/DiagnosticArray)

Frequency and sensor diagnostics

Advertised ROS2 Services

~/field_data

Returns all configured protective and warning fields for the sensor

ROS2 parameters

Parameter Name

Type

Default

Required on startup

Information

sensor_ip

String

192.168.1.11

Sensor IP address. Can be passed as an argument to the launch file.

host_ip

String

192.168.1.9

Host IP address. Can be passed as an argument to the launch file.

interface_ip

String

0.0.0.0

Interface IP address of the receiving host computer, this needs to be set if the host IP is in the multicast IP range. The default is an undefined IP address and will return an error when multicast is used without a correct interface.

host_udp_port

Integer

0

Host UDP Port. Can be passed as an argument to the launch file. Zero allows system chosen port.

frame_id

String

scan

The frame name of the sensor message

skip

Integer

0

The number of scans to skip between each measured scan. For a 25Hz laser, setting ‘skip’ to 0 makes it publish at 25Hz, ‘skip’ to 1 makes it publish at 12.5Hz.

angle_start

Double

0.0

Start angle of scan in radians, if both start and end angle are equal, all angels are regarded. 0° is at the front of the scanner.

angle_end

Double

0.0

End angle of scan in radians, if both start and end angle are equal, all angels are regarded. 0° is at the front of the scanner.

min_intensities

Double

0.0

If this parameter is set, all points below the one set in the parameter are set to infinity

channel_enabled

Boolean

true

If the channel should be enabled

general_system_state

Boolean

true

If the general system state should be published

derived_settings

Boolean

true

If the derived settings should be published

measurement_data

Boolean

true

If the measurement data should be published

intrusion_data

Boolean

true

If the intrusion data should be published

application_io_data

Boolean

true

If the application IO data should be published

use_persistent_config

Boolean

false

If this flag is set, the configured angles from the sensor are loaded and used and the ROS parameters angle_start and angle_end are disregarded

Creators

Lennart Puck

FZI Forschungszentrum Informatik

on behalf of SICK AG