BACKGROUND OF THE INVENTION
1. Field of the Invention
This invention relates to a method and apparatus in practical use, thereof, for detecting the traveling position and/or direction of an unmanned vehicle traveling by means of an autonomous guidance system.
2. Description of the Prior Art
An unmanned vehicle automatically travelling on a plant floor without using a railed track has recently been developed and put into practical use. The well-known method for controlling the travel of the unmanned vehicle, utilizes as the guiding information an electromagnetic wave generated by a current flowing in a wire provided under the floor. Such controlling method, however, needs great expense for the wire burying work and is difficult to carry out maintenance and inspection and moreover not easy to change the course on which the vehicle travels. There is an autonomous guidance method as a countermeasure for the above defects, which mounts on the vehicle an arithmetic unit which accumulates and computes pulses corresponding to the number of rotations of right and left wheels, the vehicle being set at a start point on the course on which the vehicle is to travel, sequentially counting the pulse number simultaneously with a start of the vehicle, detecting the position and direction of the vehicle, and guiding the vehicle to travel accurately along the predetermined course, thereby correcting at the fixed points on the way of the course the position and direction of the vehicle to eliminate the cumulative errors.
The method for controlling the travel of unmanned vehicle by use of the aforesaid autonomous guidance method is that intensities of magnetic fields of magnets disposed at the fixed points on the travel course for the vehicle are detected by a plurality of magnetism detection elements being disposed in the transverse direction of the vehicle, and the travelling position and/or direction of the same when passing the fixed points are computed separately on the basis of an output of each magnetism detection element, thereby correcting the detected traveling position and/or direction in accordance with the computed values (the Japanese Patent Laid-Open No. 58-11030).
The above conventional method, however, disposes each magnet at each fixed point spaced at a predetermined interval along the traveling course, whereby the traveling position and/or direction cannot be detected until the vehicle having passed on the two magnets. Hence, a time delay occurs, thereby creating the problem in that the non-linear travel of the vehicle within the time-delay causes an error.
SUMMARY OF THE INVENTION
In the light of the above-mentioned problem, the present invention has been designed. A first object thereof is to provide a method and apparatus for detecting the traveling position and/or direction of a vehicle, which dispose a pair or pairs of marks at the fixed points in the direction of intersecting the guiding direction of the travel course and provide the unmanned vehicle with sensors each detecting the transversely relative position of the mark to the vehicle, so that each sensor detects, the marks, thereby enabling the traveling position and/or direction of the vehicle to be instantaneously detected and mixing of error to be considerably reduced.
A second object of the present invention is to provide a method and apparatus which simply and rapidly compute the traveling position and/or direction of the vehicle.
The above and further objects and features of the invention will more fully be apparent from the following detailed description with accompanying drawings.
BRIEF DESCRIPTION OF THE DRAWINGS
FIG. l is a schematic view of an embodiment of an unmanned vehicle of the invention and marks thereof,
FIG. 2 is a block diagram of a steering control system of the unmanned vehicle,
FIGS. 3-(a) and -(b) are views explanatory of the relation between the magnets and the hall elements at magnetic sensors,
FIG. 4 is a view explanatory of a method, for computing the traveling position and/or direction of the unmanned vehicle, and
FIG. 5 is a flow chart of computation of the traveling position and/or direction and of steering control of the same.
DETAILED DESCRIPTION OF THE INVENTION
Next, the present invention will concretely be described in accordance with the drawing showing an embodiment of the invention. In addition, in the following embodiment, magnets are used as the marks and magnetic sensor are used as the sensors, or alternatively different kinds of marks and sensors, for example, optical marks and optical sensors may be used.
FIG. 1 is a schematic view exemplary of the relation between the magnets as the marks disposed at the fixed points on the course on which the unmanned vehicle of the invention is to travel and the magnetic sensors provided at the vehicle, in which reference letter F designates a floor, Ml and Mr designate permanent magnets, and reference numeral 1 designates the unmanned vehicle (hereinafter to be called only the vehicle), the magnets Ml and Mr each comprising a cylindrical permanent magnet (or electromagnets may also be used) and being disposed at one end face to be level with the floor surface. Also, a pair or pairs of the magnets Ml and Mr are disposed at each fixed points of the already-known coordinate with respect to the origin O of the absolute coordinate system X-Y and perpendicularly to the traveling direction of the vehicle on the course and spaced at the predetermined interval B(or B/2 with respect to the center line of the course). The vehicle 1 is provided at the longitudinally central portion thereof with driving wheels 1l and 1r controllable independently by separate motors 2l and 2r and at the transversely central portions of front and rear of the vehicle with casters 1f and 1b respectively. The numbers of rotations of the driving wheels 1l and 1r are detected by counting the pulses from pulse generators 3l and 3r attached to the driving wheels 1l and lr respectively, the traveling position and/or direction of the vehicle 1 are sequentially computed, and both the driving wheels 1l and 1r are adapted to be rotatably driven relative by to each other so that the vehicle 1 travels along the course decided by the travel schedule. The vehicle 1 is provided at the longitudinally central portion of the lower wall and at both the lateral sides with a plurality (in the embodiment, five at one lateral side) of hall elements S1 S2. . . S5 as the magnetism detection elements which are disposed being spaced at the predetermined intervals in the transverse direction, in other words, in the direction of width, perpendicular to the traveling direction of the vehicle, thereby forming a pair of magnetic sensors Sl and Sr, the inner ends of both the magnetic sensors Sl and Sr being spaced by A/2 respectively from the center line of width as shown in FIG. 4.
FIG. 2 shows a steering control system of the vehicle 1, in which the outputs from the magnetic sensors Sl, Sr and pulse generators 3l, 3r are introduced into a controller 5, where the outputs of magnetic sensors Sl and Sr are introduced therein through an analog/digital converter (not shown). The controller 5 detects the traveling position and/or direction of the vehicle 1 on the basis of the aforesaid outputs and the initial position of the same set by the aforesaid absolute coordinate system X-Y, and outputs the required signal to drive circuits 4l and 4r for the motors 2l and 2r to thereby steer the vehicle 1 to travel along the course decided by the steering schedule, or stops the vehicle 1.
Next, explanation will be given on detection of the traveling position and/or direction of the vehicle, which is the gist of the present invention.
Generally, the hall element has the property such that in a case where a current flows in the hall element in the constant direction, when the magnetic field acts on the same perpendicularly to the current direction, an electromotive force corresponding to the intensity of magnetic field and perpendicular to both the current flowing direction and the direction of magnetic field is generated. Accordingly, it is possible to detect the intensity of magnetic field and the direction of line of magnetic force by detecting magnitude and polarity of generated voltage.
FIG. 3-(a) is a schematic view showing the relation of position between the hall elements S1 to S5 constituting the magnetic sensor Sl at one side of the vehicle 1 and the magnet Ml, FIG. 3-(b) is a graph showing output voltage of the respective hall elements to S1 to S5. As shown in FIG. 3-(a), at the instant that the central hall element S3 among the hall elements S1 to S5 constituting the left side magnetic sensor Sl passes just above the magnet Ml, the hall elements S1 to S5 are positioned in the magnetic field of magnet Ml and subjected to the rightward or leftward magnetic force corresponding to the distance of the respective hall elements S1 to S5 from the magnet Ml. As a result, the output voltage of the respective hall elements S3 to S5 as shown in FIG. 3-(b) develops the maximum value at the hall element S4 and decreases toward the hall element S5 and the output voltage of the respective hall elements S1 to S3 indicates at the hall elements S2 the maximum value reverse to that of hall element S4, and then decreases toward the hall element S1. Hence, the hall element opposite to the magnet Ml is specified, and the magnet Mr is identified with the above. The controller 5 periodically reads the output from the magnetic sensors Sl and Sr, so that at the time when any hall element has the maximum voltage value, the hall element opposite to or close to the magnet Ml or Mr is specified by use of the relation between the output voltages of magnetic sensors and the positions thereof as shown in FIG. 3. Thus, the widthwise position of the vehicle 1 opposite to the magnetic Ml and Mr is detectable, whereby the controller 5 detects the traveling position and/or direction of the vehicle 1 by the following algorithm on the basis of the detected position of the vehicle.
FIG. 4 is an illustration of a method for obtaining the traveling position and/or direction of the vehicle 1 from the relation between the magnetic sensors Sl, Sr on the vehicle 1 and the magnets Ml, Mr, in which the magnetic sensors Sl and Sr at both lateral sides of the vehicle l traveling in the direction of the unshaded arrow reach the fixed points, the magnetic sensor Sl has passed above the magnetic Ml, and magnetic sensor Sr reaches above the magnet Mr. When an intersection of the magnetic sensor Sr with the magnet Mr is represented by a, a distance Lr from the point a to the inner end of magnetic sensor Sr is obtained from the aforesaid specified hall element. A distance Ll between the position at the sensor Sl opposite to the magnet Ml (designated by b) above which the magnetic sensor Sl having passed and the inner end of magnetic sensor Ll, is similarly obtainable. Also, during the time difference between the time when the magnetic sensors Ll and Sr passes above the magnets Ml and Mr respectively, the number of pulses generated by the pulse generator 3l attached to the left side wheel ll is counted and multiplied by a predetermined conversion coefficient, thereby obtaining a distance L between the point b and the magnet Ml.
Here, when an angle between the course on which said unmanned vehicle is to travel of the vehicle l and the traveling direction thereof is represented by θ, the coordinates of the middle point of the line connecting both the magnets Ml and Mr at the aforesaid absolute coordinate system are represented by (Xn, Yn), the coordinate point (Xn, Yn) is taken as the origin, the axis X is taken in the direction of passing both the magnets Ml and Mr and the axis Y is taken in the steering direction of the vehicle l, and the coordinates of the center P of the vehicle 1 at the coordinate system X-Y are represented by (xp, yp), the coordinates (Xp, Yp) of the center P of the vehicle l in the absolute coordinate system are given in the following equations:
Xp=xp+Xn (1)
Yp=yp+Yn (2)
xp, yp in the equations (1) and (2) are given in the following equations: ##EQU1##
The angle θ between the center line of the travel course and the traveling direction of the vehicle 1, in other words, an azimuth angle θ in the travel thereof, is given in the follow equation: ##EQU2##
Therefore, the coordinates of the center at the vehicle 1 in the absolute coordinate system, in other words, the traveling position of the vehicle, is obtained by substituting into the equations (1) and (2) the coordinates (Xn, Yn) preset in the controller 5 and the equations (3), (4) and (5). In order to coincide the traveling position (Xp, Yp) and azimuth angel 0 computed as above-mentioned with the travel schedule preset in the controller 5, the controller 5 sends separate signals to drive circuits 4l and 4r respectively, thereby steering the vehicle 1. FIG. 5 is a flow chart of a series of computation and steering control as above-mentioned.
In the method of the present invention, when the vehicle 1 passes above the magnets Ml and Mr at the fixed points, the magnetic sensors Sl and Sr specify the widthwise position of the vehicle 1 opposite to the magnets Ml and Mr, whereby the aforesaid distance Ll, Lr and L are instantaneously obtainable on the basis of the detected position of the vehicle 1. Also, the computation is carried out by use of Ll, Lr and L, thereby enabling the traveling position and/or direction of the vehicle 1 in the absolute coordinate system X-Y to be obtained for a short time. Hence, the drive control (or brake control) for the right and left wheels 1l and 1r can correct the travel of vehicle 1 along the travel course.
Especially, the magnets conventionally have been disposed on the travel course longitudinally in the travelling direction at the predetermined intervals, whereby the traveling position and/or direction cannot be detected until the vehicle 1 passes through an interval between both the magnets. While, the method of the present invention disposes the magnets Ml and Mr in parallel to each other and perpendicularly to the traveling direction of the vehicle on the course, and the magnetic sensors Sl and Sr also are disposed at the longitudinally central portions and near both lateral sides of the vehicle 1, so that when the vehicle 1 travels just along the travel course, the relative position of the vehicle 1 and the magnets Ml and Mr are detectable instantaneously, or in an extremely short time even the travelling direction of the vehicle 1 somewhat biased to the travel course. As a result, the mixing of error less occurs to enable accurate correction of the traveling position and/or direction of the vehicle 1.
Alternatively, the magnetic sensors Sl and Sr may be disposed, for example, widthwise of the vehicle; at the front end, the rear end, or a longitudinally intermediate portion of the vehicle 1. Also the magnetic sensors Sl and Sr may of course be disposed longitudinally of the vehicle 1 somewhat near to the front end or to the rear end.
Alteratively, one magnetic sensor instead of two magnetic sensors Sl and Sr may be disposed in a line through the entire width of the vehicle 1.
Especially, when the marks of magnets or the like, as shown in the aforesaid embodiment, are coincident in the arrangement direction with the coordinate axes of the absolute coordinate system, or the sensors are disposed in the onedimensionally extending direction perpendicular to the vehicle, the operational expression becomes simple.
As this invention may be embodied in several forms without departing from the spirit of essential characteristics thereof, the present embodiment is therefore illustrative and not restrictive, since the scope of the invention is defined by the appended claims rather than by the description preceding them, and all changes that fall within meets and bounds of the claims, or equivalence of such meets and bounds thereof are therefore intended to be embraced by the claims.