Load alignment aid

Abstract

A load alignment aid with range finding sensors positioned diagonally on a mounting platform to calculate range, vertical alignment, and horizontal alignment. Each sensor measures a distance (d) from the mounting platform to the load. Where d(1) does not equal d(2) and d(1) does not equal d(3), a misalignment due to tilt or chassis misalignment is detected. The aid further includes a display which may show a graphic representation of the approach to a load and an alert for misalignment notification.

Claims

1. A dynamic range display system for a lift truck, the system comprising: a. A sensing unit, positioned on a vehicle in an orientation where the sensing unit is capable of determining the differences in distance to a load in both the horizontal and vertical axis, where the sensing unit is a single range sensor capable of generating a 3D representation of an object of interest in the field ahead of the vehicle; b. A controller using the sensing unit input to determine a) the distance to the object of interest and b) the horizontal and c) vertical spatial alignment of the vehicle axis and an object of interest; and c. A displayer configured to use the controller output wherein the image on the display, representing the object of interest, varies based on a distance and alignment between the sensing unit and the object of interest and generates a dynamic center target that enhances the operator's ability to interoperate the distance and alignment values; wherein the image is generated using an image matrix which is a homography matrix or an epipolar matrix; and wherein the image matrix is generated using a calibration procedure, and where, in the calibration procedure, F is a rank 2 homogeneous matrix with 7 degrees of freedom; further including a point correspondence such that if x and x′ are corresponding image points, then x′.sup.TFx=0; further including epipolar lines where I′=Fx is an epipolar line corresponding to x and I=F.sup.T>x′ is an epipolar line corresponding to x′; further including an epipoles where Fe=0 and F.sup.T>e′=0; and wherein computation from general sensors with matrices P,P′: f=[e′] x P′P, where P* is the pseudo-inverse of P, and e′=P′C, with PC=0.

2. The system of claim 1, further comprising an alarm, the alarm alerting when the distance or alignment between the truck and the object of interest is greater than a predetermined variance.

3. The system of claim 1, further characterized by the display of a concentric target ring which is concentric with the center target representing the relative distance between the vehicle, the object of interest and other predetermined distances.

4. The system of claim 1, further characterized by the controller overlaying the dynamic center target over an image detected by a camera.

5. The system of claim 1, further comprising a transmitter for transmitting misalignment information to a truck controller.

Description

BRIEF DESCRIPTION OF THE SEVERAL VIEWS OF THE DRAWINGS

(1) FIG. 1 is a top view showing an embodiment of lines of sight of lateral alignment and range beams.

(2) FIG. 2 is a side view showing an embodiment lines of sight of vertical alignment beams.

(3) FIG. 3 is a planar view of an embodiment of the display.

(4) FIG. 4 is a flow chart of the load alignment function.

DETAILED DESCRIPTION OF THE INVENTION

(5) In one embodiment, three range finding sensors are positioned diagonally on a mounting platform to calculate three values including range, vertical and horizontal alignment. Each sensor measures a distance (d) from the mounting platform to the load. Where d(1) does not equal d(2) and d(1) does not equal d(3), a misalignment is detected. Misalignment information may include at least one of d(1), d(2), d(3), predetermined distances, and differences between d(1), d(2), d(3), and predetermined distances. Stated otherwise, misalignment due to tilt in either a forward or backward direction and further due to truck chassis alignment to the load is detected by a small difference in distance. The average distance between d(1) and d(3) is equal to the range or distance to the load.

(6) As seen in FIG. 1, d(1) (represented by 105) is not equal to d(3) (represented by 106) measured by sensors 103 and 104 respectively from the mounting platform 102 to a side load 101. This indicates that the load is not laterally aligned in a known orientation to the lift truck.

(7) As seen in FIG. 2, d(1) (represented by 202) is not equal to d(2) (represented by 203) measured by sensors 204 and 205 respectively from the mounting platform 102 to the top of a load 201, this indicates that the load is tilted in a known orientation as it relates to the lift truck.

(8) As seen in FIG. 3, the range to and orientation of the load is seen by the operator as the status circle 303. Misalignment is represented on a display 301 where a graph 306 shows both the target 302, the concentric circles 307 illustrate predetermined distances to the target, and of the present alignment. A user adjusts the approach toward the load to align with the target, where X-axis is the lateral alignment register and the Y-axis is the vertical alignment indicator. An optional video display 304 may show a real time view of the approach to the load. An optional vertical position display 305 may show the vertical lift of the load.

(9) As seen in FIG. 4, the load alignment aid may alarm if the load fails to align within set distance, set tilt, and set lateral alignment. The concentric rings 307 may be set to correspond to set distances from the target 302, while the present alignment shown on the X/Y graph 306 of the load represents Dh (left to right) and Dv (top to bottom) range values from the mounting platform to the load.

(10) In one embodiment, a 3D laser sensors is mounted on a mounting platform. The laser sensor may have fields of interest that act like individual sensors, for an all in one sensor, or may optionally use multiple sensors. For field of interest sensors, IFM lidar sensors are suitable and provide a more cost effective system. In this example, the each of the three sensors or single 3D sensor detects a distance (d) between the mounting platform and the target load. These distances are plotted on the graph 306, which may be an X/Y graph. The display indicates the alignment of the load compared to the target center. The labels on the graph 306 provide easy reference to the operator while enhancing, by way of the display, the understanding of what adjustments should be made to the approach to the load.

