This invention generally relates to gantry cranes and more particularly relates to a system and method for automatically guiding a gantry crane.
Gantry cranes are generally known for lifting and handling shipping containers and trailers. Such cranes are commonly equipped with wheels and rubber tires for manuvering on an asphalt surface of a shipyard, railyard or other intermodal facility. A mobile crane equipped with rubber tires is commonly referred to as an RTG (rubber tired gantry).
The Global Positioning System (GPS) is widely used for determining positions on the earth. As is known, the GPS includes a plurality of orbiting satellites that send encoded signals. By triangulating the signals of multiple satellites a GPS receiver can determine an XYZ position relative to the earth.
Conventional gantry cranes are manually driven by a human operator who occupies a cab of the crane. It has been desirable to provide a guidance system for a crane that enables the crane to automatically drive to a designated point, for example to the position of a container to be lifted. Although some crane guidance systems are known, including guidance systems that utilize GPS, an improved guidance system is needed to permit accurate automatic steering tracking as the crane travels along a curved path.
The invention provides an automatic guidance system and method for a land traveling vehicle, such as a gantry crane, wherein the method includes steps for determining tracking errors and then adjusting steering angles of the wheels based upon the combination of errors within certain parameters to maintain travel along a desired path within a desired level of accuracy. In an embodiment, for example, a method is provided for guiding a land traveling vehicle from a remote land station, the method including the steps of: defining a tracking line representing a desired travel direction at a current point along a desired land travel path, the tracking line intersecting a vehicle centerpoint; receiving signals from GPS satellites using a first GPS antenna fixed at a first position on the vehicle; receiving signals from GPS satellites using a second GPS antenna fixed at a second position on the vehicle that is spaced from the first GPS antenna in a horizontal direction; detecting a position of the first GPS antenna; detecting a position of the second GPS antenna; calculating a vehicle centerline that extends in a front-rear direction through a center of the vehicle, the vehicle centerline having a fixed relationship relative to vehicle and the first and second GPS antennae; determining a rotational error as an angular difference between the vehicle centerline and the tracking line; determining a front crosstrack error as a distance between the vehicle centerline and the tracking line at a reference distance forward of a front axle line that intersects the rotational axes of the front wheels; determining a rear crosstrack error as a distance between the vehicle centerline and the tracking line at a reference distance forward of a rear axle line that intersects the rotational axes of the rear wheels; determining a center crosstrack error as a distance between the vehicle centerpoint and the tracking line.
Additionally, an embodiment of the method includes steps for steering wheels of the vehicle to minimize the tracking errors and to provide correct steering angles for the steerable wheels of the crane. The crane steering control system correctively maintains proper steering angles of the steerable wheels of the crane during automatic guidance operation of the crane. Advantageously, by maintaining precise steering angles, the steering control system eliminates undesired structural loading of the crane due to actual wheel angle errors. In a closed loop fashion, the steering control system receives feedback from wheel angle sensors and provides output signals to the steering actuators for the steerable wheels. The control system operates to adjust the steerable wheels to respectively desired angles for the steerable wheels on the inside and outside and outside of a turn or curve. Moreover, the control system operates to constantly maintain appropriate inside and outside steerable wheel angles while the steerable wheels move from one set of angles to another as determined by the guidance controller to minimize the tracking error.
In an embodiment, the guidance controller determines the tracking errors FXTE, RXTE, CXTE, and RE. A steering controller applies a steering algorithm to determine the required inside steerable wheel angles as a function of the outside steerable wheel angles to minimize these errors.
An advantage of the present invention is that it provides an improved system and method for automatically guiding a gantry crane.
Another advantage of the present invention is that it provides a system and method for automatically guiding a gantry crane capable of determining both translational and rotational error of a vehicle relative to a desired guide path. As a result, the present invention advantageously provides accurate tracking along a curved path.
A further advantage of the present invention is that it provides a system and method for automatically guiding a gantry crane that allows the crane to travel at a higher rate of speed.
Still another advantage of the present invention is that it provides a system and method for automatically guiding a gantry crane that reduces the travel time between land points, thereby increasing loading efficiency.
These and other advantages of the invention, as well as additional inventive features, will be apparent from the description of the invention provided herein.
Now referring to the Figures, wherein like numerals designate like components, an exemplary straddle-type crane such as gantry crane 10 is shown generally in
Referring to
In an embodiment, the invention may be used on a container-handling vehicle configured for carrying loads such as containers or trailers, and in an embodiment the illustrated crane 10 may be adapted as such a container-handling vehicle. Various mechanisms may be mounted to beams of the crane, such as the stabilizer beams 18, to grip or carry a load to be lifted. For example, in the illustrated embodiment, each of the stabilizer beams 18 supports a trolley 28 adapted to traverse the length of the stabilizer beam. Each of the trolleys 28 is movably mounted to a lower horizontal portion of the elongate portion of the stabilizer beam 18. A grappler 100 is suspended from the trolleys 28 for grasping, latching or otherwise securing an object to be moved, for example a trailer 32 (
To vertically drive the stabilizer beam 18, the crane 10 includes an actuator 20 mounted to the upper support beam 16 as illustrated in
The crane 10 further includes a cab 24 (
According to an aspect of the invention, a control system 300 is provided for automatically guiding the crane. With reference to
As will be explained below, the control system is generally operates to steer the gantry crane 10 utilizing GPS signals from GPS satellites 405, as illustrated in
Each of the GPS receivers 320R, 320L includes a respective GPS antenna mounted to the crane spaced from each other. Preferably, the GPS antennae are mounted at first and second positions of the crane, atop opposite ends the support beam 16 for optimal separation in order to increase positioning precision, as shown in
The GPS receivers 320R, 320L, and 320B (
The control system 300 of
The guidance controller 310 generally coordinates all of the GPS data, calculates various error values, as will be described herein. The control system 300 further includes a steering controller 340 which receives the wheel position signals from steering angle sensors 344A–D, as well as errors signals FXTE, CXTE, RXTE, and CE from the guidance controller. The steering controller 340 determines appropriate steering angles based upon the desired path and error values, and provides control signals for adjusting steering actuators 350A–D. It should be noted that the steering controller 340 would provide control signals to only two steering actuators 350A and 350B in an embodiment wherein the crane 10 is configured for two-wheel steering during a driving mode. In an embodiment wherein the crane is adapted for four-wheel steering during drive mode, the steering controller 340 controls the steering actuators 350C and 350D in addition to actuators 350A and 350B. In an embodiment, the guidance controller 310 can receive input for determining the desired path AB (
The base GPS receiver 320B enables the position of each of the mobile GPS receivers 320R, 320L to be determined with greater precision. The guidance control system 300 is operable to calculate a correction vector representing a difference between a stored, known position of the GPS receiver 320 and the GPS position as currently measured by the GPS receiver 320B. In an embodiment, the guidance controller 310 calculates the correction vector based upon the stored known value in comparison to GPS data from the base GPS receiver 320B as transmitted from radio transceiver 330B to the radio transceiver 330A of the crane 10. In another embodiment, the reference processor 325 calculates the correction vector which is transmitted from the radio transceiver 330B at the base to the radio transceiver 330A of the crane 10 and forwarded to the guidance controller 310. The correction vector represents the difference between the known and measured positions of the base GPS receiver 320B. It is assumed that a similar difference between measured and actual positions currently affects the mobile GPS receivers 320R, 320L, and accordingly, the correction vector is used to adjust the position data as measured by the mobile GPS receivers 320R, 320L for improved precision.
An aspect of the present invention is a method for guiding the crane to travel along a desired path which may be curved as will be described with reference to
Referring to
The desired drive path AB extends from a starting position A to a desired destination position B, as illustrated in
As indicated at step 710 of
A straight path is suitable only in some situations, such as when the crane can perform multiple container handling operations along a straight lane, however, other situations arise wherein the required path is not straight. In a shipping yard, the quickest and/or most efficient drive path may be along a curved path, such as the path AB illustrated in
The path AB is preferably determined in a manner so that the crane 10 avoids obstacles and remains in appropriate driving lanes having appropriate driving surfaces, such as asphalt or concrete pads. In an embodiment, the path AB is automatically generated by an algorithm based upon various input data, such as the current position A and the destination B, and the guidance controller 310 may optionally determine the path in conjunction with predetermined map data containing approved lane boundaries between stacks of containers and obstacles. In an embodiment, the path AB may be determined based upon an input of several plotted points along the desired path. In another embodiment, some or all of the path AB can be programmed by recording GPS positions during manual crane movement on a desired route. The path AB to the destination position AB may include one or more curve.
In an embodiment, the desired path AB may also be determined based upon a starting orientation of the crane 10 and a needed destination orientation. A particular destination orientation may be necessary in order for the crane 10 to straddle over a target container at the destination B and/or to straddle obstacles as necessary to drive to the destination position B. The orientation information for the crane 10 and destination is factored as parameters in determining the path AB. For example, most grapplers 100 must generally be aligned with the object 32, 42 (
Referring back to
Referring to step 725 in
As indicated at step 727 of
As indicated at step 730 of the method of
As indicated at step 732 of
A front crosstrack error FXTE is determined at step 735 of
A rear crosstrack error RXTE is determined at step 740 of
Advantageously, the use of multiple GPS receivers 320R, 320L on the crane 10 permit the calculation of the CL and any or all of the error values RE, CXTE, RXTE and FXTE. The multiple GPS receivers 320R, 320L allow the orientation of the crane to be calculated and thereby enable guidance to maintain steering orientation of the crane along a curved path. By monitoring error values such as CXTE, RXTE and FXTE at multiple points of the crane relative to the desired tracking line TL and path AB, the present invention facilitates highly accurate tracking control.
Preferably, the guidance controller 310, located on board the crane 10, as illustrated in
Also, the controller 310 is programmed with predetermined control parameters, for example, the preferred reference distance RD based upon a particular speed. The controller can determine the current RD based upon an algorithm or a table relating a particular RD value corresponding to the current velocity. The reference distance RD can be any distance appropriate to effect the desired control accuracy. When the control system is used for guiding a gantry crane 10, it has been found that suitable results are achieved when the reference distance RD is about 15 feet when the crane 10 is traveling at maximum speed, which is typically about 4 miles per hour. The reference distance RD decreases proportionally to crane speed, so that the reference distance RD is zero (directly on an axle line between front or rear axles) when the crane is at a minimum speed. Of course, the crane is equipped with appropriate sensors, e.g., speed sensors, to provide necessary signals to the controller as needed.
The values for the errors CXTE, FXTF, and RXTE may be in any appropriate units. For example, in an embodiment, the controller 310 calculates the errors CXTE, FXTE, and RXTE in inches. Moreover, in an embodiment, the error value is negative when the error is left of the centerline CL, and the error value is positive when the error is right of the centerline CL.
It should be noted that the order of steps 730, 732, 735, and 740 is not necessary, and the values RE, CXTE, FXTE, RXTE can be calculated in any order or concurrently. Regardless of order of calculation, when the error values RE, CXTE, FXTE, RXTE, and have been determined at steps 730, 732, 735, and 740, respectively, an appropriate steering correction is calculated based upon parameters including these error values, as indicated at step 745.
In an embodiment, determining of the steering angle correction at step 745 may also consider one or more other parameters, such as velocity, a proximity to a limit of an authorized travel zone, a proximity to an obstacle, or another appropriate parameter. The steering controller applies an appropriate algorithm to the parameters, determining a desired current steering angle of the steerable wheels. The steering algorithm is adapted to the particular steering configuration of the crane, such as front wheel steering, rear wheel steering, or all wheel steering, and includes the crane geometry, such as tracking width TW and wheel. Accordingly, the steering control system is adapted to steer the steerable wheels in the particular two or four wheel steering configuration. Additionally, the steering algorithm accounts for crane geometry, such as tracking width and wheelbase.
In an embodiment, step 745 operates to steer wheels of the vehicle to minimize the tracking errors and to provide correct steering angles for the steerable wheels of the crane. For example, a suitable steering controller is described in U.S. Pat. No. 6,206,127, incorporated herein by reference in its entirety. The crane steering control system correctively maintains proper steering angles of the steerable wheels of the crane during automatic guidance operation of the crane. Advantageously, by maintaining precise steering angles, the steering controller eliminates undesired structural loading of the crane due to actual wheel angle errors. With reference to
By manipulating equation C, the following relationship is established:
Equation D represents the relationship between the outside angle θo and the inside angle θi.
The steering algorithm of the steering controller defines the required steering correction (to steer either to the right or left) from the tracking errors FXTE, RXTE, CXTE, and RE, and determines the required inside angle. In the closed-loop steering system, the proper actuator signal is sent to an actuator to drive the appropriate wheel to the required inside angle. The instantaneous angular position θi of the inside steerable wheel, as measured by its angle sensor, determines the corresponding outside angle θo, that is required from equation D above. A signal indicating steering angle θi of the inside wheel is applied to the relationship of equation D, resulting in a signal that actuates adjustment of the outside steerable wheel to steering angle θo. The instantaneous difference between the inside and outside angles is also measured by the steer control system to maintain a minimum following error. The faster wheel is slowed down to allow the slower wheel to catch up to the required position to maintain an appropriate minimum following error or to eliminate it.
Based on the results of step 745, steering corrections are executed at step 750 by actuating the steering actuators 350A and 350B (
All references, including publications, patent applications, and patents, cited herein are hereby incorporated by reference to the same extent as if each reference were individually and specifically indicated to be incorporated by reference and were set forth in its entirety herein.
The use of the terms “a” and “an” and “the” and similar referents in the context of describing the invention (especially in the context of the following claims) are to be construed to cover both the singular and the plural, unless otherwise indicated herein or clearly contradicted by context. Recitation of ranges of values herein are merely intended to serve as a shorthand method of referring individually to each separate value falling within the range, unless otherwise indicated herein, and each separate value is incorporated into the specification as if it were individually recited herein. All methods described herein can be performed in any suitable order unless otherwise indicated herein or otherwise clearly contradicted by context. The use of any and all examples, or exemplary language (e.g., “such as”) provided herein, is intended merely to better illuminate the invention and does not pose a limitation on the scope of the invention unless otherwise claimed. No language in the specification should be construed as indicating any non-claimed element as essential to the practice of the invention.
Preferred embodiments of this invention are described herein, including the best mode known to the inventors for carrying out the invention. Of course, variations of those preferred embodiments will become apparent to those of ordinary skill in the art upon reading the foregoing description. For example, the invention could be implemented using a position sensing means other than GPS technology, such as a ground based radio position detection system, infrared waves, sonar position sensors, or any appropriate device that is be recognized for use in position detection. The inventors expect skilled artisans to employ such variations as appropriate, and the inventors intend for the invention to be practiced otherwise than as specifically described herein. Accordingly, this invention includes all modifications and equivalents of the subject matter recited in the claims appended hereto as permitted by applicable law. Moreover, any combination of the above-described elements in all possible variations thereof is encompassed by the invention unless otherwise indicated herein or otherwise clearly contradicted by context.
Number | Name | Date | Kind |
---|---|---|---|
4427623 | Howard et al. | Jan 1984 | A |
5144317 | Duddek et al. | Sep 1992 | A |
5512902 | Guthrie et al. | Apr 1996 | A |
5686924 | Trimble et al. | Nov 1997 | A |
5923270 | Sampo et al. | Jul 1999 | A |
6266008 | Huston et al. | Jul 2001 | B1 |
6549835 | Deguchi et al. | Apr 2003 | B1 |
6577921 | Carson | Jun 2003 | B1 |
6668157 | Takeda et al. | Dec 2003 | B1 |
6671600 | Hintzy | Dec 2003 | B1 |
20020046142 | Ishikura | Apr 2002 | A1 |
20020070891 | Houston et al. | Jun 2002 | A1 |
Number | Date | Country |
---|---|---|
0077085 | Apr 1983 | EP |
2001-240372 | Sep 2001 | JP |
9834127 | Aug 1998 | WO |