METHOD AND SYSTEM FOR AUTOMATICALLY GUIDING AN UNMANNED VECHILE
First Claim
1. A method for automatically guiding an unmanned vehicle along a predetermined route, the method comprising:
- (a) selecting first, second, third and fourth locations along said route defining adjacent first, second and third linear portions for a current iteration such that the first and second linear portions meet at the second location and the second and third linear portions meet at the third location;
(b) if an imaginary circle can be constructed that is mutually tangential to all three of said first, second and third linear portions or to projections thereof;
i) guiding the vehicle according to the circle intercept method as herein defined until it reaches an imaginary point of contact (M) between said circle and the second linear portion or passes its traverse; and
ii) thereafter selecting a fifth location along the route so that the second, third, fourth and fifth locations of the current iteration respectively constitute said first, second, third and fourth locations of a successive iteration and repeating from (b);
(c) if an imaginary circle cannot be constructed that is mutually tangential to all three of said first, second and third linear portions or to projections thereof;
i) constructing an imaginary circle that is mutually tangential to the first and second linear portions;
ii) guiding the vehicle along according to the leg intercept method as herein defined until the vehicle reaches an imaginary point of contact (M) between said circle and the first linear portion or passes its traverse; and
iii) thereafter selecting a fifth location along the route so that the second, third, fourth and fifth locations of the current iteration respectively constitute said first, second, third and fourth locations for a successive iteration and repeating from (b).
1 Assignment
0 Petitions
Accused Products
Abstract
An unmanned vehicle is guided by selecting locations along a predetermined mute defining adjacent first, second and third linear portions. If an imaginary circle can be constructed that is mutually tangential to all three linear portions or to projections thereof, the vehicle is guided according to the circle intercept method until it reaches an imaginary point of contact (M) between the circle and the second linear portion or passes its traverse. If an imaginary circle cannot be constructed that is mutually tangential to all three linear portions or to projections thereof, an imaginary circle is constructed that is mutually tangential to the first and second linear portions; and the vehicle is guided along according to the leg intercept method until it reaches an imaginary point of contact (M) between the circle and the first linear portion or passes its traverse. The process is repeated iteratively in respect of successive locations.
23 Citations
13 Claims
-
1. A method for automatically guiding an unmanned vehicle along a predetermined route, the method comprising:
-
(a) selecting first, second, third and fourth locations along said route defining adjacent first, second and third linear portions for a current iteration such that the first and second linear portions meet at the second location and the second and third linear portions meet at the third location; (b) if an imaginary circle can be constructed that is mutually tangential to all three of said first, second and third linear portions or to projections thereof; i) guiding the vehicle according to the circle intercept method as herein defined until it reaches an imaginary point of contact (M) between said circle and the second linear portion or passes its traverse; and ii) thereafter selecting a fifth location along the route so that the second, third, fourth and fifth locations of the current iteration respectively constitute said first, second, third and fourth locations of a successive iteration and repeating from (b); (c) if an imaginary circle cannot be constructed that is mutually tangential to all three of said first, second and third linear portions or to projections thereof; i) constructing an imaginary circle that is mutually tangential to the first and second linear portions; ii) guiding the vehicle along according to the leg intercept method as herein defined until the vehicle reaches an imaginary point of contact (M) between said circle and the first linear portion or passes its traverse; and iii) thereafter selecting a fifth location along the route so that the second, third, fourth and fifth locations of the current iteration respectively constitute said first, second, third and fourth locations for a successive iteration and repeating from (b). - View Dependent Claims (2, 3, 4, 5)
-
-
6. A method for automatically guiding a vehicle along a predetermined route, the method comprising:
-
(a) obtaining successive current speed and wheel angle signals of the vehicle; (b) obtaining successive current angle signals from an inertial navigation system; (c) obtaining current successive digital GPS velocity and position signals; (d) filtering said signals to derive a current velocity signal of the vehicle; (e) integrating the current velocity signal to determine a predicted vehicle position; (f) comparing the predicted vehicle position with a current sensed position of the vehicle as determined by one or more vehicle positioning sensors; (g) if a difference between the predicted vehicle position and the current sensed position of the vehicle exceeds a predetermined threshold, then; i) if the computed current position remains stable for a predetermined number of successive iterations, using the computed current position for position filtering, vehicle control generation and in a subsequent iteration; and ii) otherwise eliminating the computed current position; (h) determining a new position of the vehicle as a weighted average of the respective sensed positions; and (i) using the new position to control the vehicle. - View Dependent Claims (7)
-
-
8. (canceled)
-
9. (canceled)
-
10. A navigation data filter comprising:
-
a velocity filter having inputs for receiving signals indicative of vehicle speed and wheel angle as well as GPS velocity signals; a velocity component computation unit for receiving angle signals from an inertial navigation unit and feeding to an input of the velocity filter; an azimuth filter for receiving azimuth signals from the inertial navigation unit and feeding to an input of the velocity filter; an integrator coupled to the velocity filter for integrating a current velocity signal output thereby so as to produce a predicted position signal; one or more comparators each coupled to the integrator and to a respective external sensor for determining whether a difference between the predicted position a sensed position as received from a respective one of the external sensors exceeds a predetermined threshold, a weighting unit coupled to an output of the comparator and being responsive to said difference being within a prescribed limit for computing a new position that is a weighted average of input position signals fed thereto, and an abnormal data processing unit responsive to said difference being outside said prescribed limit for determining whether the sensed position is stable, and if so for feeding the sensed position to the weighting unit. - View Dependent Claims (11)
-
-
12. A program storage device readable by machine, tangibly embodying a program of instructions executable by the machine to perform a method for automatically guiding an unmanned vehicle along a predetermined route, the method comprising:
-
(a) selecting first, second, third and fourth locations along said route defining adjacent first, second and third linear portions for a current iteration such that the first and second linear portions meet at the second location and the second and third linear portions meet at the third location; (b) if an imaginary circle can be constructed that is mutually tangential to all three of said first, second and third linear portions or to projections thereof; i) guiding the vehicle according to the circle intercept method as herein defined until it reaches an imaginary point of contact (M) between said circle and the second linear portion or passes its traverse; and ii) thereafter selecting a fifth location along the route so that the second, third, fourth and fifth locations of the current iteration respectively constitute said first, second, third and fourth locations of a successive iteration and repeating from (b); (c) if an imaginary circle cannot be constructed that is mutually tangential to all three of said first, second and third linear portions or to projections thereof; i) constructing an imaginary circle that is mutually tangential to the first and second linear portions; ii) guiding the vehicle along according to the leg intercept method as herein defined until the vehicle reaches an imaginary point of contact (M) between said circle and the first linear portion or passes its traverse; and iii) thereafter selecting a fifth location along the route so that the second, third, fourth and fifth locations of the current iteration respectively constitute said first, second, third and fourth locations for a successive iteration and repeating from (b).
-
-
13. A program storage device readable by machine, tangibly embodying a program of instructions executable by the machine to perform a method for automatically guiding a vehicle along a predetermined route, the method comprising:
-
(a) obtaining successive current speed and wheel angle signals of the vehicle; (b) obtaining successive current angle signals from an inertial navigation system; (c) obtaining current successive digital GPS velocity and position signals; (d) filtering said signals to derive a current velocity signal of the vehicle; (e) integrating the current velocity signal to determine a predicted vehicle position; (f) comparing the predicted vehicle position with a current sensed position of the vehicle as determined by one or more vehicle positioning sensors; (g) if a difference between the predicted vehicle position and the current sensed position of the vehicle exceeds a predetermined threshold, then; i) if the computed current position remains stable for a predetermined number of successive iterations, using the computed current position for position filtering, vehicle control generation and in a subsequent iteration; and ii) otherwise eliminating the computed current position; (h) determining a new position of the vehicle as a weighted average of the respective sensed positions; and (i) using the new position to control the vehicle.
-
Specification