Collision avoidance system and method for human commanded systems
A method of implementing an optimal avoidance filter for interposing between a human operator issued movement commands and a corresponding machine control system of a movable machine, for the avoidance of collisions with objects. The method: includes inputting a detailed representation of objects in the vicinity of the movable machine; and formulating a hierarchical set of bounding boxes around the objects. The hierarchical set including refinement details depending on the current positional state of the movable machine, with objects closer to the machine having higher levels of refinement details. The method further includes utilizing the resultant hierarchical set as a set of constraints for a mixed integer optimization problem to determine any alterations to the issued movement commands so as to avoid collisions with any objects.
1. A method of implementing an optimal avoidance filter for interposing between movement commands issued by a human operator and a machine control system of a movable machine operated by the human operator, for the avoidance of collisions with objects, the method comprising:
(a) inputting a detailed representation of the objects in a vicinity of the movable machine;
(b) formulating a hierarchical set of bounding boxes around the objects, the hierarchical set including refinement details depending on a current positional state of the movable machine, with the objects closer to the movable machine having higher levels of refinement details; and
(c) utilizing, by the processor, the hierarchical set as a set of constraints for an optimization program to determine any alterations to the issued movement commands so as to avoid collisions with the objects.
2. The method as claimed in claim 1 wherein the set of constraints comprise mixed integer constraints and the optimization program comprises a mixed integer optimization program.
3. The method as claimed in claim 1 further comprising:
(d) utilizing a the predicted future motion to update the hierarchical set.
4. The method as claimed in claim 1 wherein step (c) further comprises the step of:
determining a series of alternative alterations to the issued movement commands, and costing the series in terms of a magnitude of alteration, and utilizing a lower cost alternative alteration.
5. The method as claimed in claim 1 wherein steps (a) to (c) are applied in a continuous iterative manner.
6. The method as claimed in claim 1 wherein the hierarchical set of bounding boxes are axially aligned.
7. The method as claimed in claim 1 wherein the hierarchical set of bounding boxes includes representation of non convex objects, in a form of convexities in the hierarchical set.
8. The method as claimed in claim 1 wherein step (b) further comprises, for any particular time interval, culling members of the hierarchical set that are not reachable in a current time interval.