A Physics-based Optimization Approach for Path Planning on Rough Terrains

Diogo Amorim, Rodrigo Ventura

2015

Abstract

The following paper addresses the problem of applying existing path planning methods targeting rough terrains. Most path planning methods for mobile robots divide the environment in two areas—free and occupied —and restrict the path to lie within the free space. The presented solution addresses the problem of path planning on rough terrains, where the local shape of the environment are used to both constrain and optimize the resulting path. Finding both the feasibility and the cost of the robot crossing the terrain at a given point is cast as an optimization problem. Intuitively, this problem models dropping the robot at a given location (x,y) and determining the minimal potential energy pose (attitude angles and the distance of the centre of mass to the ground). We then applied two path planning methods for computing a feasible path to a given goal: Fast Marching Method (FMM) and Rapidly exploring Random Tree (RRT). Processing the whole mapped area, determining the cost of every cell in the map, we apply a FMM in order to obtain a potential field free of local minima. This field can then be used to either pre-compute a complete trajectory to the goal point or to control, in real time, the locomotion of the robot. Solving the previously stated problem using RRT we need not to process the entire area, but only the coordinates of the nodes generated. This last approach does not require as much computational power or time as the FMM but the resulting path might not be optimal. In the end, the results obtained from the FMM may be used in controlling the vehicle and show optimal paths. The output from the RRT method is a feasible path to the goal position. Finally, we validate the proposed approach on four example environments.

References

  1. Garrido, S., Malfaz, M., and Blanco, D. (2013). Application of the fast marching method for outdoor motion planning in robotics. Robotics and Autonomous Systems, 61(2):106-114.
  2. Garrido, S., Moreno, L., Blanco, D., and Martin, F. (2009). Smooth path planning for non-holonomic robots using fast marching. In Mechatronics, 2009. ICM 2009. IEEE International Conference on, pages 1-6.
  3. Kohlbrecher, S., Meyer, J., Graber, T., Petersen, K., von Stryk, O., and Klingauf, U. (2013). Hector open source modules for autonomous mapping and navigation with rescue robots. Proceedings of 17th RoboCup international symposium.
  4. Kraft, D. (1988). A software package for sequential quadratic programming. DFVLR Obersfaffeuhofen, Germany.
  5. LaValle, S. (2006). Planning algorithms. Cambridge University Press.
  6. Powell, M. (2007). A view of algorithms for optimization without derivatives. Mathematics Today-Bulletin of the Institute of Mathematics and its Applications, 43(5):170-174.
  7. Sethian, J. A. (1996). A fast marching level set method for monotonically advancing fronts. Proceedings of the National Academy of Sciences, 93(4):1591-1595.
  8. Sethian, J. A. (1999). Fast marching methods. SIAM Review, 41(2):199-235.
  9. Siciliano, B. and Khatib, O. (2008). Springer handbook of robotics. Springer.
  10. Tarokh, M., Shiller, Z., and Hayati, S. (1999). A comparison of two traversability based path planners for planetary rovers. Proc. i-SAIRAS99, pages 151-157.
  11. Ventura, R. (2014). New Trends on Medical and Service Robots: Challenges and Solutions, volume 20 of MMS, chapter Two Faces of Human-robot Interaction: Field and Service robots, pages 177-192. Springer.
Download


Paper Citation


in Harvard Style

Amorim D. and Ventura R. (2015). A Physics-based Optimization Approach for Path Planning on Rough Terrains . In Proceedings of the 12th International Conference on Informatics in Control, Automation and Robotics - Volume 2: ICINCO, ISBN 978-989-758-123-6, pages 259-266. DOI: 10.5220/0005529302590266


in Bibtex Style

@conference{icinco15,
author={Diogo Amorim and Rodrigo Ventura},
title={A Physics-based Optimization Approach for Path Planning on Rough Terrains},
booktitle={Proceedings of the 12th International Conference on Informatics in Control, Automation and Robotics - Volume 2: ICINCO,},
year={2015},
pages={259-266},
publisher={SciTePress},
organization={INSTICC},
doi={10.5220/0005529302590266},
isbn={978-989-758-123-6},
}


in EndNote Style

TY - CONF
JO - Proceedings of the 12th International Conference on Informatics in Control, Automation and Robotics - Volume 2: ICINCO,
TI - A Physics-based Optimization Approach for Path Planning on Rough Terrains
SN - 978-989-758-123-6
AU - Amorim D.
AU - Ventura R.
PY - 2015
SP - 259
EP - 266
DO - 10.5220/0005529302590266