Towards Safe Robotic Agricultural Applications: Safe Navigation System Design for a Robotic Grass-Mowing Application through the Risk Management Method
Abstract
:1. Introduction
- Design of a safe navigation architecture through the risk assessment methodology for an automated grass-cutting application, including a hazard detection and risk mitigation plan;
- Development of safety functions for open-field agricultural tasks, specifically grass-mowing;
- A safe navigation system designed according to the risk assessment method focusing on human detection and risk mitigation, and designed specifically to handle potential human-robot accidents.
2. Related Work
3. Problem Statement
4. Approach
4.1. Risk Management
4.2. Autonomous Navigation
- Execution: This module handles the task execution, including localization, mapping, trajectory planning, and control. The agricultural robots normally localize themselves by GPS-based solutions. In mapping approaches, there are two main tendencies using a static map or map-less solutions. A high number of controllers and planners can be used to make the robot execute a given task; however, the selection is influenced by the agricultural application’s characteristics. The execution module must stop whenever the safety module is not working;
- Communication: The second module addresses the problem of creating human-robot communication. This can include visual, speech, haptic, or smartphone app interfaces to receive and send information to the robot. In this module, the concept of human intervention is introduced, enabling a safe human-robot interface;
- Safety: This monitors the external events that interrupt the robot’s safe state. Any object or human that is put at risk of collision, injury, or death must be detected in order to prevent these from happening. This, and the execution module are highly dependent;
- Monitoring: Any of the other systems can fail during run-time. The last module watches the correct behaviour of the other three modules. This module can interrupt the robot’s task.
4.2.1. Execution Module
4.2.2. Safety Systems Module
5. Safety Functionalities
5.1. Basic Proximity Function
- Once the hazard state is reached, the robot cannot transit to the safe state directly, i.e., a person is no longer detected in the hazard zone;
- If the detection algorithm does not provide feedback after a timeout, it might mean that the robot does not understand the environment (blind robot), therefore, the robot must stop and/or require human assistance;
- Safety system acts as a navigation monitor, therefore, it interrupts and commands the system if any of the safety rules are threatened.
5.2. Braking System Function
5.3. Human Risk Assessment Function
- Idle: Sets current state t with previous risk state ;
- Speed-Up Enables full speed;
- Slowdown Constrains mobile robot by limiting maximum speed to a safe speed ;
- Stop: Pauses given task, motion, and shuts down power tools;
- Resume: Resumes current task, motion, and shuts down power tools;
- HI: Requests human intervention, and leaves the decision-making process to a human operator.
5.4. Knowledge-Based Function
6. Navigation Architecture
7. Simulations
8. Results
9. Conclusions
Author Contributions
Funding
Conflicts of Interest
Appendix A
Risk ID | Hazard Definition | Severity | P.Oc. |
---|---|---|---|
01 | Living Being not Detected | S0, S2 | E4 |
02 | Living Being Detected in Proximity | S0–S3 | E4 |
03 | Non-Living Being not Detected | S1, S2 | E4 |
04 | Non-Living Being Detected in Proximity | S1, S2 | E4 |
05 | People Laying on the Grass | S0, S3 | E2 |
06 | Trajectory Intersects Human Trajectory | S1–S3 | E4 |
07 | Injured Animals on the Crops | S1–S4 | E3 |
08 | Tool Malfunction | S2 | E2 |
09 | Running out of Borders | S2 | E3 |
10 | Encoders Malfunction | S1 | E2 |
11 | Camera Malfunction | S2 | E2 |
12 | LiDAR Malfunction | S2 | E1 |
13 | GPS Malfunction | S2 | E3 |
14 | Speeding | S2 | E3 |
15 | Communication Lost | S2 | E2 |
16 | Others (to be defined) |
Appendix B
Process Step | Potential Failure Mode | Potential Failure Effects | Potential Causes | Current Controls | Recomm. Action |
---|---|---|---|---|---|
High-Level Failures | |||||
Execution | Localization Imprecision | Speeding | GPS Failure | Monitoring | Slow Down |
Odometry Failure | Kalman Filter | Slow Down | |||
Unintended Excursion | GPS Failure | Monitoring | EStop | ||
Odometry Failure | Kalman Filter | EStop | |||
Unintended Excursion | Collision | Odometry Failure | Perception System | EStop | |
Speeding | Localization Imprecision | Velocity Constraints | Abort | ||
Wrong Path | Unintended Excursion | Localization Imprecision | Kalman Filter | EStop | |
Collision | Safety System Error | Perception System | Abort | ||
Safety | Collision | Injuries/Death | Wrong Path | Perception System | ESTOP + H.I. + Shutdown |
Destroy Property | Wrong Path | Perception System | ESTOP + H.I. | ||
Safety System Error | Injuries/Death | Camera Failure | Perception System | ESTOP + H.I.+ Shutdown | |
LiDAR Failure | Perception System | ESTOP + H.I. + Restart | |||
Comms. | App Comm. Lost | Injuries/Death | Bluetooth Failure WiFi Failure | Monitoring | Abort + H.I |
Visual Comm. Lost | Injuries/Death | Camera Failure | Monitoring | Stop Motion | |
Speech Comm. Lost | Microphones Failure | Stop Motion | |||
Haptic Comm. Lost | Inertial Sensor Failure | Stop Motion |
Low-Level Failures | |||||
---|---|---|---|---|---|
Process Step | Potential Failure Mode | Potential Failure Effects | Potential Causes | Current Controls | Recomm. Action |
Monitoring | Camera Failure | Safety System Error | Power Issue | Electric Design | H.I. + Shutdown |
Unplugged Cable | Reinforce connections | Stop Motion + H.I. | |||
Software Crash | Signal Monitoring | Restart Firmware | |||
Visual Comm. Lost | Software Crash | None | Wait | ||
LiDAR Failure | Safety System Error | Power Issue | Electric Design | H.I. + Shutdown | |
Unplugged Cable | Reinforce Connection | Stop Motion + H.I. | |||
Software Crash | Signal Monitoring | Restart Firmware | |||
GPS Failure | Unintended Excursion | Software Crash | Monitoring | Restart Firmware | |
Signal Precision | None | Wait | |||
Localization Imprecision | Satellites Comm. | Kalman Filter | Wait | ||
Odometry Failure | Localization Imprecision | Encoders Malfunction | Maintenance | Maintenance | |
Speeding | GPS Failures | Param. Optimization | Slow Down | ||
Unintended Excursion | Software Crash | Monitoring | Restart Firmware | ||
Aborted Execution | Localization Imprecision | Velocity Controller | H.I. | ||
WiFi Failure | App Comm. Lost | Low Reception | None | Wait | |
Unplugged Cable | Reinforce connections | Stop Motion + H.I. | |||
Software Crash | Signal Monitoring | Restart Firmware | |||
Bluetooth Failure | App Comm. Lost | Low Reception | None | Wait | |
Unplugged Cable | Reinforce connections | Stop Motion + H.I. | |||
Software Crash | Signal Monitoring | Restart Firmware | |||
Inertial Sensor Failure | Haptic Comm. Lost | External Noise | Kalman Filter | Wait | |
Unplugged Cable | Reinforce connections | Stop Motion + H.I. | |||
Software Crash | Signal Monitoring | Restart Firmware | |||
Microphone Failure | Speech Comm. Lost | External Noise | None | Wait | |
Unplugged Cable | Reinforce connections | Stop Motion + H.I. | |||
Software Crash | Signal Monitoring | Restart Firmware |
References
- Benos, L.; Bechar, A.; Bochtis, D. Safety and ergonomics in human-robot interactive agricultural operations. Biosyst. Eng. 2020, 200, 55–72. [Google Scholar] [CrossRef]
- Kruse, T.; Pandey, A.K.; Alami, R.; Kirsch, A. Human-aware robot navigation: A survey. Robot. Auton. Syst. 2013, 61, 1726–1743. [Google Scholar] [CrossRef]
- Vasconez, J.P.; Kantor, G.A.; Auat Cheein, F.A. Human–robot interaction in agriculture: A survey and current challenges. Biosyst. Eng. 2019, 179, 35–48. [Google Scholar] [CrossRef]
- Fargnoli, M.; Lombardi, M. Safety Vision of Agricultural Tractors: An Engineering Perspective Based on Recent Studies (2009–2019). Safety 2019, 6, 1. [Google Scholar] [CrossRef]
- Bechar, A.; Vigneault, C. Agricultural robots for field operations: Concepts and components. Biosyst. Eng. 2016, 149, 94–111. [Google Scholar] [CrossRef]
- Reina, G.; Milella, A.; El Rouveure, R.; Nielsen, M.; Worst, R.; Blas, M.R. Special Issue: Robotic Agriculture Research Paper Ambient awareness for agricultural robotic vehicles. Biosyst. Eng. 2016, 146, 114–132. [Google Scholar] [CrossRef]
- ISO 10218:2016(E); Robots and Robotic Devices—Safety Requirements for Industrial Robots. ISO: Geneva, Switzerland, 2016.
- Lasota, P.A.; Fong, T.; Shah, J.A. A Survey of Methods for Safe Human-Robot Interaction. Found. Trends Robot. 2017, 5, 261–349. [Google Scholar] [CrossRef]
- Fryman, J.; Matthias, B. Safety of Industrial Robots: From Conventional to Collaborative Applications. In Proceedings of the 7th International Conference on the Safety of Industrial Automated Systems—SIAS 2012, Montreal, BC, Canada, 11–12 October 2012. [Google Scholar]
- Machin, M.; Guiochet, J.; Waeselynck, H.; Blanquart, J.P.; Roy, M.; Masson, L. SMOF—A Safety MOnitoring Framework for Autonomous Systems to Cite this version: HAL Id: Hal-01394139 SMOF—A Safety MOnitoring Framework for Autonomous Systems. IEEE Trans. Syst. Man Cybern. Syst. 2018, 48, 702–715. [Google Scholar] [CrossRef]
- Kollmitz, M.; Hsiao, K.; Gaa, J.; Burgard, W. Time dependent planning on a layered social costmap for human-aware robot navigation. In Proceedings of the 2015 European Conference on Mobile Robots, ECMR 2015, Lincoln, UK, 2–4 September 2015. [Google Scholar] [CrossRef]
- Chung, W.; Kim, S.; Choi, M.; Choi, J.; Kim, H.; Moon, C.B.; Song, J.B. Safe navigation of a mobile robot considering visibility of environment. IEEE Trans. Ind. Electron. 2009, 56, 3941–3950. [Google Scholar] [CrossRef]
- Zacharaki, A.; Kostavelis, I.; Gasteratos, A.; Dokas, I. Safety bounds in human robot interaction: A survey. Saf. Sci. 2020, 127, 104667. [Google Scholar] [CrossRef]
- ISO 8497:2018(E); Agricultural Machinery and Tractors—Safety of Highly Automated Agricultural Machines—Principles for Design. ISO: Geneva, Switzerland, 2018.
- ISO 31000:2018(E); ISO3100: Risk Asssessment. ISO: Geneva, Switzerland, 2018.
- ISO 12100:2010(E); International Standard for Design—Risk Assessment and Risk. ISO: Geneva, Switzerland, 2010.
- Sumit, S.S.; Rambli, D.R.A.; Mirjalili, S. Vision-Based Human Detection Techniques: A Descriptive Review. IEEE Access 2021, 9, 42724–42761. [Google Scholar] [CrossRef]
- Redmon, J.; Farhadi, A. YOLO v3: An Incremental Improvement. arXiv 2018, arXiv:1804.02767. [Google Scholar]
- Hayton, J.N.; Barros, T.; Premebida, C.; Coombes, M.J.; Nunes, U.J. CNN-based Human Detection Using a 3D LiDAR onboard a UAV. In Proceedings of the 2020 IEEE International Conference on Autonomous Robot Systems and Competitions (ICARSC), Ponta Delgada, Portugal, 15–17 April 2020. [Google Scholar] [CrossRef]
- Shi, S.; Wang, X.; Li, H. PointRCNN: 3D Object Proposal Generation and Detection from Point Cloud. arXiv 2018, arXiv:1812.04244. [Google Scholar]
- Halme, R.J.; Lanz, M.; Kämäräinen, J.; Pieters, R.; Latokartano, J.; Hietanen, A. Review of vision-based safety systems for human-robot collaboration. Procedia CIRP 2018, 72, 111–116. [Google Scholar] [CrossRef]
- Ponnambalam, V.R.; Fentanes, J.P.; Das, G.; Cielniak, G.; Gjevestad, J.G.O.; From, P.J. Agri-Cost-Maps—Integration of Environmental Constraints into Navigation Systems for Agricultural Robots. In Proceedings of the 2020 6th International Conference on Control, Automation and Robotics (ICCAR), Singapore, 20–23 April 2020; pp. 214–220. [Google Scholar] [CrossRef]
- Guiochet, J.; Machin, M.; Waeselynck, H. Safety-critical advanced robots: A survey. Robot. Auton. Syst. 2017, 94, 43–52. [Google Scholar] [CrossRef]
- Woodman, R.; Winfield, A.F.T.; Harper, C.; Fraser, M. Online Hazard Analysis for Autonomous Robots. In Towards Autonomous Robotic Systems; Springer: Berlin/Heidelberg, Germany, 2011; pp. 406–407. [Google Scholar] [CrossRef]
- Woodman, R.; Winfield, A.F.; Harper, C.; Fraser, M. Building safer robots: Safety driven control. Int. J. Robot. Res. 2012, 31, 1603–1626. [Google Scholar] [CrossRef]
- Musto, J.C.; Lauderbaugh, L. A Safety-Based Decision Architecture for Autonomous Making Systems; NASA: Washington, DC, USA, 1991. [Google Scholar]
- Masson, L.; Guiochet, J.; Waeselynck, H.; Cabrera, K.; Cassel, S.; Törngren, M. Tuning permissiveness of active safety monitors for autonomous systems. Lect. Notes Comput. Sci. 2018, 10811, 333–348. [Google Scholar] [CrossRef]
- Schratter, M.; Bouton, M.; Kochenderfer, M.J.; Watzenig, D. Pedestrian Collision Avoidance System for Scenarios with Occlusions. arXiv 2019, arXiv:1904.11566. [Google Scholar]
- Hata, A.; Inam, R.; Raizer, K.; Wang, S.; Cao, E. AI-based Safety Analysis for Collaborative Mobile Robots. In Proceedings of the 2019 24th IEEE International Conference on Emerging Technologies and Factory Automation (ETFA), Zaragoza, Spain, 10–13 September 2019. [Google Scholar] [CrossRef]
- Dupre, R.; Argyriou, V. Risk Estimation in Robotics and the Impact of Human Behaviour. In Robotics—Legal, Ethical and Socioeconomic Impacts; InTech: London, UK, 2017. [Google Scholar] [CrossRef]
- Jensen, K.; Larsen, M.; Nielsen, S.; Larsen, L.; Olsen, K.; Jørgensen, R. Towards an Open Software Platform for Field Robots in Precision Agriculture. Robotics 2014, 3, 207–234. [Google Scholar] [CrossRef]
- Grimstad, L.; Pham, C.D.; Phan, H.T.; From, P.J. On the design of a low-cost, light-weight, and highly versatile agricultural robot. In Proceedings of the IEEE Workshop on Advanced Robotics and its Social Impacts, ARSO, Lyon, France, 30 June–2 July 2015. [Google Scholar] [CrossRef]
- Terra, A.; Riaz, H.; Raizer, K.; Hata, A.; Inam, R. Safety vs. Efficiency: AI-Based Risk Mitigation in Collaborative Robotics. In Proceedings of the 2020 6th International Conference on Control, Automation and Robotics (ICCAR), Singapore, 20–23 April 2020; pp. 151–160. [Google Scholar] [CrossRef]
- Putz, S.; Simon, J.S.; Hertzberg, J. Move Base Flex A Highly Flexible Navigation Framework for Mobile Robots. In Proceedings of the 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Madrid, Spain, 1–5 October 2018. [Google Scholar] [CrossRef]
- Macenski, S.; Martin, F.; White, R.; Ginés Clavero, J. The Marathon 2: A Navigation System. In Proceedings of the 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Las Vegas, NV, USA, 24 October 2020–24 January 2021. [Google Scholar]
- Mayoral, J.C.; Grimstad, L.; From, P.J.; Cielniak, G. Integration of a Human-aware Risk-based Braking System into an Open-Field Mobile Robot. In Proceedings of the 2021 IEEE International Conference on Robotics and Automation (ICRA), Xi’an, China, 30 May–5 June 2021; pp. 2435–2442. [Google Scholar] [CrossRef]
- Badrloo, S.; Varshosaz, M.; Pirasteh, S.; Li, J. Image-Based Obstacle Detection Methods for the Safe Navigation of Unmanned Vehicles: A Review. Remote Sens. 2022, 14, 3824. [Google Scholar] [CrossRef]
- Skoczeń, M.; Ochman, M.; Spyra, K.; Nikodem, M.; Krata, D.; Panek, M.; Pawłowski, A. Obstacle Detection System for Agricultural Mobile Robot Application Using RGB-D Cameras. Sensors 2021, 21, 5292. [Google Scholar] [CrossRef] [PubMed]
- Wurm, K.; Kümmerle, R.; Stachniss, C.; Burgard, W. Improving Robot Navigation in Structured Outdoor Environments by Identifying Vegetation from Laser Data. In Proceedings of the IEEE International Workshop on Intelligent Robots and Systems (IROS), St. Louis, MO, USA, 10–15 October 2009; pp. 1217–1222. [Google Scholar] [CrossRef]
- Mayoral, J.C.; Grimstad, L.; From, P.J.; Cielniak, G. Towards Safety in Open-field Agricultural Robotic Applications: A Method for Human Risk Assessment using Classifiers. In Proceedings of the 2021 IEEE International Conference on Human System Interaction (HSI), Gdańsk, Poland, 8–10 July 2021. [Google Scholar]
Property | Value | |
---|---|---|
Environment | Structured | No |
Season | Spring-Summer | |
Weather | Sunny | |
Collaboration | Required | |
Multi-Agent | No | |
Mowing | Material | Grass |
Nominal Speed | 3.35 mph | |
Tool | Industrial Cutter | |
Platform | Power | Electricity |
Drive | Omnidirectional | |
Name | Thorvald | |
Sensor Set | Customized | |
Wheels | 4 | |
Motors | 8 |
Selection | Mode | Layer | Avoidance | |
---|---|---|---|---|
Nav. Stack | MBF | ALL | None | Enabled |
Motion Planners | Global Planner | Line Changing | Free | Custom |
Free | Obstacle | Enabled | ||
Carrot Planner | Crop Following | Custom | Disabled | |
Local Planners | DWA | Free | Custom | |
MPC | Crop Following | Custom | Custom | |
Line Changing | Obstacle | Enabled | ||
Localization | RTK-GPS and Odometry | ALL | - | - |
Mapping | Custom | ALL | Custom | - |
Risk ID | Hazard Definition | Severity | P.Oc. |
---|---|---|---|
01 | Living Being Not Detected | S0, S2 | E4 |
02 | Living Being Detected in Proximity | S0–S3 | E4 |
06 | Trajectory Intersects Human Trajectory | S1–S3 | E4 |
09 | Running out of Borders | S2 | E3 |
Risk ID | Hazard Definition | Severity | Function | Type |
---|---|---|---|---|
01-A | Living Being not Detected in Lethal Zone | S0 | State-Transition | Event |
01-B | Living Being not Detected in Danger Zone | S1 | State-Transition | Event |
01-C | Living Being not Detected in Warning Zone | S2 | State-Transition | Event |
01-D | Living Being not Detected in Safe Zone | S3 | State-Transition | Event |
02 | Living Being Detected in Proximity | * | Advance-Proximity | Continuous |
State-Transition | Event | |||
03-A | Non-Living Being not Detected in Lethal Zone | S0 | State-Transition | Event |
03-B | Non-Living Being not Detected in Danger Zone | S1 | State-Transition | Event |
03-C | Non-Living Being not Detected in Warning Zone | S2 | NONE | Idle |
03-D | Non-Living Being not Detected in Safe Zone | S3 | NONE | Idle |
04 | Non-Living Being Detected in Proximity | S3 | Basic-Proximity | Event |
Collision-Avoidance | Continous | |||
05 | People Laying on the Grass | * | State-Transition | Event |
06 | Trajectory Intersects Human Trajectory | * | Advance-Proximity | Continuous |
07 | Injured Animals on the Crops | * | Basic-Proximity | Event |
Collision-Avoidance | Continuous | |||
08 | Tool Malfunction | S2 | Monitor | Continous |
09 | Running out of Borders | S2 | Knowledge | HI |
10 | Encoder Malfunction | S1 | FMEA | HI |
11 | Camera Malfunction | S2 | FMEA | HI |
12 | LiDAR Malfunction | S2 | FMEA | HI |
13 | GPS Malfunction | S2 | Knowledge | HI |
14 | Speeding | S2 | Advance-Proximity | Continous |
Knowledge | FMEA | |||
15 | Communication Lost | S2 | FMEA | Idle |
16 | Others (to be defined) |
t | Lethal | Danger | Warning | Safe | Unknown |
---|---|---|---|---|---|
t − 1 | |||||
Lethal | Stop | Resume | Resume | H.I. | Stop |
Danger | Stop | Stop | Resume | H.I. | Stop |
Warning | Stop | Stop | Idle | SpeedUp | Slowdown |
Safe | H.I. | H.I. | SlowDown | Idle | Slowdown |
Unknown | H.I. | Stop | Resume | Resume | Idle |
No -Safety | Basic Proximity | Braking System | H. Risk Assessment | Functions Fusion | |
---|---|---|---|---|---|
0.32 | 0.11 | 0.24 | 0.28 | 0.26 | |
160.5 | 476.8 | 234.9 | 184.9 | 222.1 | |
#Col. | 55 | 30 | 28 | 31 | 19 |
MTBC | 101.5 | 442.1 | 327.6 | 222.6 | 417.8 |
MTBI | - | - | - | 45.16 | 52.90 |
%Imp. | - | 435.5 | 322.7 | 219.2 | 411.5 |
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content. |
© 2023 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (https://creativecommons.org/licenses/by/4.0/).
Share and Cite
Mayoral Baños, J.C.; From, P.J.; Cielniak, G. Towards Safe Robotic Agricultural Applications: Safe Navigation System Design for a Robotic Grass-Mowing Application through the Risk Management Method. Robotics 2023, 12, 63. https://doi.org/10.3390/robotics12030063
Mayoral Baños JC, From PJ, Cielniak G. Towards Safe Robotic Agricultural Applications: Safe Navigation System Design for a Robotic Grass-Mowing Application through the Risk Management Method. Robotics. 2023; 12(3):63. https://doi.org/10.3390/robotics12030063
Chicago/Turabian StyleMayoral Baños, José Carlos, Pål Johan From, and Grzegorz Cielniak. 2023. "Towards Safe Robotic Agricultural Applications: Safe Navigation System Design for a Robotic Grass-Mowing Application through the Risk Management Method" Robotics 12, no. 3: 63. https://doi.org/10.3390/robotics12030063
APA StyleMayoral Baños, J. C., From, P. J., & Cielniak, G. (2023). Towards Safe Robotic Agricultural Applications: Safe Navigation System Design for a Robotic Grass-Mowing Application through the Risk Management Method. Robotics, 12(3), 63. https://doi.org/10.3390/robotics12030063