## Coordinating Multiple Robots with Kinodynamic Constraints along Specified Paths (2005)

### Cached

### Download Links

- [www.cs.rpi.edu]
- [www.cs.rpi.edu]
- [ijr.sagepub.com]
- DBLP

### Other Repositories/Bibliography

Citations: | 50 - 9 self |

### BibTeX

@MISC{Peng05coordinatingmultiple,

author = {Jufeng Peng and Srinivas Akella},

title = {Coordinating Multiple Robots with Kinodynamic Constraints along Specified Paths},

year = {2005}

}

### Years of Citing Articles

### OpenURL

### Abstract

This paper focuses on the collision-free coordination of multiple robots with kinodynamic constraints along specified paths. We present an approach to generate continuous velocity profiles for multiple robots; these velocity profiles satisfy the dynamics constraints, avoid collisions, and minimize the completion time. The approach, which combines techniques from optimal control and mathematical programming, consists of identifying collision segments along each robot's path, and then optimizing the robots' velocities along the collision and collision-free segments. First, for each path segment for each robot, the minimum and maximum possible traversal times that satisfy the dynamics constraints are computed by solving the corresponding two-point boundary value problems. The collision avoidance constraints for pairs of robots can then be combined to formulate a mixed integer nonlinear programming (MINLP) problem. Since this nonconvex MINLP model is difficult to solve, we describe two related mixed integer linear programming (MILP) formulations, which provide schedules that give lower and upper bounds on the optimum; the upper bound schedule is designed to provide continuous velocity trajectories that are feasible. The approach is illustrated with coordination of multiple robots, modeled as double integrators subject to velocity and acceleration constraints. An application to coordination of nonholonomic car-like robots is described, along with implementation results for 12 robots.

### Citations

1988 |
Robot Motion Planning
- Latombe
- 1991
(Show Context)
Citation Context ...le Robot Coordination: Motion planning for multiple robots requires moving each robot from its initial to its goal configuration, while avoiding collisions with static obstacles or with other robots (=-=[24]-=-). This problem is highly underconstrained, and Hopcroft, Schwartz, and Sharir [16] showed that even a simplified two-dimensional case of the problem is PSPACE-hard. Recent efforts have focused on red... |

1038 |
Integer and Combinatorial Optimization
- Nemhauser, Wolsey
- 1988
(Show Context)
Citation Context ...) (when Ai exits segment k before Aj enters segment h) or tik ≥ tj(h+1) (when Aj exits segment h before Ai enters segment k). These disjunctive constraints are converted to standard conjunctive form (=-=[28]-=-) by introducing δijkh, a binary variable that is 1 if robot Ai goes first along its kth segment and 0 if robot Aj goes first along its hth segment, and M, a sufficiently large positive number. The re... |

482 |
Scheduling: Theory, Algorithms and Systems
- Pinedo
- 1995
(Show Context)
Citation Context ...al operations, is a robot’s motion along its path. Each operation is the motion along a segment. Each machine is a collision zone or a collision-free zone. The job shop scheduling problem is NP-hard (=-=[31]-=-), and by reduction, the instantaneous model for robot coordination is NP-hard. 5 Continuous Velocity Model We now consider generating a schedule with continuous velocity profiles for the robots that ... |

403 | Randomized kinodynamic planning
- LaValle, Kuffner
- 2001
(Show Context)
Citation Context ...mics constraints moving along a given path among moving obstacles. Recent work has focused on randomized kinodynamic planning, including the use of rapidly exploring random trees (Lavalle and Kuffner =-=[27]-=-) and probabilistic roadmaps (Hsu et al. [17]). Air Traffic Control: Conflict resolution among multiple aircraft in a shared airspace is closely related to multiple robot coordination. Tomlin, Pappas,... |

