Surface vehicle vertical trajectory planning
View Patent ↗An active suspension system for a vehicle including elements for developing and executing a trajectory plan responsive to the path on which the vehicle is traveling. The system may include a location system for locating the vehicle, and a system for retrieving a road profile corresponding to the vehicle location.
1. A method for improving accuracy of vehicle position determination, comprising:
determining an initial vehicle position estimate based on GPS data,
recording a sequence of sensor data from a sensor located with the vehicle, and
refining the initial vehicle position estimate by performing pattern matching with a pattern matching system that looks for the presence of a known sequence of data in the recorded sequence of sensor data
wherein the pattern matching system multiplies a sequence consisting of n numbers obtained from the known sequence of data by a corresponding sequence of n numbers obtained from the recorded sequence of sensor data, sums the results of the n multiplications, and determines when the sequences match by identifying when the sum of the n multiplications has a peak.
2. The method for improving accuracy of claim 1 wherein the sensor data is Z axis deflection data.
3. The method for improving accuracy of claim 1 further comprising using a dead reckoning system to provide additional information on vehicle speed and direction when GPS data is difficult to obtain.
4. The method for improving accuracy of claim 3 wherein the dead reckoning system counts wheel rotations of the vehicle.
5. The method for improving accuracy of claim 3 wherein the dead reckoning system tracks steering angle changes of the vehicle.
6. The method for improving accuracy of claim 1 wherein the pattern matching system performs continuous pattern matching.
7. The method for improving accuracy of claim 1 wherein the pattern matching system matches consecutive groups of n multiplications.
8. The method for improving accuracy of claim 1 wherein the known sequence of data and the recorded sequence of data are transformed into the spatial domain prior to performing the pattern matching by the pattern matching system.