Vehicle navigation control system
First Claim
1. A navigation control system for a vehicle with the navigation control system having a pair of cameras mounted on said vehicle for taking an image of an outside circumstance and for transmitting an image signal, a vehicle speed sensor mounted on said vehicle for detecting a vehicle speed and for generating a vehicle speed signal, and a steering angle sensor mounted on a steering column in said vehicle for sensing a steering angle and for producing a steering angle signal, said system further comprising:
- distance calculating means responsive to said image signal for calculating a running distance from the vehicle and for producing a corresponding distance signal;
primary error width calculating means responsive to a distance signal from said distance calculating means for calculating a primary near-distance error width between a forwardly extending line in front of said vehicle and a target path located in a running direction of said vehicle within a calculated near running distance and for generating a primary near-distance error width signal;
said primary error width calculating means also being responsive to a distance signal from said distance calculating means for calculating a primary far-distance error width between said forwardly extending line in front of said vehicle and said target path located in said running direction of said vehicle within a calculated far running distance and for generating a primary far-distance error width signal;
secondary error width calculating means responsive to said vehicle speed signal, said steering angle signal and a distance signal from said distance calculating means for calculating a predicted path and a secondary near-distance error width between said predicted path and said target path located in said running direction of said vehicle within a calculated near running distance and for generating a secondary near-distance error width signal;
said secondary error width calculating means further being for calculating a secondary far-distance error width between said predicted path and said target path located in said running direction of said vehicle within a far running distance calculated by said distance calculating means and for generating a secondary far-distance error width signal;
steering angle formula selecting means responsive to said primary and secondary near-distance error width signals and said primary and secondary far-distance error width signals for selecting a desired model steering angle formula and for transmitting a select signal; and
steering angle determining means responsive to said primary and secondary near-distance error width signals, said primary and secondary far-distance error width signals and said select signal for deciding on an optimum steering angle for accurately and rapidly following said target path.
1 Assignment
0 Petitions
Accused Products
Abstract
A vehicle navigation control system has primary prediction error width calculating means for calculating a primary near-distance error width between a forward extending line of the vehicle and a target path at a predetermined near-distance observing location and for calculating a primary far-distance error width between the forward extending line and the target path at a predetermined far-distance observing location. A secondary near-distance error width between a predicted path and the target path at the predetermined near-distance observing location, and a secondary far-distance error width between the predicted path and the target path at the predetermined far-distance observing location, are calculated by a secondary prediction error width calculation means. Steering angle calculating formula selecting means determines whether the target path is a straight path or a curved path with a large curvature, a constantly curved path, or other curved path in accordance with the error widths calculated by the primary and secondary prediction error width calculating means and selects an optimum formula from predetermined model formulas. Steering angle determining means substitutes the corresponding error widths into the selected model formula so as to determine a steering angle.
-
Citations
6 Claims
-
1. A navigation control system for a vehicle with the navigation control system having a pair of cameras mounted on said vehicle for taking an image of an outside circumstance and for transmitting an image signal, a vehicle speed sensor mounted on said vehicle for detecting a vehicle speed and for generating a vehicle speed signal, and a steering angle sensor mounted on a steering column in said vehicle for sensing a steering angle and for producing a steering angle signal, said system further comprising:
-
distance calculating means responsive to said image signal for calculating a running distance from the vehicle and for producing a corresponding distance signal; primary error width calculating means responsive to a distance signal from said distance calculating means for calculating a primary near-distance error width between a forwardly extending line in front of said vehicle and a target path located in a running direction of said vehicle within a calculated near running distance and for generating a primary near-distance error width signal; said primary error width calculating means also being responsive to a distance signal from said distance calculating means for calculating a primary far-distance error width between said forwardly extending line in front of said vehicle and said target path located in said running direction of said vehicle within a calculated far running distance and for generating a primary far-distance error width signal; secondary error width calculating means responsive to said vehicle speed signal, said steering angle signal and a distance signal from said distance calculating means for calculating a predicted path and a secondary near-distance error width between said predicted path and said target path located in said running direction of said vehicle within a calculated near running distance and for generating a secondary near-distance error width signal; said secondary error width calculating means further being for calculating a secondary far-distance error width between said predicted path and said target path located in said running direction of said vehicle within a far running distance calculated by said distance calculating means and for generating a secondary far-distance error width signal; steering angle formula selecting means responsive to said primary and secondary near-distance error width signals and said primary and secondary far-distance error width signals for selecting a desired model steering angle formula and for transmitting a select signal; and steering angle determining means responsive to said primary and secondary near-distance error width signals, said primary and secondary far-distance error width signals and said select signal for deciding on an optimum steering angle for accurately and rapidly following said target path. - View Dependent Claims (2, 3, 4, 5, 6)
-
Specification