341 |
AMPL: a modeling language for mathematical programming Thomson/Brooks/Cole
- Fourer, Gay, et al.
- 2003
(Show Context)
Citation Context ...e PQP collision detection package (Larsen et al. [23]) by sampling uniformly along each robot’s path. We generate the MILP formulations from the computed collision zones and solve them using the AMPL =-=[13]-=- and CPLEX [18] optimization packages. Since the setpoint formulation with its tighter constraints is usually solved much more quickly than the improved instantaneous formulation, we use the setpoint ... |

328 | SNOPT: An SQP algorithm for Large-Scale Constrained Optimization - Gill, Murray, et al. - 2001 |

201 | Conflict resolution for air traffic management: A study in multi-agent hybrid systems
- Tomlin, Pappas, et al.
- 1998
(Show Context)
Citation Context ...ilistic roadmaps (Hsu et al. [17]). Air Traffic Control: Conflict resolution among multiple aircraft in a shared airspace is closely related to multiple robot coordination. Tomlin, Pappas, and Sastry =-=[42]-=- synthesized provably safe conflict resolution maneuvers for two aircraft using speed and heading changes. Kosecka et al. [21] used potential field planners to generate conflict resolution maneuvers. ... |

190 | Randomized kinodynamic motion planning with moving obstacles
- Hsu, Kindel, et al.
(Show Context)
Citation Context ...ong moving obstacles. Recent work has focused on randomized kinodynamic planning, including the use of rapidly exploring random trees (Lavalle and Kuffner [27]) and probabilistic roadmaps (Hsu et al. =-=[17]-=-). Air Traffic Control: Conflict resolution among multiple aircraft in a shared airspace is closely related to multiple robot coordination. Tomlin, Pappas, and Sastry [42] synthesized provably safe co... |

172 | On Multiple Moving Objects
- Erdmann, Lozano-Perez
- 1987
(Show Context)
Citation Context ...obots have specified trajectories. This is the problem of planning a path and velocity for a single robot among moving obstacles (Reif and Sharir [32], Kant and Zucker [19]). Erdmann and Lozano-Perez =-=[12]-=- obtain a heuristic solution for planning the motions of multiple robots by assigning priorities to robots and sequentially searching for collision-free paths for the robots in the configuration-time ... |

155 |
Numerical Potential Field Techniques for Robot Path Planning
- Barraquand, Langlois, et al.
- 1992
(Show Context)
Citation Context ...ion space by grouping robots (Aronov et al. [3]) or using probabilistic approaches. A potential field randomized path planner was applied to multiple robot planning (Barraquand, Langlois, and Latombe =-=[4]-=-), and probabilistic roadmap planner have been developed for multiple car-like robots (Svestka and Overmars [43]) and multiple manipulators (Sanchez and Latombe [35]). A slightly more constrained vers... |

136 | Practical Methods for Optimal Control Using Nonlinear - Betts - 2001 |

131 |
Towards efficient trajectory planning: the pathvelocity decomposition
- Kant, Zucker
- 1986
(Show Context)
Citation Context ...tained when all but one of the robots have specified trajectories. This is the problem of planning a path and velocity for a single robot among moving obstacles (Reif and Sharir [32], Kant and Zucker =-=[19]-=-). Erdmann and Lozano-Perez [12] obtain a heuristic solution for planning the motions of multiple robots by assigning priorities to robots and sequentially searching for collision-free paths for the r... |

127 |
Time-Optimal Control of Robotic Manipulators Along Specified Path
- Bobrow, Dubowsky, et al.
- 1985
(Show Context)
Citation Context ...y addressed either the collision-free path coordination problem of several robots without considering dynamics constraints ([29],[26],[41]), or the search for time-optimal motions for a single robot (=-=[7]-=-,[39]), the contribution of this paper is an approach to generate continuous velocity profiles that avoids2 Peng and Akella collisions between multiple robots and that also minimize the task completio... |

114 | Motion planning in dynamic environments using velocity obstacles - Fiorini, Shiller - 1998 |

