Home  /  Cases  /  Robot safety

Robot safety

A tractor that drives itself has to see people, animals and obstacles in an open field. We built the perception platform that does — colour, thermal, stereo, lidar and radar together.


SAFE project logo

Safety

Sensor fusion

Radar

Thermal

Lidar

Safety first. Automating agricultural processes using autonomous vehicles and robots has a huge potential for reducing manual labor and optimizing yield. However, self-driven vehicles pose a major safety risk. Therefore, the SAFE project investigated technologies for maximizing the safety of both humans and animals, using multiple perception sensors and state-of-the-art object detection algorithms.

A perception platform was developed including color camera, thermal camera, stereo camera, lidar and radar. A variety of datasets were collected, including the popular and publicly available dataset: FieldSAFE.

Object detection in a colour image
01 Object detection (color)
Object detection in a thermal image
02 Object detection (thermal)
Point cloud classification from lidar
03 Point cloud classification (lidar)
Radar detections overlaid on lidar data
04 Radar detections (overlaid on lidar)
Anomaly detection in a colour image sequence
05 Anomaly detection (color)
Sensor fusion and obstacle mapping
06 Sensor fusion and obstacle mapping

The project

Safer Autonomous
Farming Equipment.

SAFE was a joint research collaboration between two agricultural machine manufacturers, a robotics consulting firm and two research institutions. It explored technologies for maximizing the safety of both humans and animals around autonomous farming vehicles, while minimizing the workload and supervision needed by farmers.

Early in their careers, Peter Christiansen and Mikkel Fly Kragh did their PhDs on safety for autonomous farming vehicles in the project. Their role was to explore how well a variety of sensor technologies — cameras, lidar and radar — could detect and avoid obstacles in unstructured agricultural environments.

They designed and built an advanced perception system, synchronized and calibrated all its sensors, and used it for extensive data collection at seven locations in Denmark. One of those datasets, FieldSAFE, has been downloaded more than 10,000 times.

Illustration of autonomous farm machines detecting people and obstacles in a field
The idea machines that see people and obstacles, and stop, slow down, warn or steer around them
The multi-sensor perception platform
Perception platform colour + thermal + stereo + lidar + radar
The perception platform with its sensors labelled: lidar, 360 camera, IMU, GPS antennas, stereo camera, web camera, thermal camera and radar
The sensor platform lidar, stereo, thermal, 360° and web cameras, radar, IMU and GPS

Detection

Detection
algorithms.

Several state-of-the-art detection algorithms were investigated — both traditional computer vision and deep learning for object detection (bounding box predictions), and fully convolutional neural networks for semantic segmentation (pixel-wise predictions).

Object detection bounding box predictions
Semantic segmentation pixel-wise predictions

3D point clouds

Hand-crafted features or deep learning

For 3D point clouds, either generated from stereo vision or directly available from a multi-beam lidar, we also compared traditional methods based on hand-crafted features with methods based on deep learning.

The traditional approach looks at all points in the neighborhood of a single 3D point. Based on features such as linearity, planarity, scatteredness and height, each point is classified using a support vector machine (SVM). The deep learning approach is a fully convolutional neural network operating on 2D range images.

There is still debate on which representation of a 3D point cloud is best suited for deep learning. Some methods use multiple 2D views of a point cloud, some a hierarchical voxel-based representation, some graph neural networks, and some transformer-based models.

Neighborhood of a single 3D point used for hand-crafted feature extraction
Hand-crafted neighborhood features, classified with an SVM
Point cloud classes predicted by a fully convolutional network on range images
Deep learning a fully convolutional network on 2D range images

Sensor fusion

Combining sensors to reduce uncertainty

Sensor fusion, or multi-modal fusion, combines sensor data from different domains to increase robustness and confidence. Combining multiple sensors should result in reduced uncertainty compared to the performance of the individual sensors.

Below is an example of lidar and camera fusion. Using the extrinsic calibration between the sensors and the intrinsics of the camera, 3D points can be projected onto the corresponding 2D image. The result shows pixel-wise and point-wise classification using a conditional random field (CRF) for fusion. The white boxes mark the qualitative improvements from fusing 2D and 3D information, and from fusing sensor data across subsequent frames (time).

Lidar points projected onto a camera image
Projection lidar points on the camera image
Pixel-wise and point-wise classification results with CRF fusion, white boxes marking improvements
CRF fusion white boxes mark where fusing 2D, 3D and time helps

Obstacle mapping

From detections to a map

For an autonomous system to be safe, obstacle detection must be followed by obstacle avoidance. Among other steps, that means transforming detections from the local sensor frames to the vehicle frame, possibly followed by local or global mapping.

For this, we investigated occupancy grid mapping combined with probabilistic fusion of inverse sensor models. The detections from all sensors and algorithms were transformed to a 2D top-down view and fused across both space and time. IMU and RTK GPS sensors were used for global localization.

The slider shows a drone-recorded orthophoto of a grass field with and without the obstacle map overlaid. The map was generated from a single traversal along the periphery of the field.

Drone orthophoto of a grass field
The same orthophoto with the obstacle map overlaid
Orthophoto Obstacle map
Drag the divider to overlay the obstacle mapone pass along the edge of the field

More work

See the other cases, or read about the systems behind them.

Ready to talk?

Do you have a big idea
we can help with?