Motion planning and control for systems with multiple mobile objects
First Claim
1. A system for controlling the movements of multiple mobile objects through a workspace, wherein the position of each object is dependent on the configuration of a plurality of interconnected linkages, as defined by a plurality, n, of configuration settings corresponding to n degrees of freedom of the object, the system comprising:
- a path planner for planning in advance a series of movements of each of the mobile objects to provide a relatively coarse scale plan for the movements, wherein the path planner determines paths in a configuration space defined by n orthogonal axes corresponding to n configuration settings that define the position of each object in three-dimensional space; and
a path execution module operable to move the objects in accordance with the relatively coarse scale plan provided by the path planner, and including a fine-scale artificial force field collision avoidance subsystem, to provide control signals to the movable objects such that they are moved along paths determined in part by the path planner and in part by the collision avoidance subsystem, whereby the objects are moved from starting points to desired endpoints without collisions with each other or with any stationary obstacles, and wherein the path execution module includesa waypoint interpolator, to generate finer resolution paths from path data provided by the path planner.a control law module for generating control signals based on the finer resolution path through configuration space and predicted configuration setting of the object,a collision avoidance force model, for generating collision avoidance control signals based on mutual proximity of the objects in the workplace, andmeans for combining the collision avoidance control signals and the control signals from the control law module, wherein collision avoidance is achieved on a fine scale by modifying the paths planed through the configuration space.
4 Assignments
0 Petitions
Accused Products
Abstract
A method and apparatus for path planning and execution of movements of multiple mobile objects, such as robotic manipulators (64, 66), in a common workspace. Path planning at a relatively coarse scale yields, for each object, path definitions (24) in configuration space (c-space), which is an n-dimensional space, where there are n degrees of freedom of movement of each object. The coarse path definitions are interpolated to provide primary control signals (54) to execute object movements, in combination with collision avoidance control signals (56) derived from an artificial force field model (46) that generates repulsion forces based on mutual proximity of the objects. Path planning includes determining which subregions or cells of c-space are subject to potential collision, and selecting multiple trial path segments until a path is found around those cells. For execution, the coarse scale path parameters, are expanded to a finer scale by interpolation (40), and the artificial force field model generates additional control signals (56) corresponding to the repulsion forces needed to maintain separation of the objects in the workspace.
-
Citations
28 Claims
-
1. A system for controlling the movements of multiple mobile objects through a workspace, wherein the position of each object is dependent on the configuration of a plurality of interconnected linkages, as defined by a plurality, n, of configuration settings corresponding to n degrees of freedom of the object, the system comprising:
-
a path planner for planning in advance a series of movements of each of the mobile objects to provide a relatively coarse scale plan for the movements, wherein the path planner determines paths in a configuration space defined by n orthogonal axes corresponding to n configuration settings that define the position of each object in three-dimensional space; and a path execution module operable to move the objects in accordance with the relatively coarse scale plan provided by the path planner, and including a fine-scale artificial force field collision avoidance subsystem, to provide control signals to the movable objects such that they are moved along paths determined in part by the path planner and in part by the collision avoidance subsystem, whereby the objects are moved from starting points to desired endpoints without collisions with each other or with any stationary obstacles, and wherein the path execution module includes a waypoint interpolator, to generate finer resolution paths from path data provided by the path planner. a control law module for generating control signals based on the finer resolution path through configuration space and predicted configuration setting of the object, a collision avoidance force model, for generating collision avoidance control signals based on mutual proximity of the objects in the workplace, and means for combining the collision avoidance control signals and the control signals from the control law module, wherein collision avoidance is achieved on a fine scale by modifying the paths planed through the configuration space. - View Dependent Claims (2, 3, 4, 5, 6, 7)
-
-
8. A system for controlling the movements of multiple robotic manipulators through a workspace, wherein the position of each manipulator is dependent on the configuration of a plurality of interconnected linkages, as defined by a plurality, n, of configuration joint settings corresponding to n degrees of freedom of the manipulator, the system comprising:
-
a path planner for planning in advance a series of movements of each of a plurality robotic manipulators to provide a relatively coarse scale plan for the movements, wherein the path planner determines paths in a configuration space defined by n orthogonal axes corresponding to n configuration joint settings that define the position of each manipulator in three-dimensional space; and a path execution module operable to move the manipulators in accordance with the relatively coarse scale plan provided by the path planner, and including a fine-scale artificial force field collision avoidance subsystem, to provide control signals to the manipulators such that they are moved along paths determined in part by the path planner and in part by the collision avoidance subsystem, whereby the manipulators are moved from starting points to desired endpoints without collisions with each other or with any stationary obstacles, and wherein the path execution module includes a waypoint interpolator, to generate finer resolution paths from path data provided by the path planner, a control law module for generating control signals based on the finer resolution paths through configuration space and predicted states of the manipulators; a collision avoidance force model, for generating collision avoidance control signals based on mutual proximity of the manipulators and any other objects in the workspace, and means for combining the collision avoidance control signals and the control signals from the control law module, wherein collision avoidance is achieved by modifying the paths planned through the configuration space. - View Dependent Claims (9, 10, 11, 12, 13, 14)
-
-
15. A method for planning and executing movements of multiple mobile objects through a workspace, wherein the position of each object is dependent on the configuration of a plurality of interconnected linkages, as defined by a plurality, n, of configuration settings corresponding to n degrees of freedom of the object, the method comprising the steps of:
-
planning in advance a path having series of movements of each of the mobile objects to provide a relatively coarse scale plan for the movements, wherein the planning step determines paths in a configuration space defined by n orthogonal axes corresponding to n configuration settings that define the position of each object in three-dimensional space; controlling the path execution in such a way as to move the objects primarily in accordance with the relatively coarse scale plan provided by the planning step, and including an additional step of generating collision avoidance object control signals based on an artificial force field model, wherein the step of controlling the path execution movement includes interpolating between coarse path planning waypoints to generate finer resolution planned paths, generating control signals based on the finer resolutions paths through configuration space and predicted configuration settings of the objects, generating collision avoidance control signals based on mutual proximity of objects in the workspace, and combining collision avoidance control signals and the control signals based on the finer resolution planned path, wherein collision avoidance is achieved by modifying the paths planned through the configuration space; and applying control signals to the movable objects such that they are moved along paths determined in part by the path planning step and in part by the step of controlling the path execution, whereby the objects are moved from starting points to desired endpoints without collision with each other or with any stationary obstacles. - View Dependent Claims (16, 17, 18, 19, 20, 21)
-
-
22. A method for planning and executing movements of multiple robotic manipulators through a workspace, wherein the position of each manipulator is dependent on the configuration of a plurality of interconnected linkages, as defined by a plurality, n, of configuration joint settings corresponding to n degrees freedom of the manipulator, the method comprising the steps of:
-
planning in advance a path having series of movements of each of the manipulators to provide a relatively coarse scale plan for the movements, wherein the planning step determines paths in a configuration space defined by n orthogonal axes corresponding to n configuration settings that define the position of each manipulator in three-dimensional space; controlling the path execution in such a way as to move the manipulators primarily in accordance with the relatively coarse scale plan provided by the planning step, and including an additional step of generating collision avoidance object control signals based on an artificial force field model, wherein the step of controlling the path execution movement includes interpolating between coarse path planning waypoints to generate finer resolution planned paths, generating control signals based on the finer resolution paths through configuration space and predicted configuration settings of the manipulators, generating collision avoidance control signals based on mutual proximity of manipulators and any obstacles in the workspace, and combining the collision avoidance control signals and the control signals based on the finer resolution planned paths, wherein collision avoidance is achieved by modifying the paths planned through the configuration space; and applying control signals to the manipulators in such that they are moved along paths determined in part by the path planning step and in part by the step of controlling the path execution, whereby the manipulators are moved from starting points to desired endpoints without collisions with each other or with any stationary obstacles. - View Dependent Claims (23, 24, 25, 26, 27, 28)
-
Specification