109 | Motion planning in the presence of moving obstacles
- Reif, Sharir
- 1985
(Show Context)
Citation Context ...n of the problem is obtained when all but one of the robots have specified trajectories. This is the problem of planning a path and velocity for a single robot among moving obstacles (Reif and Sharir =-=[32]-=-, Kant and Zucker [19]). Erdmann and Lozano-Perez [12] obtain a heuristic solution for planning the motions of multiple robots by assigning priorities to robots and sequentially searching for collisio... |

96 |
On the complexity of motion planning for multiple independent objects: PSPACE-hardness of the warehouseman’s problem
- Hopcroft, Schwartz, et al.
- 1984
(Show Context)
Citation Context ...ot from its initial to its goal configuration, while avoiding collisions with static obstacles or with other robots ([24]). This problem is highly underconstrained, and Hopcroft, Schwartz, and Sharir =-=[16]-=- showed that even a simplified two-dimensional case of the problem is PSPACE-hard. Recent efforts have focused on reducing the dimension of the configuration space by grouping robots (Aronov et al. [3... |

92 |
Minimum-time control of robotic manipulators with geometric path constraints
- Shin, McKay
- 1985
(Show Context)
Citation Context ...dressed either the collision-free path coordination problem of several robots without considering dynamics constraints ([29],[26],[41]), or the search for time-optimal motions for a single robot ([7],=-=[39]-=-), the contribution of this paper is an approach to generate continuous velocity profiles that avoids2 Peng and Akella collisions between multiple robots and that also minimize the task completion tim... |

85 | Kinodynamic motion planning
- Donald, Xavier, et al.
- 1993
(Show Context)
Citation Context ...ts. Implementation results for coordination of 12 robots are described. 1 Introduction Coordinating multiple robots with kinodynamic constraints, i.e. simultaneous kinematic and dynamics constraints (=-=[11]-=-), in a shared workspace without collisions has applications in manufacturing cells ([33]), AGV coordination in harbors and airports ([2]), and air traffic control ([5]). The general problem requires ... |

79 |
Robot Motion Planning and Control
- LAUMOND, SEKHAVAT, et al.
- 1998
(Show Context)
Citation Context ...e easily added to the MILP formulations. Car-like robots: Our approach can be applied to car-like nonholonomic robots with continuous curvature paths. Paths that satisfy the nonholonomic constraints (=-=[25]-=-) typically require the robot to stop whenever there is a discontinuity in curvature (to change the steering direction) or there is a cusp point (to reverse the robot direction of motion). Therefore w... |

79 | Optimal motion planning for multiple robots having independent goals
- LaValle, Hutchinson
- 1998
(Show Context)
Citation Context ...h kinodynamic constraints along specified paths. While prior work mostly addressed either the collision-free path coordination problem of several robots without considering dynamics constraints ([29],=-=[26]-=-,[41]), or the search for time-optimal motions for a single robot ([7],[39]), the contribution of this paper is an approach to generate continuous velocity profiles that avoids2 Peng and Akella collis... |

74 | A provably good approximation algorithm for optimal-time trajectory planning - Donald, Xavier - 1989 |

70 |
Global time-optimal motions of robotic manipulators in the presence of obstacles
- Shiller, Dubowsky
- 1988
(Show Context)
Citation Context ...tory planning directly in the 2n-dimensional state space that considers both kinematic and dynamic constraints is called kinodynamic planning. Sahar and Hollerbach [34] and later Shiller and Dubowsky =-=[38]-=- developed algorithms for global near minimum-time trajectory generation (path and velocity) for a manipulator with dynamics and actuator constraints using grid-based search spaces. Donald et al. [11]... |

65 | On delaying collision checking in prm planning: Application to multi-robot coordination,” The international
- Sanchez, Latombe
- 2002
(Show Context)
Citation Context ... (Barraquand, Langlois, and Latombe [4]), and probabilistic roadmap planner have been developed for multiple car-like robots (Svestka and Overmars [43]) and multiple manipulators (Sanchez and Latombe =-=[35]-=-). A slightly more constrained version of the problem is obtained when all but one of the robots have specified trajectories. This is the problem of planning a path and velocity for a single robot amo... |

64 |
Deadlock-free and collision-free coordina- tion of two robot manipulators
- O’Donnell, Lozano-Pérez
- 1989
(Show Context)
Citation Context ...g with kinodynamic constraints along specified paths. While prior work mostly addressed either the collision-free path coordination problem of several robots without considering dynamics constraints (=-=[29]-=-,[26],[41]), or the search for time-optimal motions for a single robot ([7],[39]), the contribution of this paper is an approach to generate continuous velocity profiles that avoids2 Peng and Akella c... |

60 | Mixed integer programming for multivehicle path planning
- Schouwenaars, DeMoor, et al.
- 2001
(Show Context)
Citation Context ...chi and Pallottino [5] modeled aircraft with constant velocity and curvature bounds and generated minimum total time collision-free paths using given waypoints for three aircraft. Schouwenaars et al. =-=[37]-=- used a discretized system model to develop an MILP formulation for fuel-optimal path planning of multiple vehicles, including moving obstacles. Pallottino, Feron, and Bicchi [30] generate conflict-fr... |

56 |
Coordinated motion planning for multiple car-like robots using probabilistic roadmaps
- Svestka, Overmars
- 1995
(Show Context)
Citation Context ...d path planner was applied to multiple robot planning (Barraquand, Langlois, and Latombe [4]), and probabilistic roadmap planner have been developed for multiple car-like robots (Svestka and Overmars =-=[43]-=-) and multiple manipulators (Sanchez and Latombe [35]). A slightly more constrained version of the problem is obtained when all but one of the robots have specified trajectories. This is the problem o... |

51 | Fast motion planning for multiple moving robots - Buckley - 1989 |

49 | Path coordination for multiple mobile robots: a resolution-complete algorithm,IEEE Transactionson Roboticsand Automation
- Siméon, Leroy, et al.
(Show Context)
Citation Context ...odynamic constraints along specified paths. While prior work mostly addressed either the collision-free path coordination problem of several robots without considering dynamics constraints ([29],[26],=-=[41]-=-), or the search for time-optimal motions for a single robot ([7],[39]), the contribution of this paper is an approach to generate continuous velocity profiles that avoids2 Peng and Akella collisions ... |

46 | An exact algorithm for kinodynamic planning in the plane - Canny, Rege, et al. - 1991 |

43 | Dynamic scaling of manipulator trajectories - Hollerbach - 1984 |

42 | Planning of minimum-time trajectories for robot arms
- Sahar, Hollerbach
- 1985
(Show Context)
Citation Context ...oving along a specified path. Trajectory planning directly in the 2n-dimensional state space that considers both kinematic and dynamic constraints is called kinodynamic planning. Sahar and Hollerbach =-=[34]-=- and later Shiller and Dubowsky [38] developed algorithms for global near minimum-time trajectory generation (path and velocity) for a manipulator with dynamics and actuator constraints using grid-bas... |

40 | Multirobot cooperation in the MARTHA project
- Alami, Fleury, et al.
- 1998
(Show Context)
Citation Context ...raints, i.e. simultaneous kinematic and dynamics constraints ([11]), in a shared workspace without collisions has applications in manufacturing cells ([33]), AGV coordination in harbors and airports (=-=[2]-=-), and air traffic control ([5]). The general problem requires finding the trajectory (path and velocity profile) of each robot such that the specified objective, such as the task completion time, tot... |

39 |
On optimal cooperative conflict resolution of air traffic management systems
- Bicchi, Pallottino
- 2000
(Show Context)
Citation Context ...atic and dynamics constraints ([11]), in a shared workspace without collisions has applications in manufacturing cells ([33]), AGV coordination in harbors and airports ([2]), and air traffic control (=-=[5]-=-). The general problem requires finding the trajectory (path and velocity profile) of each robot such that the specified objective, such as the task completion time, total time, or energy consumption,... |

39 | Trajectory Planning in a Dynamic Workspace: a 'State-Time Space' Approach
- Fraichard, Rhone-Alpes
- 1999
(Show Context)
Citation Context ... spaces. Donald et al. [11] developed a polynomial time approximation algorithm to generate near time-optimal trajectories for a single robot that satisfy kinematic and dynamic constraints. Fraichard =-=[14]-=- describes a trajectory planner for a car-like robot with dynamics constraints moving along a given path among moving obstacles. Recent work has focused on randomized kinodynamic planning, including t... |

34 | A hierarchical strategy for path planning among moving objects - Fujimura, Samet - 1989 |

30 | Coordinating the motions of multiple robots with specified trajectories
- Akella, Hutchinson
(Show Context)
Citation Context ...robot is specified. Previous work on trajectory coordination focused almost exclusively on dual robot systems (Shin and Zheng [40], Bien and Lee [6], Chang, Chung, and Lee [9]). Akella and Hutchinson =-=[1]-=- recently developed an MILP formulation for the trajectory coordination of large numbers of robots by changing robot start times. Our work extends these problem classes by additionally considering dyn... |

30 | Smooth motion planning for car-like vehicles
- Lamiraux, Laumond
- 2001
(Show Context)
Citation Context ... for a forward moving robot (Scheuer and Fraichard [36]) so that the robot does not have to stop at curvature discontinuities. When the class of continuous curvature paths includes cusp points ([15], =-=[22]-=-), we add the constraint that the robot velocity must be zero at every such point. Aircraft: To apply this approach to aircraft, we can use a simplified planar aircraft model ([5]). Since the path is ... |

30 |
Conflict resolution problems for air traffic management systems solved with mixed integer programming
- Pallottino, Feron, et al.
(Show Context)
Citation Context ... Schouwenaars et al. [37] used a discretized system model to develop an MILP formulation for fuel-optimal path planning of multiple vehicles, including moving obstacles. Pallottino, Feron, and Bicchi =-=[30]-=- generate conflict-free paths to minimize the total flight time for the cases when either instantaneous velocity changes or heading angle changes are allowed. 3 Problem Overview Given a set of n robot... |

28 | Time optimal trajectory planning in dynamic environments - Fiorini, Shiller - 1996 |

26 | Resolution of conflicts involving many aircraft via semidefinite programming - Frazzoli, Mao, et al. |

25 | BMotion planning in dynamic environments using the relative velocity paradigm - Fiorini, Shiller - 1993 |

25 | Improving the efficiency of time-optimal path-following algorithms - Slotine, Yang - 1989 |

24 | A concept for manipulator trajectory planning - Pfeiffer, Johanni - 1987 |

24 | Non-uniform discretization approximations for kinodynamic motion planning - Reif, Wang - 1997 |

23 | From Reeds and Shepp’s to Continuous-Curvature Paths
- Fraichard, Scheuer
- 2004
(Show Context)
Citation Context ... paths for a forward moving robot (Scheuer and Fraichard [36]) so that the robot does not have to stop at curvature discontinuities. When the class of continuous curvature paths includes cusp points (=-=[15]-=-, [22]), we add the constraint that the robot velocity must be zero at every such point. Aircraft: To apply this approach to aircraft, we can use a simplified planar aircraft model ([5]). Since the pa... |

22 | Time-optimal trajectories for a robotic manipulator: A provably good approximation algorithm - Heinzinger, Jacobs, et al. - 1990 |

22 | Computation of path constrained time optimal motions with dynamic singularities. Journal of dynamic systems, measurement, and control - Shiller, Lu - 1992 |

20 | The near-minimum-time control of open-loop articulated kinematic chains - Kahn, Roth |

20 | Optimal motion planning of autonomous vehicles in three-dimensional terrains - Shiller, Chen - 1990 |

20 | Motion planning in dynamic environments: Obstacles moving along arbitrary trajectories - Large, Sekhavat - 2001 |