The present invention relates to an inertial navigational guidance system for a driverless vehicle and, more particularly, to a system for utilizing laser obstacle sensor data to update the navigational system without the use of secondary devices along the path of the driverless vehicle.
Inertial guidance systems for guiding a driverless vehicle are well known, and have many advantages in specific applications, but generally require an absolute position update to be entered into the navigational system to correct for errors which may result from tire slippage, skewing or floor deviations. Absolute position indicators are commonly disposed along the vehicle guide path to provide periodic absolute position updates to the vehicle guidance system thereby increasing guidance accuracy and ensuring proper positioning of the vehicle. The floor-disposed position indicators provide the vehicle guidance system with the position of the vehicle in an absolute coordinate system. Such position indicators and the corresponding readers are expensive, require labor-intensive installation, and require detailed surveying of their positions once installed. Further, such position indicators are subject to the workplace environment which may diminish their accuracy. Still further, permanent or fixed markers reduce the flexibility of the driverless vehicle, restricting the ability of the vehicle to be programmed for a variety of paths or different facilities without increased cost for additional position indicators to be installed.
The present invention, referred to as an independent navigational control system with positional correction, includes an inertial guidance system in communication with one or more laser obstacle sensors. The laser obstacle sensors periodically relay positional information with respect to a fixed object, which is utilized in the systems navigational correction routines. In this manner, the system uses the laser-derived positional data to correct errors in the inertial guidance positioning during the travel of the driverless vehicle along the vehicle guide path.
The present invention provides many advantages and benefits. Since many driverless vehicles or automatically guided vehicles (AGVs) have laser obstacle sensors (collision or obstacle avoidance systems) to detect potential collisions, the system is relatively inexpensive and, thus, is an appropriate addition to lower cost driverless vehicles or carts. The system is flexible allowing, in a simple and low cost manner, for the use of a driverless vehicle in a plurality of settings or over a variety of vehicle guide paths, or for the reprogramming or reuse of the vehicle or modification of the vehicle guide path. Further, the system provides improved accuracy by reducing positional drift often occurring in inertial guidance systems.
Further scope of applicability of the present invention will become apparent from the following detailed description, claims, and drawings. However, it should be understood that the detailed description and specific examples, while indicating preferred embodiments of the invention, are given by way of illustration only, since various changes and modifications within the spirit and scope of the invention will become apparent to those skilled in the art.
The present invention will become more fully understood from the detailed description given here below, the appended claims, and the accompanying drawings in which:
The navigational control system 10 of the present invention includes a laser obstacle sensor 16 mounted to the driverless vehicle 12. The laser obstacle sensor 16 is selectively positioned on the driverless vehicle 12 so as to detect or “read” objects near or in proximity to the vehicle guide path 14 such as overhead stanchions 18, walls 24, conveyor 22, or other structure proximate to the guide path. The system creates a map of the position of the objects along the guide path, which can be used as checkpoints in repeated trips along the path. The navigational control system 10 of the present invention utilizes data from the laser obstacle sensor 16 to provide absolute positioning updates that are used by the guidance system to determine and correct any error in vehicle movement relative to the guide path 14. Laser obstacle sensors, such as “PLS Laser Bumpers™” available from Sick Inc, are well known in the art. Other optical sensors could be utilized within the scope of this invention.
Obstacle sensors are utilized as a failsafe in industrial inertial guidance systems; should the inertial guidance system fail for some reason, the optical sensor will detect an object in proximity to the vehicle, and provide alert of an impending impact. Many systems will also provide a drive override to prevent the vehicle from continuing in the direction of a proximate object.
The present invention also utilizes the obstacle sensing devices to provide relative positional information, such as distance to an object. Again, optical sensing devices to provide positional information are known in the art, and are available from sensor suppliers such as Sick, Inc. However, such sensors are typically utilized as the primary positional navigation system, such as for locating a robot arm or identifying when a work piece is in position.
By sampling the positional data, the control system 10 may compare the change in position between sampling points expected by the inertial guidance system to the relative change in position compared to the object sampled. A single laser obstacle sensor 16 is all that is required to gather data regarding the position of the vehicle relative to objects along the guide path. By using multiple laser obstacle sensors 16, the system may utilize multiple samples relative to a single object, thus allowing triangulation for a more precise positional determination. Further, it is anticipated that the sensors be positioned to acquire data regardless of the direction of travel. It is known to utilize multiple laser obstacle sensors 16 located around the perimeter of the vehicle to avoid collisions in all directions of vehicle movement. It is preferred that at least a pair of sensors be located toward each end of the vehicle, each pair separated toward each side of the vehicle, to allow for relative positioning as the vehicle approaches objects in forward or reverse travel.
In operation, the vehicle 12 moves along the guide path 14 under the guidance of the vehicle guidance system 10. When the vehicle is in readable proximity to an object, the laser obstacle sensor 16 measures a reference distance to the object at a given interval, and measures the distance again at additional selected intervals. By comparing the selected path and the relative distances from the fixed object at the specific intervals, the positional accuracy of the inertial guidance system can be verified. In particular, data regarding position with respect to multiple objects can be analyzed, also giving sufficient data for triangulation. For example,
The foregoing discussion discloses and describes an exemplary embodiment of the present invention. One skilled in the art will readily recognize from such discussion, and from the accompanying drawings and claims that various changes, modifications and variations can be made therein without departing from the true spirit and fair scope of the invention as defined by the following claims.