(11) Apart from visual representation of alignment, a disparity in d(1), d(2) and d(3) measurements or a threshold of an assigned value for the disparity may cause a variable audible signal or alarm to be played to provide further indication to the operator of the discrepancy between the current position and the target center. In another embodiment, if the truck is an automatically guided vehicle (AGV), this disparity may be communicated to an AGV controller of the truck to permit the controller to make adjustments to the approach. These adjustments may be full automatic or partially automatic and partially manual.

(12) As seen in FIG. 3, other information can be displayed in conjunction with the graph 306 to aid the operator. These additional displays may include camera output, which may aid in load identification or in preventing load damage. The display may include an indicator of the height of the bottom of the clamp. Optionally, the display may include a height indication to identify load height separation points or rack heights preset or as determined by a vision system or line detection system. The display may include buttons for activation of various features such as a laser line indicator, video recording, load illumination, scanner activation or other features that are switched on or off. The display may include a data log or other features.

(13) In another example, a dynamic alignment display system for a lift truck is provided, the system comprising a display configured to provide a visual image; and a controller configured to receive a first signal from the sensor(s) and generating an image on the display representing a dynamic center target, the controller overlaying the dynamic center target over the image detected by the camera; wherein the image varies based on a distance between the mounting platform and the load. This facilitates display of a representation of the lift truck, the target end point, and guide lines or arrows for the driver to follow to reach the end point.

(14) The display of a concentric target rings may accompany the display of the center target, so the operator may gage how the operator's adjustments bring the load more closely to a center target alignment.

(15) The X/Y graphic may utilize an image as generated using a homography matrix calibrated for any parallax or similar distortion.

(16) In one embodiment, the disclosure provides for a dynamic range display system for a lift truck, the system comprising a sensing unit, positioned on a vehicle in an orientation where the sensing unit is capable of determining the differences in distance to a load in both the horizontal and vertical axis, where the sensing unit is a set of at least two sensors or a single range sensor capable of generating a 3D representation of an object of interest in the field ahead of the vehicle; a controller using the sensing unit input to determine a) the distance to the object of interest and b) the horizontal and c) vertical spatial alignment of the vehicle axis and an object of interest; and a display configured to use the controller output wherein the image on the display, representing the object of interest, varies based on a distance and alignment between the sensing unit and the object of interest and generates a dynamic center target that enhances the operators ability to interoperate the distance and alignment values.

(17) The embodiment may include an alarm to alerting when the distance or alignment between the truck and the object of interest is greater than a predetermined variance. Optionally, the embodiment may also include a display of a concentric target ring which is concentric with the center target representing the relative distance between the vehicle, the object of interest and other predetermined distances. These options help the use to focus on movement towards the object of interest.

(18) The display 301 may show 3D image (not shown), which may aid in addressing rotational misalignment. In one embodiment, this 3D image may be generated using a homography matrix or epipolar geometry, optionally generated by using a calibration procedure. In the epipolar configuration, for example:

(19) F is a rank 2 homogeneous matrix with 7 degrees of freedom.

(20) Point correspondence: If x and x′ are corresponding image points, then x′.sup.TFx=0.

(21) Epipolar lines:

(22) I′=Fx is the epipolar line corresponding to x.

(23) I=F.sup.T>x′ is the epipolar line corresponding to x′.

(24) Epipoles:

(25) Fe=0.

(26) F.sup.T>e′=0.

(27) Computation from general sensors with matrices P,P′:

(28) F=[e′]×P′P+, where P.sup.+ is the pseudo-inverse of P, and e′=P′C, with PC=0.

(29) The display 301 may also permit overlaying an image of the dynamic center target over an image detected by a camera.

(30) Another embodiment is a method of assisting an operator of a truck in determining an alignment between the truck and a load, the method comprising: displaying an image representative of a present position of the load; detecting a present position of the load; overlaying a present center target on the displayed image; and adjusting the displayed image based on the dynamic position of the truck relative to the load. Optionally the method may include transmitting the dynamic position of the truck relative to the load to an automatic guided vehicle controller.

(31) A further embodiment of this method includes providing a display to correlate distance measurements from a distance sensor unit to a load, said display providing a graphic overlay super-imposed on a main image to provides visual steering assistance, said graphic overlay including an alignment lines having a vertical alignment and horizontal alignment which are determined by a distance sensing unit; providing vehicle dynamic modeling for identifying the motion of the lift truck as the lift truck moves; predicting a path of the lift truck as it is being steered relative to a target; and providing a human-machine interface (HMI) which allows a user to set preferences for display and for distance sensor unit.

(32) The terms and expressions which have been employed in the foregoing specification are used therein as terms of description and not of limitation, and there is no intention in the use of such terms and expressions of excluding equivalents of the features shown and described or portions thereof, it being recognized that the scope of the invention is defined and limited only by the claims which follow.