System and method for controlling a vehicle traveling along a path

摘要

The present invention provides an unmanned fully autonomous threat representative mobile land target for testing modern weapon systems and training personnel. The invention implements novel navigation and vehicle control algorithms which allow any predefined course to be represented spatially and temporally with continuously and smoothly varying curvatures having no discontinuities of curvature, direction, or acceleration that enable the target vehicle to traverse a predefined course with unprecedented speed, accuracy, and maneuverability without the need for communication with any remotely located station. It is emphasized that this abstract is provided to comply with the rules requiring an abstract that will allow a searcher or other reader to quickly ascertain the subject matter of the technical disclosure. It is submitted with the understanding that it will not be used to interpret or limit the scope of the claims.

主权项

1. A mobile target vehicle traveling along a path, comprising:
a motor vehicle arranged to traverse terrain including an engine, engine throttle system, drive train system, braking system, and steering system; the motor vehicle including actuators arranged to position controls of the braking system, steering system, drive train system, and engine throttle system in response to commands from an onboard vehicle control computer; the motor vehicle including sensors arranged to sense the position of controls for the braking system, steering system, drive train system, and engine throttle system; said sensors arranged to relay the position of controls of the braking system, steering system, drive train system, and engine throttle system to said vehicle control computer; a navigation computer disposed onboard the motor vehicle; a global positioning system receiver disposed onboard the motor vehicle arranged to provide motor vehicle position information to said navigation computer; information representative of a recorded predefined path, wherein said recorded predefined path is a previously driven manually operated traverse of the motor vehicle over the desired vehicle ground path, wherein said information is a plurality of data points based upon specific GPS coordinates stored in said navigation computer as enhanced waypoints derived from continuously and smoothly varying curvatures of a simultaneous two-segment piecewise least-squares fit of a clothoid spiral form having no discontinuities of curvature or direction; wherein said information representative of a recorded predefined path is matched by calculating time of arrival and path length at each point in said plurality of data points along said simultaneous two-segment piecewise least-squares fit of said clothoid spiral form, said least-squares fit having corresponding path length, velocity, and acceleration information at any given time, wherein said time of arrival and said velocity information is used to match the velocity profile and maintain synchronization of the motor vehicle along said predefined path; said navigation computer operably linked with said vehicle control computer; said navigation computer operative upon said stored information representative of a recorded predefined path and said motor vehicle position information to determine and to send to said vehicle control computer the actuator commands necessary to cause the motor vehicle to follow said predefined path; and said vehicle control computer arranged to cause execution by the actuators of the commands sent from the navigation computer to cause the motor vehicle to follow said recorded predefined path.