We propose an innovative, integrated solution to path planning, path following, and obstacle avoidance that is suitable both for 2D and 3D navigation. The proposed method takes as input a generic curve connecting a start and a goal position, and is able to find a corresponding path from start to goal in a maze-like environment even in the absence of global information, it guarantees convergence to the path with kinematic control, and finally avoids locally sensed obstacles without becoming trapped in deadlocks. This is achieved by computing a closed-form expression in which the control variables are a continuous function of the input curve, the robot’s state, and the distance of all the locally sensed obstacles. Specifically, we introduce a novel formalism for describing the path in two and three dimensions, as well as a computationally efficient method for path deformation (based only on local sensor readings) that is able to find a path to the goal even when such path cannot be produced through continuous deformations of the original. The article provides formal proofs of all the properties above, as well as simulated results in a simulated environment with a wheeled robot, an underwater vehicle, and a multicopter.
Keywords Autonomous agents, motion control, wheeled robots, marine robotics, aerial robotics
Aicardi, M, Casalino, G, Bicchi, A, Balestrino, A (1995) Closed loop steering of unicycle like vehicles via Lyapunov techniques. IEEE Robotics Automation Magazine 2(1): 27–35. Google Scholar | Crossref |
Alvarez, A, Caffaz, A, Caiti, A. (2009) Fòlaga: A low-cost autonomous underwater vehicle combining glider and AUV capabilities. Ocean Engineering 36(1): 24–38. Google Scholar | Crossref |
Borenstein, J, Koren, Y (1991) The vector field histogram-fast obstacle avoidance for mobile robots. IEEE Transactions on Robotics and Automation 7(3): 278–288. Google Scholar | Crossref |
Braginsky, B, Guterman, H (2016) Obstacle avoidance approaches for autonomous underwater vehicle: Simulation and experimental results. IEEE Journal of Oceanic Engineering 41(4): 882–892. Google Scholar | Crossref |
Brock, O, Khatib, O (2002) Elastic strips: A framework for motion generation in human environments. The International Journal of Robotics Research 21(12): 1031–1052. Google Scholar | SAGE Journals | ISI |
Consolini, L, Maggiore, M, Nielsen, C, Tosques, M (2010) Path following for the PVTOL aircraft. Automatica 46(8): 1284–1296. Google Scholar | Crossref |
Dafflon, B, Chen, B, Gechter, F, Gruer, P (2014) A self-adaptive agent-based path following control lateral regulation and obstacles avoidance. In: Proceedings of the 2014 International Conference on High Performance Computing Simulation (HPCS), Bologna, Italy, pp. 452–459. Google Scholar | Crossref |
Do, KD, Jiang, ZP, Pan, J (2003) On global tracking control of a VTOL aircraft without velocity measurements. IEEE Transactions on Automatic Control 48(12): 2212–2217. Google Scholar | Crossref | ISI |
Foo, J, Knutzon, J, Kalivarapu, V, Oliver, J, Winer, E (2009) Path planning of unmanned aerial vehicles using B-splines and particle swarm optimization. Journal of Aerospace Computing, Information and Communication 6(4): 271–290. Google Scholar | Crossref |
Fox, D, Burgard, W, Thrun, S (1997) The dynamic window approach to collision avoidance. IEEE Robotics Automation Magazine 4(1): 23–33. Google Scholar | Crossref | ISI |
Franchi, A, Secchi, C, Ryll, M, Bülthoff, H, Giordano, P (2012) Shared control: Balancing autonomy and human assistance with a group of quadrotor UAVs. IEEE Robotics and Automation Magazine 19(3): 57–68. Google Scholar | Crossref | ISI |
Gageik, N, Benz, P, Montenegro, S (2015) Obstacle detection and collision avoidance for a UAV with complementary low-cost sensors. IEEE Access 3: 599–609. Google Scholar | Crossref |
Hrabar, S (2008) 3D path planning and stereo-based obstacle avoidance for rotorcraft UAVs. In: Proceedings 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Nice, France, pp. 807–814. Google Scholar | Crossref |
Karaman, S, Frazzoli, E (2011) Sampling-based algorithms for optimal motion planning. The International Journal of Robotics Research 30(7): 846–894. Google Scholar | SAGE Journals | ISI |
Khatib, M, Jaouni, H, Chatila, R, Laumond, J (1997) Dynamic path modification for car-like nonholonomic mobile robots. In: Proceedings 1997 IEEE International Conference on Robotics and Automation (ICRA97), Vol. 4.,Albuquerque, NM, pp. 2920–2925. Google Scholar | Crossref |
Khatib, O (1986) Real-time obstacle avoidance for manipulators and mobile robots. The International Journal of Robotics Research 5(1): 90–98. Google Scholar | SAGE Journals | ISI |
Kutulakos, K, Lumelsky, VJ, CR, D (1993) Vision-guided exploration: A step toward general motion planning in three dimensions. In: Proceedings of 1999 IEEE International Conference on Robotics and Automation (ICRA99), Vol. 1, Atlanta, GA, pp. 289–296. Google Scholar | Crossref |
Lapierre, L, Soetanto, D (2007) Nonlinear path-following control of an AUV. Ocean Engineering 34: 1734–1744. Google Scholar | Crossref | ISI |
Lapierre, L, Zapata, R, Lepinay, P (2007) Combined path-following and obstacle avoidance control of a wheeled robot. The International Journal of Robotics Research 26(4): 361–376. Google Scholar | SAGE Journals | ISI |
Latombe, JC (1991) Robot Motion Planning. Norwell, MA: Kluwer Academic Publishers. Google Scholar | Crossref |
LaValle, SM (2006) Planning Algorithms. Cambridge: Cambridge University Press. Google Scholar | Crossref |
Lee, H, Kim, H, Kim, HJ (2016) Planning and control for collision-free cooperative aerial transportation. IEEE Transactions on Automation Science and Engineering 99: 1–13. Google Scholar |
Liu, C, Fan, S, Li, B, Chen, S, Xu, Y, Xu, W (2016) Path planning for autonomous underwater vehicle docking in stationary obstacle environment. In: Proceedings OCEANS 2016, Shanghai, China, pp. 1–5. Google Scholar | Crossref |
Liu, Z, Ciarletta, L, Yuan, C, Zhang, Y, Theilliol, D (2017) Path following control of unmanned quadrotor helicopter with obstacle avoidance capability. In: Proceedings of the 2017 International Conference on Unmanned Aircraft Systems (ICUAS), Miami, FL, pp. 304–309. Google Scholar | Crossref |
Lumelsky, VJ, Stepanov, AA (1987) Path-planning strategies for a point mobile automaton moving amidst unknown obstacles of arbitrary shape. Algorithmica 2: 403–430. Google Scholar | Crossref | ISI |
Michalek, M (2014) A highly scalable path-following controller for N-trailers with off-axle hitching. Control Engineering Practice 29: 61–73. Google Scholar | Crossref | ISI |
Millar, G (2014) An obstacle avoidance system for autonomous underwater vehicles: A reflexive vector field approach utilizing obstacle localization. In: Proceedings 2014 IEEE/OES Autonomous Underwater Vehicles (AUV), Oxford, MS, pp. 1–4. Google Scholar | Crossref |
Morro, A, Sgorbissa, A, Zaccaria, R (2011) Path following for unicycle robots with an arbitrary path curvature. IEEE Transactions on Robotics 27(5): 1016–1023. Google Scholar | Crossref |
Nelson, DR, Barber, DB, McLain, TW, Beard, RW (2007) Vector field path following for miniature air vehicles. IEEE Transactions on Robotics 23(3): 519–529. Google Scholar | Crossref | ISI |
Ng, J, Bräunl, T (2007) Performance comparison of bug navigation algorithms. Journal of Intelligent and Robotic Systems 50(1): 73–84. Google Scholar | Crossref | ISI |
Nguyen, DHP, Recchiuto, CT, Sgorbissa, A (2016) Real-time path generation for multicopters in environments with obstacles. In: Proceedings 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Daejeon Convention Center, Daejeon, Korea, pp. 1582–1588. Google Scholar | Crossref |
Nguyen, DHP, Recchiuto, CT, Sgorbissa, A (2017) Real-time path generation and obstacle avoidance for multirotors: A novel approach. Journal of Intelligent and Robotic Systems: Theory and Applications, in press. Google Scholar |
Ogren, P, Leonard, N (2005) A convergent dynamic window approach to obstacle avoidance. IEEE Transactions on Robotics 21(2): 188–195. Google Scholar | Crossref | ISI |
Orsag, M, Haus, T, Palunko, I, Bogdan, S (2015) State estimation, robust control and obstacle avoidance for multicopter in cluttered environments: EUROC experience and results. In: Proceedings of the 2015 International Conference on Unmanned Aircraft Systems (ICUAS), pp. 455–461. Google Scholar | Crossref |
Pathak, K, Agrawal, SK (2005) An integrated path-planning and control approach for nonholonomic unicycles using switched local potentials. IEEE Transactions on Robotics 21(6): 1201–1208. Google Scholar | Crossref |
Quinlan, S, Khatib, O (1993) Elastic bands: Connecting path planning and control. In: Proceedings 1993 IEEE International Conference on Robotics and Automation (ICRA93), Vol. 2, pp. 802–807. Google Scholar | Crossref |
Regier, P, Missura, M, Bennewitz, M (2017) Predicting travel time from path characteristics for wheeled robot navigation. In: Proceedings of the 2017 European Conference on Mobile Robots (ECMR), pp. 1–6. Google Scholar | Crossref |
Sgorbissa, A, Zaccaria, R (2010) 3D path following with no bounds on the path curvature through surface intersection. In: Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS2010), Taipei, Taiwan, pp. 4029–4035. Google Scholar | Crossref |
Sgorbissa, A, Zaccaria, R (2012) Planning and obstacle avoidance in mobile robotics. Robotics and Autonomous Systems 60(4): 628–638. Google Scholar | Crossref | ISI |
Sgorbissa, A, Zaccaria, R (2013) Integrated obstacle avoidance and path following through a feedback control law. Journal of Intelligent and Robotic Systems: Theory and Applications 72(3–4): 409–428. Google Scholar | Crossref |
Shiller, Z, Sharma, S, Stern, I, Stern, A (2013) Online obstacle avoidance at high speeds. The International Journal of Robotics Research 32(9–10): 1030–1047. Google Scholar | SAGE Journals | ISI |
Shim, DH, Chung, H, Sastry, SS (2006) Conflict-free navigation in unknown urban environments. IEEE Robotics Automation Magazine 13(3): 27–33. Google Scholar | Crossref |
Tanveer, M, Sgorbissa, A, Recchiuto, C (2017) Collision-free navigation of multiple unicycle mobile robots. In: Proceedings 26th IEEE International Symposium on Robot and Human Interactive Communication (RO-MAN 2017), Lisbon, Portugal, pp. 1–8. Google Scholar | Crossref |
Todoran, G, Bader, M (2016) Expressive navigation and local path-planning of independent steering autonomous systems. In: Proceedings 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Daejeon, South Korea, pp. 4742–4749. Google Scholar | Crossref |
Tomić, T, Ott, C, Haddadin, S (2017) External wrench estimation, collision detection, and reflex reaction for flying robots. IEEE Transactions on Robotics 33(6): 1467–1482. Google Scholar | Crossref |
Ulrich, I, Borenstein, J (2000) VFH*: local obstacle avoidance with look-ahead verification. In: Proceedings of the IEEE International Conference on Robotics and Automation (ICRA00), Vol. 3, pp. 2505–2511. Google Scholar | Crossref |
Zhang, W, Wang, X, Liang, Z, Sun, X (2016) Study of obstacle information processing for unmanned underwater vehicle in unknown ocean environment. In: Proceedings OCEANS 2016, Shanghai, China, pp. 1–5. Google Scholar | Crossref |
The dynamic-systems approach to robotpathplanningdefinesa dynamics ofrbotbehavior in which task constraints contribute independently to a nonlinear vector field that governs robot actions. We address problems that arise in scaling this approach to handle complex behavioral requirements. We propose a dynamics that operates in the space of task constraints, determining the relative contribution of each constraint to the behavioral dynamics. Competition among task constraints is able to deal with problems that arise when combining constraint contributions, making it possible to specify tasks that are mome complex than simple navigation. To demonstrate the utility of this approach, we design a system of two agents to perform a cooperative navigation task We show how competition among constraints enables agents to make decisions regarding which behavior to execute in a given situation, resulting in the execution of sequences of behaviors that satisfy task requirements. We discuss the scalability of the competitive-dynamics approach to the design of more complex autonomous systems.
Adams, J., Bajcsy, R., Koeck'a, J., Kumar, V.Mandelbam, R., Mintz, M., Paul, R., Wang, C.-C., Yamamoto, Y., and Yun, X. 1995. Cooperative material handling by human and robotic agents: Module development and system synthesis. Proc. of the IEEE/RSJ Int. Conf. on Intell. Robots and Sys. IEEE pp. 195-197. Google Scholar |
Amari, A. 1977. Dynamics of pattern formation in lateralinhibition type neural fields . Biol. Cybernet. 27: 77-87 . Google Scholar | Crossref | Medline | ISI |
Brockett, R. W. 1994. Dynamical systems and their associated automata. In Systems and Networks: Mathematical Theory and Applications, vol. 77, Berlin: Akademi-Verlag , pp. 49-69. Google Scholar |
Brooks, R. 1989. A robot that walks: Emergent behaviours from a carefully evolted network . Neural Computation 1(2): 253-262 . Google Scholar | Crossref | ISI |
Desai, J., Wang, C., Zefran, M., and Kumar, V. 1996. Motion planning for multiple mobile manipulators. Proc. of the Int. Conf. on Robot. and Automat. Madison, WI, Omnipress , pp. 477-484. Google Scholar |
Engels, C., and Schöner, G. 1995. Dynamic field endow behavior-based robots with representations . Robot. Autonomous Sys. 14: 55-77 . Google Scholar | Crossref | ISI |
Guckenheimer, J., and Holmes, P. 1983. Nonlinear Oscillations, Dynamical Systems and Bifurcations of Vector Fields, Springer-Verlag, vol. 42 of Applied Mathematical Sciences, New York: Springer-Verlag . Google Scholar |
Jacobs, R. A., Jordan, M. I., and Barto, A. 1990. Task decomposition through competition in a modular architecture: The what and where in vision tasks . Cognitive Science 15: 219-250 . Google Scholar | ISI |
Jordan, M. I., and Jacobs, R. A. 1994. Hierarchical mixtures of experts and the em algorithm . Neural Computation 6: 181-214 . Google Scholar | Crossref | ISI |
Khatib, O. 1986. Real time avoidance for manipulators and mobile robots . Int. J Robot. Res. 5(l): 90-98 . Google Scholar | Abstract |
Latombe, J. C. 1991. Robot Motion Planning. Boston, Kluwer Academic . Google Scholar |
Lozano-Perez, T., and Wesley, W. A. 1979. An algorithm for planning collision-free paths among polyhedral obstacles . Comm. ACM 22(10). Google Scholar |
Lumelsky, V. J., and Stepanov, A. A. 1987. Path-planning strategies for a point mobile automaton moving amidst unknow obstacles of arbitrary shape . Algorithmica 2: 403-430 . Google Scholar | Crossref | ISI |
Mallot, H., Bülthoff, H., Little, L., and Bohrer, S. 1991. Inverse-perspective mapping simplifies optical flow computation and obstacle detection . Biol. Cybernet. 64: 177-185 . Google Scholar | Crossref | Medline | ISI |
Murray, R. M., Li, Z., and Sastry, S. S. 1991. Robotic Manipulation. New York: CRC Press . Google Scholar |
Neven, H., and Schöner, G. 1996. Neural dynamics parametrically controlled by image correlations organize robot navigation . Biol. Cybernet. 75: 293-301 . Google Scholar | Crossref | ISI |
Perko, I. 1991. Differential Equations and Dynamical Systems: Texts in Applied Mathematics. Berlin: Springer-Verlag . Google Scholar |
Rimon, E., and Koditschek, D. E. 1993. Exact robot navigation using artificial potential functions . IEEE Trans. Robot. Automat. 8(5): 501-519 . Google Scholar |
Schöner, G., and Dose, M. 1992. A dynamic systems approach to task-level systems integration used to plan and control autonomous vehicle motion . Robot. Autonomous Sys. 10: 253-267 . Google Scholar | Crossref |
Schöner, G., Dose, M., and Engels, C. 1995. Dynamics of behaviour: Theory and applications for autonomous robot architectures . Robot. Autonomous Sys. 16(2): 213-246 . Google Scholar | Crossref | ISI |
Schöner, G., and Kelso, J. 1988. Dynamic pattern generation in behavioral and neural systems . Science 239: 1513-1520 . Google Scholar | Crossref | Medline | ISI |
Schwarz, J. T., and Sharir, M. 1983. On the 'piano movers' problem. I. The case of two-dimensional rigid polygonal body moving amidst polygonal barriers . Comm. Pure Appl. Math. 36: 345-398 . Google Scholar | Crossref | ISI |
Steinhage, A., and Schöner, G. 1998. Dynamical systems for the behavioral organization of autonomous robot navigation. In P. S. Schenker and G. T. Mc Kee (Eds.), Sensor Fusion and Decentralized Control in Robotic Systems: Proceeding of SPLE. pp. 160-180. Bellingham, WA: SPIE Publishing . Google Scholar |
Venetianer, B., Large, E. W., and Bajcsy, R. 1997. Methodology for evaluation of task performance in robotic systems: A case study in vision-based localization . Machine Vision Apple. 9: 304-320 . Google Scholar | Crossref | ISI |
The problem of path planning for an automaton moving in a two-dimensional scene filled with unknown obstacles is considered. The automaton is presented as a point; obstacles can be of an arbitrary shape, with continuous boundaries and of finite size; no restriction on the size of the scene is imposed. Path planning. Because the roomba is a serial device, there are no language, system, or computational limitations except those of the controlling onboard palmtop, laptop, or desktop computer – the last presumably offboard! The CS 1 class used the erdos simulator halfway through the semester to introduce the notion of functions.