Vehicle control and guidance system
First Claim
1. A vehicle control and guidance system comprising:
- (A) a vehicle including(i) motive power means for driving said vehicle having a position and a heading along a path,(ii) dead reckoning means for estimating the position and the heading of said vehicle along the path,(iii) steering means for controlling the path of said vehicle,(iv) route data storage means for storing data defining a desired route for said vehicle, and(v) computing means having position comparison means for comparing the position of said vehicle as determined by said dead reckoning means with the desired route, and for controlling said steering means in dependence upon the result of the comparison;
(B) an electromagnetic direction finding system including(i) a plurality of fixed reference targets having fixed locations, and(ii) transmitting and receiving means mounted on said vehicle for making periodic determinations of a detected bearing relative to said vehicle of at least one of said fixed reference targets; and
(C) said computing means further having(i) means for periodically receiving from said direction finding system a said detected bearing of a fixed reference target,(ii) target storage means for storing the fixed locations of said fixed reference targets,(iii) means for deriving from said dead reckoning means and from the stored fixed location of the said fixed reference target an estimated bearing of the said fixed reference target,(iv) bearing comparison means for comparing the detected bearing determined by said transmitting and receiving means with the estimated bearing derived from said dead reckoning means, and for generating a bearing error, and(v) means for correcting the estimated position and the estimated heading of said vehicle determined by said dead reckoning means in dependence upon the bearing error determined by said bearing comparison means.
4 Assignments
0 Petitions
Accused Products
Abstract
A vehicle control and guidance system in which a desired route for the vehicle is stored in the vehicle in the form of co-ordinates in a ground reference frame. The `vectors` between these junction points are divided by successive reference points into incremental vectors, the reference points being generated ahead of the vehicle at regular intervals. A dead reckoning system predicts the position of the vehicle at the end of each interval and this estimate is corrected, using a Kalman filter, by an independent fixed-target detection system using a scanning laser. The error between the estimated vehicle position and the local incremental vector provides a steering angle correction for the vehicle and the vehicle speed is dependent upon the lag of the vehicle behind the generation of reference points.
-
Citations
22 Claims
-
1. A vehicle control and guidance system comprising:
-
(A) a vehicle including (i) motive power means for driving said vehicle having a position and a heading along a path, (ii) dead reckoning means for estimating the position and the heading of said vehicle along the path, (iii) steering means for controlling the path of said vehicle, (iv) route data storage means for storing data defining a desired route for said vehicle, and (v) computing means having position comparison means for comparing the position of said vehicle as determined by said dead reckoning means with the desired route, and for controlling said steering means in dependence upon the result of the comparison; (B) an electromagnetic direction finding system including (i) a plurality of fixed reference targets having fixed locations, and (ii) transmitting and receiving means mounted on said vehicle for making periodic determinations of a detected bearing relative to said vehicle of at least one of said fixed reference targets; and (C) said computing means further having (i) means for periodically receiving from said direction finding system a said detected bearing of a fixed reference target, (ii) target storage means for storing the fixed locations of said fixed reference targets, (iii) means for deriving from said dead reckoning means and from the stored fixed location of the said fixed reference target an estimated bearing of the said fixed reference target, (iv) bearing comparison means for comparing the detected bearing determined by said transmitting and receiving means with the estimated bearing derived from said dead reckoning means, and for generating a bearing error, and (v) means for correcting the estimated position and the estimated heading of said vehicle determined by said dead reckoning means in dependence upon the bearing error determined by said bearing comparison means.
-
-
2. A vehicle control and guidance system comprising:
-
(A) a vehicle including (i) motive power means for driving said vehicle having a position and a heading along a path, (ii) dead reckoning means for estimating the position and the heading of said vehicle along the path, (iii) steering means for controlling the path of said vehicle, (iv) route data storage means for storing data defining a desired route for said vehicle, and (v) computing means having position comparison means for comparing the position of said vehicle as determined by said dead reckoning means with the desired route, and for controlling said steering means in dependence upon the result of the comparison; (B) a laser target detection system including (i) a plurality of fixed reference target reflectors having fixed locations, (ii) laser beam scanning means mounted on said vehicle for scanning said target reflectors along a scanning direction, (iii) laser beam detection means mounted on said vehicle for detecting laser beam reflections from said target reflectors, said computing means having means for determining a detected bearing of a said target reflector from the scanning direction at the instant of detection of a said laser beam reflection; and (C) said computing means further having (i) means for periodically receiving from said laser target detection system a said detected bearing of a said target reflector, (ii) target storage means for storing the fixed locations of said fixed reference target reflectors, (iii) means for deriving from said dead reckoning means and from the stored fixed location of the said fixed reference target reflector an estimated bearing of the said fixed reference target reflector, (iv) bearing comparison means for comparing the detected bearing determined by said target detection system with the estimated bearing derived from said dead reckoning means, and for generating a bearing error, and (v) means for correcting the estimated position and the estimated heading of said vehicle by said dead reckoning means in dependence upon the bearing error determined by said bearing comparison means. - View Dependent Claims (3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13)
-
-
14. A vehicle control and guidance system comprising:
-
(A) a vehicle including (i) motive power means for driving said vehicle having a position and a heading along a path, (ii) steering means for controlling the path of said vehicle, (iii) route data storage means for storing data defining a desired route for said vehicle, (iv) computing means, and (v) dead reckoning means having (a) position transducer means for providing a vehicle displacement signal, (b) heading transducer means for providing a vehicle heading signal, and (c) position and heading estimating means comprised within said computing means, and responsive to said vehicle displacement signal and to said vehicle heading signal, for estimating the position and the heading of said vehicle after each of a series of time increments, the position and the heading of said vehicle after each time increment being estimated from the position and the heading of said vehicle at the beginning of said time increment and in dependence upon the forward and angular velocities of said vehicle during the said time increment; (B) a laser target detection system including (i) a plurality of fixed reference target reflectors having fixed locations, (ii) laser beam scanning means mounted on said vehicle for scanning said target reflectors along a scanning direction, (iii) detection means mounted on said vehicle for detecting laser beam reflections from said target reflectors, (iv) bearing determination means comprised within said computing means for determining a detected bearing of a said target reflector from the scanning direction at the instant of detection of a said laser beam reflection; and (C) said computing means having (i) location storage means for storing the fixed locations of said fixed reference target reflectors, (ii) bearing prediction means for providing a predicted bearing of a said target reflector from said vehicle at the end of a said time increment, said bearing prediction means employing the said estimated position and the heading of said vehicle at the end of said time increment and the fixed location of the said target reflector derived from said location storage means, (iii) bearing error detection means for determining a bearing error between the predicted bearing and the detected bearing determined by said bearing determination means, and (iv) Kalman filter processing means having (a) means for producing correction products, said correction products being products of the said bearing error and Kalman gain factors in respect of coordinates of the vehicle position and the vehicle heading, and (b) means for combining said correction products with the respective estimates of vehicle position and heading provided by said dead reckoning means, the results of the combination being best estimates of the position and the heading of said vehicle; and (D) said computing means including means for comparing said best estimates of the position and the heading of said vehicle with said desired route, and for controlling said steering means accordingly. - View Dependent Claims (15, 16, 17, 18, 19, 20, 21, 22)
-
Specification