CA2204857A1 - Guidance system for vehicle - Google Patents
Guidance system for vehicleInfo
- Publication number
- CA2204857A1 CA2204857A1 CA002204857A CA2204857A CA2204857A1 CA 2204857 A1 CA2204857 A1 CA 2204857A1 CA 002204857 A CA002204857 A CA 002204857A CA 2204857 A CA2204857 A CA 2204857A CA 2204857 A1 CA2204857 A1 CA 2204857A1
- Authority
- CA
- Canada
- Prior art keywords
- vehicle
- steering angle
- deviation
- basis
- calculated
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Abandoned
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D1/00—Steering controls, i.e. means for initiating a change of direction of the vehicle
- B62D1/24—Steering controls, i.e. means for initiating a change of direction of the vehicle not vehicle-mounted
- B62D1/28—Steering controls, i.e. means for initiating a change of direction of the vehicle not vehicle-mounted non-mechanical, e.g. following a line or other known markers
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0891—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
Abstract
A system for accurately guiding a vehicle along a predetermined driving course. The deviation of a vehicle position in a direction perpendicular to the course is calculated on the basis of coordinates position data (Xi, Yi) and direction data (i) selected by selection means and the actual coordinates position (X, Y) detected by position detection means. Next, the steering angle of the vehicle is so calculated as to decrease with the increase in the actual speed of the vehicle on the basis of this deviation and the detected speed (V) so that the deviation may become zero. The steering angle of the vehicle is controlled on the basis of the vehicle steering angle, and the vehicle can be accurately guided and driven on the predetermined driving course. Alternatively, the vehicle steering angle is so calculated as to decrease with the increase in the actual speed of the vehicle on the basis of the deviation obtained from deviation calculating means, the deviation obtained from integrating means and the actual speed calculated by speed detection means so that the deviation quantity may become zero.
Description
CA 022048~7 1997-0~-08 DESCRIPTION
GUIDANCE SYSTEM FOR VEHICLE
TECHNICAL FIELD
The present invention relates to a vehicle guidance system for storing position data pertaining to a predetermined driving course, and for guiding the vehicle along the predetermined driving course by controlling the steering angle of the vehicle on the basis of this position data.
BACKGROUND ART
Several systems for guiding vehicles along predetermined driving courses have been developed and submitted for patent application in the past.
Japanese Patent Publications 5-22925 and 5-22926 teach a technique of approximating the driving course by connecting a plurality of straight line segments and guiding the vehicle along these straight line segments.
While the technique taught in these publications has the advantage that calculation of the vehicle steering angle or the like is easy since the vehicle needs only to move forward in a straight line, it has the drawback that, since curved driving course paths are approximated by straight lines, the vehicle does not follow the predetermined driving course in an exact manner.
Further, the technique taught in the aforementioned -CA 022048~7 1997-0~-08 publications sets the vehicle steering angle without regard for current vehicle speed.
Thus, when the vehicle is traveling at high speed, the steering angle can be too great, creating the possibility of oversteering and, in some cases, causing the vehicle to deviate from the curved driving course.
Conversely, when the vehicle is traveling at low speed, the steering angle can be too small, creating the possibility of understeering and, in some cases, causing the vehicle to deviate from the curved driving course.
Further, in the technique taught in the aforementioned publications, the steering angle when the vehicle follows a straight-line course without deviation is set to zero for reasons pertaining to the steering angle calculation process.
However, in the case of a vehicle such as a dump truck, the alignment of the four wheels of the vehicle can change depending on the load and load distribution.
When the alignment changes, continuing to move with the steering angle set at zero can cause the vehicle to deviate from a straight-line course. This presents significant practical problems.
Japanese Patent Publication 5-503775 teaches calculating the steering angle by plotting from the current position a smoothly linked path, expressed by a polynomial of degree 5, over the driving course and guiding the vehicle along this path.
While the technique taught in this publication does CA 022048~7 1997-0~-08 take into account travel over a curved driving course, the calculations are quite complex and time-consuming.
Like the aforementioned Japanese Patent Publications 5-22925 and 5-22926, the technique taught in the aforementioned publication sets the vehicle steering angle without regard for current vehicle speed. This gives rise to the possibility of deviation from a curved driving course.
Also, like the aforementioned Japanese Patent Publications 5-22925 and 5-22926, the steering angle when the vehicle follows a straight-line course without deviation is set to zero, so if there is not perfect alignment between the front and rear wheels of the vehicle, it becomes extremely difficult to prevent the vehicle from traveling along the straight-line course without deviation.
Thus, conventional techniques have the drawback of being incapable of affording travel in an exact manner over a curved driving course by means of a simple process.
They also have the problem of deviation from a curved driving course depending on vehicle speed.
A further problem is that changes in vehicle alignment can result in deviation from the predetermined course, even when the driving course is straight course.
DISCLOSURE OF THE INVENTION
It is an object of the present invention to provide CA 022048~7 1997-0~-08 a system that can overcome these problems.
The first invention of this invention is intended to accurately guide the vehicle over a curved driving course by means of a simple process, and to prevent the vehicle from deviating from a curved driving course regardless of vehicle speed.
These objects are achieved through a vehicle guidance system for storing position data pertaining to a predetermined driving course and for guiding the vehicle along the predetermined driving course by controlling the steering angle of the vehicle on the basis of this position data, comprising memory means for storing, for each point on the aforementioned predetermined driving course, data indicating the coordinate position for the point in question and the direction in which the vehicle should advance, position detection means for detecting the current coordinate position of the vehicle, speed detection means for detecting the current speed of the vehicle, selection means for selecting from the memory contents of the memory means coordinate position data for the point on the predetermined driving course that is closest to the current coordinate position detected by the position detection means and direction of advance data for this closest point, deviation calculation means for calculating the current deviation of vehicle position in the direction perpendicular to the direction of vehiclè advance on the basis of the coordinate position data and direction of advance data selected by the CA 022048~7 1997-0~-08 selection means and the current coordinate position detected by the position detection means, steering angle calculation means for calculating the vehicle steering angle so as to decrease with increased detected travel speed on the basis of the deviation calculated by the deviation calculation means and the current speed detected by the speed detection means in order to reduce deviation to zero, and control means for controlling the steering angle of the vehicle on the basis of the vehicle steering angle calculated by the steering angle calculation means.
In addition to the objects of the first invention stated above, it is a further object of the second invention of this invention to compensate for and cancel out changes in vehicle alignment in order to accurately guide the vehicle over a predetermined driving course.
This object is achieved by further providing the structure of the first invention with integration operation means for performing integration operations on the deviation calculated by the deviation calculation means, and by configuring the steering angle calculation means to calculate the vehicle steering angle so as to decrease with increased detected travel speed on the basis of the deviation calculated by the deviation calculation means, the integral calculated by the integration operation means, and the current speed detected by the speed detection means in order to reduce the deviation to zero.
CA 022048~7 1997-0~-08 In addition to the objects of the first invention stated above, it is a further object of the third invention of this invention to accurately guide the vehicle over a course whose radius of curvature varies in complex fashion.
This object is achieved by further providing the structure of the first invention with integration operation means for performing integration operations on the deviation calculated by the deviation calculation means, by replacing the steering angle calculation means with first steering angle calculation means for calculating a first vehicle steering angle so as to decrease with increased detected travel speed on the basis of the deviation calculated by the deviation calculation means, the integral calculated by the integration operation means in order to reduce the deviation to zero, and the current speed detected by the speed detection means, second steering angle calculation means for calculating a second vehicle steering angle on the basis of the radius of curvature of the predetermined course at the closest point, and third steering angle calculation means for calculating a third vehicle steering angle on the basis of the first vehicle steering angle calculated by the first steering angle calculation means and the second vehicle steering angle calculated by the second steering angle calculation means, and by employing as the control means control means that controls steering angle of the vehicle on the basis of CA 022048~7 1997-0~-08 the third vehicle steering angle calculated by the third steering angle calculation means.
In accordance with the first invention, the current deviation of vehicle position in the direction perpendicular to the direction of vehicle advance is calculated on the basis of the coordinate position data and direction of advance data selected by the selection means and the current coordinate position detected by the position detection means. Thus, deviation from a curved driving course may be readily calculated.
Furthermore, the vehicle steering angle is calculated so as to decrease with increased detected travel speed on the basis of the deviation calculated by the deviation calculation means and the current speed detected by the speed detection means in order to reduce deviation to zero. Thus, vehicle steering angle may be calculated easily and accurately with reference to current vehicle speed.
Furthermore, the vehicle steering angle is controlled on the basis of the vehicle steering angle calculated by the steering angle calculation means, allowing the vehicle to be accurately guided over the predetermined course.
In accordance with the second invention, the deviation calculated by the deviation calculation means is subjected to an integration operation. The vehicle steering angle is calculated so as to decrease with increased detected travel speed on the basis of the CA 022048~7 1997-0~-08 deviation calculated by the deviation calculation means, the integral calculated by the integration operation means, and the current speed detected by the speed detection means in order to reduce the deviation to zero.
Since the steering angle is calculated with reference to the integral of deviation, vehicle steering angles which compensate for and cancel out changes in vehicle alignment can be calculated correctly in order to accurately guide the vehicle over a predetermined driving course.
In accordance with the third invention, a second vehicle steering angle is calculated on the basis of the radius of curvature of the predetermined course at the point closest to the current vehicle position. A third vehicle steering angle is then calculated on the basis of the deviation-based first steering angle and the second steering angle, and the vehicle steering angle is controlled on the basis of this third vehicle steering angle. As a result, the second steering angle, which is based on the curvature of the course, can be nimbly maintained, allowing the vehicle to be guided around the course in an approximate fashion, while deviation from the course is corrected through the deviation-based first steering angle, allowing the vehicle to be accurately guided along a course whose radius of curvature varies in complex fashion.
BRIEF DESCRIPTION OF THE DRAWINGS
CA 022048~7 1997-0~-08 Fig. 1 is a block diagram depicting the structure of an embodiment of the vehicle guidance system which pertains to the present invention;
Fig. 2 is a block diagram which illustrates the process for obtaining predetermined course data through teaching;
Fig. 3 is a diagram of geometric relationships illustrating the process for computing vehicle steering angle; and Fig. 4 is a flow chart depicting the processing order in automatic vehicle guidance.
BEST MODE FOR CARRYING OUT THE INVENTION
An embodiment of the vehicle guidance system which pertains to the present invention will be described with reference to the drawings.
Fig. 1 is a block diagram depicting the vehicle guidance system of the embodiment. Fig. 2 is a block diagram which illustrates the teaching process conducted prior to actual guidance.
~Predetermined Course Teaching In the embodiment, it is supposed that the vehicle to be driven is the unmanned dump truck (hereinafter termed "vehicle") 14 which is shown in Fig. 2.
The vehicle 14 is to be driven unmanned over a predetermined course S, for example. Data representing the predetermined course S is taught, that is, set and CA 022048~7 1997-0~-08 stored in the memory 5 provided to the vehicle 14, by means of a teaching operation in which the vehicle is driven by a human operator once around the course to be traveled.
The vehicle 14 is equipped with a gyro 1 for detecting the direction of advance, a distance encoder 2 for detecting travel distance, and a position measurement controller 3 which controls the gyro 1 and the distance encoder 2.
During the teaching run, a vehicle 14 positional coordinate series, a vehicle 14 direction of advance series, and a vehicle 14 speed series are calculated by the position measurement controller 3 on the basis of the detection signals output by the gyro 1 and the distance encoder 2. These are output as entire course data 4.
The entire course data 4 is output several to several dozen times per second, and thus represents a considerable volume of data; to adjust the size to one suited for the memory capacity of the memory 5, sampling is conducted at a prescribed interval 1. The sampling interval I is an optimal interval that is neither too great or too small.
The sampling operation produces a vehicle 14 positional coordinate series P1 (X1, Y1), P2 (X2, Y2) ...
Pi (Xi, Yi) ... , a vehicle 14 direction of advance (bearing) series ~ 2, ...~i ... , and a vehicle 14 speed series V1, V2, ... Vi, ... which are stored as course data 6 in the memory 5.
CA 022048~7 1997-0~-08 For each point Pl, P2, ... Pi ... on the predetermined course S, positional coordinates (Xi, Xj) indicating where the vehicle 14 should be positioned, the direction of advance~i in which the vehicle 14 should go, and the speed Vi at which the vehicle 14 should move are stored in the memory 5.
In this embodiment, course data 6 is calculated using a teaching process, but any method of calculation may be used, including measurement and the like.
~Automatic Guidance The steps in the automatic guidance process for the vehicle 14 will be explained referring to the flow chart in Fig. 4.
When the teaching run has been completed and automatically guided operation (playback) begins, detection signals are output by the gyro 1 and the distance encoder 2, and the current position Q (X, Y) of the vehicle 14 is calculated by the position measurement controller 3 and output to the guidance controller 7 (step 101).
The guidance controller 7 calculates a target steering angle~, described later, whereupon, through the a~ency of a steering controller 8, the steering (not shown) of the vehicle 14 is operated by means of a hydraulic servo system 11 in order to change the direction of the vehicle 14 to produce the aforementioned target steering angle~ (steps 102 - 106).
CA 022048~7 1997-0~-OX
The guidance controller 7 also calculates a target speed for the vehicle 14, described later, whereupon, through the agency of an accelerator controller 9 and a brake controller 10, the accelerator and brakes (not shown) of the vehicle 14 are operated by means of a mechanical servo system 12 and a pneumatic servo system 13 in order to change the speed of the vehicle 14 to produce the aforementioned target speed.
The computations for the aforementioned target steering angle will now be described in more detail.
The most proximate point Pi on the driving course S
lying ahead of the current position Q (X, Y) of the vehicle 14 in the direction of advance of the vehicle 14 is selected (step 102; see Fig. 3).
Positional coordinate data (Xi, Yi) and bearing data ~i for the selected point Pi are read out from the memory 5.
A basic steering angle ~p which corresponds to the radius of curvature of the driving course S at the most proximate point Pi is calculated in the manner described later (step 103).
On the basis of the course positional coordinates (Xi, Yi), the bearing~i, and the basic steering angle ~p, and the current vehicle position Q (X, Y) so obtained, the operations represented by equations (1), (2), and (3), below, are performed to calculate the target steering angle ~ for the vehicle 14.
CA 022048~7 1997-0~-08 yi = -(X - Xi) sin~i + (Y - Yi) cos~i (1) as = -(K4 + K5-K6) yi - K4-K6 yidt - K5dyi/dt (2) ~ = tan-1 (asL/V2) + Kp-~p (3) Here, K4, K5, K6, and Kp are control constants, and L is the wheel base (distance between front and rear axles) of the vehicle 14.
V is the current speed of the vehicle 14; it is input to the guidance controller 7 through the agency of the position measurement controller 3.
Equations (1) through (3), given above, will now be discussed. The basic steering angle p represented by equation (3) is calculated from (4) through (7), below.
Where V represents the speed of the vehicle 14 and represents the sampling interval, the length G of an arc lying on the predetermined driving course S which connects point Pi and the next point Pi + 1 on the course is computed as follows:
G = V ~ I (4) Where Ri is the radius of curvature of the arc which connects point Pi and the next point Pi + 1, the arc length G may also be computed as follows:
G = Ri ~ (~i + 1 - ~i) (5) From equations (4) and (5), the radius of curvature Ri may be computed using equation (6), below.
Ri = V ~ ~ i + 1 - ~i) (6) Using the radius of curvature Ri so calculated and the wheel base L, the basic steering angle p may be obtained CA 022048~7 1997-0~-08 using equation (7), below.
~p = arctan (L/Ri) (7) In equation (1), above, the Y-axis coordinate position Y (current position) of the vehicle 14 in an X-Y fixed coordinate system is converted to the coordinate yi in a local coordinate system xi-yi.
Specifically, as shown in Fig. 3, an xi-yi coordinate system in which the point Pi on the predetermined driving course S is designated as the origin, the direction of the speed Vi (vector) which the vehicle 14 should put out at point Pi, i.e., the direction of advance ~i, is designated as the xi axis, and the normal direction of the course S is designated as the yi axis is established as the local coordinate system. Thus, the converted coordinate position yi indicates deviation of the vehicle 14 in the normal direction of the predetermined driving course S (the direction perpendicular to the direction of advance).
The target steering angle ~ required to bring deviation in the normal direction, yi, to zero is computed using equation (3).
The X-axis coordinate position X (current position) of the vehicle 14 in the X-Y fixed coordinate system is converted to xi in the local coordinate system xi-yi in the manner indicated by equation (8), below.
xi = (X - Xi) cos~i + (Y - Yi) sin~i (8) The deviation in the normal direction, yi, CA 022048~7 1997-0~-08 calculated using the aforementioned equation (1) is substituted into the aforementioned equation (2), the acceleration in the lateral (normal) direction of the vehicle 14, as, is calculated, and this lateral direction acceleration as is substituted into the aforementioned equation (3) to calculate the target steering angle ~.
Here, the lateral direction acceleration as includes the normal direction deviation yi integral -K4 ~ K6 yidt, so this integral is added to the target steering angle ~.
Thus, when the steering of the vehicle 14 is controlled in such a way that this target steering angle becomes zero, even if the vehicle 14 should be out of alignment, the aforementioned integral compensates for and cancels out the aberration, making it possible for the vehicle 14 to travel along a straight-line course without deviation.
The target steering angle ~ computed in equation (3) is proportional to 1/V2. Thus, the higher the current speed V of the vehicle 14, the smaller the steering angle becomes, and the lower the speed V, the greater the steering angle becomes. As a result, the steering can be turned at the angle most appropriate for the speed, preventing the vehicle 14 from deviating from the course S.
The calculations given earlier are not complex operations that require calculation of complex polynomial expressions, but are rather simple operations. Thus, the CA 022048~7 1997-0~-08 vehicle 14 can be accurately guided along a curved course by means of a simple process that does not require complex calculations (steps 103, 104, 105).
The current bearing ~ of the vehicle 14 is calculated by the position measurement controller 3 computes and is input to the guidance controller 7. The target speed Vxi, Vyi for the vehicle 14 is then computed on the basis of the current bearing ~, the current speed V, and the bearing ~i with reference to point Pi using equations (9), (10), and (11), below.
( 9 ) Vxi = Vcos~i (10) Vyi = Vsin~i (11) In equation (9), ~ is approximately equal to ~i, so ~i becomes zero and the lateral (normal) direction speed Vyi becomes zero as well. Thus, it is sufficient to simply control the longitudinal (tangent) direction speed Vxi indicated by equation (10); this is output as the target speed to the accelerator controller 9 and the brake controller 10, whereby the accelerator and a brakes are controlled.
As noted earlier, in accordance with the present invention the vehicle steering angle is calculated using simple operations, ma~ing it possible to readily guide the vehicle over a curved driving course by means of a simple process.
Since the calculated steering angle is smaller the greater the traveling speed, the vehicle can be CA 022048~7 1997-0~-08 accurately guided over a curved driving course without deviating from it.
Since reference is made to the integral of deviation in the normal direction of the driving course when calculating the steering angle, the vehicle can be accurately guided along a predetermined driving course even if the vehicle should be out of alignment.
Since the required steering angle is given by a basic steering angle based on the curvature of the driving course, and deviation from the course is corrected by adding a deviation-based steering angle, the vehicle can be guided accurately and without delayed response, even over a curved course whose radius of curvature changes in a complex manner.
INDUSTRIAL APPLICABILITY
The present invention has potential application in both unmanned and manned vehicles. The present invention is not limited to dump trucks and other vehicles which are operated outdoors, but has potential application in vehicles operated indoors, such as unmanned carrier vehicles and the like.
GUIDANCE SYSTEM FOR VEHICLE
TECHNICAL FIELD
The present invention relates to a vehicle guidance system for storing position data pertaining to a predetermined driving course, and for guiding the vehicle along the predetermined driving course by controlling the steering angle of the vehicle on the basis of this position data.
BACKGROUND ART
Several systems for guiding vehicles along predetermined driving courses have been developed and submitted for patent application in the past.
Japanese Patent Publications 5-22925 and 5-22926 teach a technique of approximating the driving course by connecting a plurality of straight line segments and guiding the vehicle along these straight line segments.
While the technique taught in these publications has the advantage that calculation of the vehicle steering angle or the like is easy since the vehicle needs only to move forward in a straight line, it has the drawback that, since curved driving course paths are approximated by straight lines, the vehicle does not follow the predetermined driving course in an exact manner.
Further, the technique taught in the aforementioned -CA 022048~7 1997-0~-08 publications sets the vehicle steering angle without regard for current vehicle speed.
Thus, when the vehicle is traveling at high speed, the steering angle can be too great, creating the possibility of oversteering and, in some cases, causing the vehicle to deviate from the curved driving course.
Conversely, when the vehicle is traveling at low speed, the steering angle can be too small, creating the possibility of understeering and, in some cases, causing the vehicle to deviate from the curved driving course.
Further, in the technique taught in the aforementioned publications, the steering angle when the vehicle follows a straight-line course without deviation is set to zero for reasons pertaining to the steering angle calculation process.
However, in the case of a vehicle such as a dump truck, the alignment of the four wheels of the vehicle can change depending on the load and load distribution.
When the alignment changes, continuing to move with the steering angle set at zero can cause the vehicle to deviate from a straight-line course. This presents significant practical problems.
Japanese Patent Publication 5-503775 teaches calculating the steering angle by plotting from the current position a smoothly linked path, expressed by a polynomial of degree 5, over the driving course and guiding the vehicle along this path.
While the technique taught in this publication does CA 022048~7 1997-0~-08 take into account travel over a curved driving course, the calculations are quite complex and time-consuming.
Like the aforementioned Japanese Patent Publications 5-22925 and 5-22926, the technique taught in the aforementioned publication sets the vehicle steering angle without regard for current vehicle speed. This gives rise to the possibility of deviation from a curved driving course.
Also, like the aforementioned Japanese Patent Publications 5-22925 and 5-22926, the steering angle when the vehicle follows a straight-line course without deviation is set to zero, so if there is not perfect alignment between the front and rear wheels of the vehicle, it becomes extremely difficult to prevent the vehicle from traveling along the straight-line course without deviation.
Thus, conventional techniques have the drawback of being incapable of affording travel in an exact manner over a curved driving course by means of a simple process.
They also have the problem of deviation from a curved driving course depending on vehicle speed.
A further problem is that changes in vehicle alignment can result in deviation from the predetermined course, even when the driving course is straight course.
DISCLOSURE OF THE INVENTION
It is an object of the present invention to provide CA 022048~7 1997-0~-08 a system that can overcome these problems.
The first invention of this invention is intended to accurately guide the vehicle over a curved driving course by means of a simple process, and to prevent the vehicle from deviating from a curved driving course regardless of vehicle speed.
These objects are achieved through a vehicle guidance system for storing position data pertaining to a predetermined driving course and for guiding the vehicle along the predetermined driving course by controlling the steering angle of the vehicle on the basis of this position data, comprising memory means for storing, for each point on the aforementioned predetermined driving course, data indicating the coordinate position for the point in question and the direction in which the vehicle should advance, position detection means for detecting the current coordinate position of the vehicle, speed detection means for detecting the current speed of the vehicle, selection means for selecting from the memory contents of the memory means coordinate position data for the point on the predetermined driving course that is closest to the current coordinate position detected by the position detection means and direction of advance data for this closest point, deviation calculation means for calculating the current deviation of vehicle position in the direction perpendicular to the direction of vehiclè advance on the basis of the coordinate position data and direction of advance data selected by the CA 022048~7 1997-0~-08 selection means and the current coordinate position detected by the position detection means, steering angle calculation means for calculating the vehicle steering angle so as to decrease with increased detected travel speed on the basis of the deviation calculated by the deviation calculation means and the current speed detected by the speed detection means in order to reduce deviation to zero, and control means for controlling the steering angle of the vehicle on the basis of the vehicle steering angle calculated by the steering angle calculation means.
In addition to the objects of the first invention stated above, it is a further object of the second invention of this invention to compensate for and cancel out changes in vehicle alignment in order to accurately guide the vehicle over a predetermined driving course.
This object is achieved by further providing the structure of the first invention with integration operation means for performing integration operations on the deviation calculated by the deviation calculation means, and by configuring the steering angle calculation means to calculate the vehicle steering angle so as to decrease with increased detected travel speed on the basis of the deviation calculated by the deviation calculation means, the integral calculated by the integration operation means, and the current speed detected by the speed detection means in order to reduce the deviation to zero.
CA 022048~7 1997-0~-08 In addition to the objects of the first invention stated above, it is a further object of the third invention of this invention to accurately guide the vehicle over a course whose radius of curvature varies in complex fashion.
This object is achieved by further providing the structure of the first invention with integration operation means for performing integration operations on the deviation calculated by the deviation calculation means, by replacing the steering angle calculation means with first steering angle calculation means for calculating a first vehicle steering angle so as to decrease with increased detected travel speed on the basis of the deviation calculated by the deviation calculation means, the integral calculated by the integration operation means in order to reduce the deviation to zero, and the current speed detected by the speed detection means, second steering angle calculation means for calculating a second vehicle steering angle on the basis of the radius of curvature of the predetermined course at the closest point, and third steering angle calculation means for calculating a third vehicle steering angle on the basis of the first vehicle steering angle calculated by the first steering angle calculation means and the second vehicle steering angle calculated by the second steering angle calculation means, and by employing as the control means control means that controls steering angle of the vehicle on the basis of CA 022048~7 1997-0~-08 the third vehicle steering angle calculated by the third steering angle calculation means.
In accordance with the first invention, the current deviation of vehicle position in the direction perpendicular to the direction of vehicle advance is calculated on the basis of the coordinate position data and direction of advance data selected by the selection means and the current coordinate position detected by the position detection means. Thus, deviation from a curved driving course may be readily calculated.
Furthermore, the vehicle steering angle is calculated so as to decrease with increased detected travel speed on the basis of the deviation calculated by the deviation calculation means and the current speed detected by the speed detection means in order to reduce deviation to zero. Thus, vehicle steering angle may be calculated easily and accurately with reference to current vehicle speed.
Furthermore, the vehicle steering angle is controlled on the basis of the vehicle steering angle calculated by the steering angle calculation means, allowing the vehicle to be accurately guided over the predetermined course.
In accordance with the second invention, the deviation calculated by the deviation calculation means is subjected to an integration operation. The vehicle steering angle is calculated so as to decrease with increased detected travel speed on the basis of the CA 022048~7 1997-0~-08 deviation calculated by the deviation calculation means, the integral calculated by the integration operation means, and the current speed detected by the speed detection means in order to reduce the deviation to zero.
Since the steering angle is calculated with reference to the integral of deviation, vehicle steering angles which compensate for and cancel out changes in vehicle alignment can be calculated correctly in order to accurately guide the vehicle over a predetermined driving course.
In accordance with the third invention, a second vehicle steering angle is calculated on the basis of the radius of curvature of the predetermined course at the point closest to the current vehicle position. A third vehicle steering angle is then calculated on the basis of the deviation-based first steering angle and the second steering angle, and the vehicle steering angle is controlled on the basis of this third vehicle steering angle. As a result, the second steering angle, which is based on the curvature of the course, can be nimbly maintained, allowing the vehicle to be guided around the course in an approximate fashion, while deviation from the course is corrected through the deviation-based first steering angle, allowing the vehicle to be accurately guided along a course whose radius of curvature varies in complex fashion.
BRIEF DESCRIPTION OF THE DRAWINGS
CA 022048~7 1997-0~-08 Fig. 1 is a block diagram depicting the structure of an embodiment of the vehicle guidance system which pertains to the present invention;
Fig. 2 is a block diagram which illustrates the process for obtaining predetermined course data through teaching;
Fig. 3 is a diagram of geometric relationships illustrating the process for computing vehicle steering angle; and Fig. 4 is a flow chart depicting the processing order in automatic vehicle guidance.
BEST MODE FOR CARRYING OUT THE INVENTION
An embodiment of the vehicle guidance system which pertains to the present invention will be described with reference to the drawings.
Fig. 1 is a block diagram depicting the vehicle guidance system of the embodiment. Fig. 2 is a block diagram which illustrates the teaching process conducted prior to actual guidance.
~Predetermined Course Teaching In the embodiment, it is supposed that the vehicle to be driven is the unmanned dump truck (hereinafter termed "vehicle") 14 which is shown in Fig. 2.
The vehicle 14 is to be driven unmanned over a predetermined course S, for example. Data representing the predetermined course S is taught, that is, set and CA 022048~7 1997-0~-08 stored in the memory 5 provided to the vehicle 14, by means of a teaching operation in which the vehicle is driven by a human operator once around the course to be traveled.
The vehicle 14 is equipped with a gyro 1 for detecting the direction of advance, a distance encoder 2 for detecting travel distance, and a position measurement controller 3 which controls the gyro 1 and the distance encoder 2.
During the teaching run, a vehicle 14 positional coordinate series, a vehicle 14 direction of advance series, and a vehicle 14 speed series are calculated by the position measurement controller 3 on the basis of the detection signals output by the gyro 1 and the distance encoder 2. These are output as entire course data 4.
The entire course data 4 is output several to several dozen times per second, and thus represents a considerable volume of data; to adjust the size to one suited for the memory capacity of the memory 5, sampling is conducted at a prescribed interval 1. The sampling interval I is an optimal interval that is neither too great or too small.
The sampling operation produces a vehicle 14 positional coordinate series P1 (X1, Y1), P2 (X2, Y2) ...
Pi (Xi, Yi) ... , a vehicle 14 direction of advance (bearing) series ~ 2, ...~i ... , and a vehicle 14 speed series V1, V2, ... Vi, ... which are stored as course data 6 in the memory 5.
CA 022048~7 1997-0~-08 For each point Pl, P2, ... Pi ... on the predetermined course S, positional coordinates (Xi, Xj) indicating where the vehicle 14 should be positioned, the direction of advance~i in which the vehicle 14 should go, and the speed Vi at which the vehicle 14 should move are stored in the memory 5.
In this embodiment, course data 6 is calculated using a teaching process, but any method of calculation may be used, including measurement and the like.
~Automatic Guidance The steps in the automatic guidance process for the vehicle 14 will be explained referring to the flow chart in Fig. 4.
When the teaching run has been completed and automatically guided operation (playback) begins, detection signals are output by the gyro 1 and the distance encoder 2, and the current position Q (X, Y) of the vehicle 14 is calculated by the position measurement controller 3 and output to the guidance controller 7 (step 101).
The guidance controller 7 calculates a target steering angle~, described later, whereupon, through the a~ency of a steering controller 8, the steering (not shown) of the vehicle 14 is operated by means of a hydraulic servo system 11 in order to change the direction of the vehicle 14 to produce the aforementioned target steering angle~ (steps 102 - 106).
CA 022048~7 1997-0~-OX
The guidance controller 7 also calculates a target speed for the vehicle 14, described later, whereupon, through the agency of an accelerator controller 9 and a brake controller 10, the accelerator and brakes (not shown) of the vehicle 14 are operated by means of a mechanical servo system 12 and a pneumatic servo system 13 in order to change the speed of the vehicle 14 to produce the aforementioned target speed.
The computations for the aforementioned target steering angle will now be described in more detail.
The most proximate point Pi on the driving course S
lying ahead of the current position Q (X, Y) of the vehicle 14 in the direction of advance of the vehicle 14 is selected (step 102; see Fig. 3).
Positional coordinate data (Xi, Yi) and bearing data ~i for the selected point Pi are read out from the memory 5.
A basic steering angle ~p which corresponds to the radius of curvature of the driving course S at the most proximate point Pi is calculated in the manner described later (step 103).
On the basis of the course positional coordinates (Xi, Yi), the bearing~i, and the basic steering angle ~p, and the current vehicle position Q (X, Y) so obtained, the operations represented by equations (1), (2), and (3), below, are performed to calculate the target steering angle ~ for the vehicle 14.
CA 022048~7 1997-0~-08 yi = -(X - Xi) sin~i + (Y - Yi) cos~i (1) as = -(K4 + K5-K6) yi - K4-K6 yidt - K5dyi/dt (2) ~ = tan-1 (asL/V2) + Kp-~p (3) Here, K4, K5, K6, and Kp are control constants, and L is the wheel base (distance between front and rear axles) of the vehicle 14.
V is the current speed of the vehicle 14; it is input to the guidance controller 7 through the agency of the position measurement controller 3.
Equations (1) through (3), given above, will now be discussed. The basic steering angle p represented by equation (3) is calculated from (4) through (7), below.
Where V represents the speed of the vehicle 14 and represents the sampling interval, the length G of an arc lying on the predetermined driving course S which connects point Pi and the next point Pi + 1 on the course is computed as follows:
G = V ~ I (4) Where Ri is the radius of curvature of the arc which connects point Pi and the next point Pi + 1, the arc length G may also be computed as follows:
G = Ri ~ (~i + 1 - ~i) (5) From equations (4) and (5), the radius of curvature Ri may be computed using equation (6), below.
Ri = V ~ ~ i + 1 - ~i) (6) Using the radius of curvature Ri so calculated and the wheel base L, the basic steering angle p may be obtained CA 022048~7 1997-0~-08 using equation (7), below.
~p = arctan (L/Ri) (7) In equation (1), above, the Y-axis coordinate position Y (current position) of the vehicle 14 in an X-Y fixed coordinate system is converted to the coordinate yi in a local coordinate system xi-yi.
Specifically, as shown in Fig. 3, an xi-yi coordinate system in which the point Pi on the predetermined driving course S is designated as the origin, the direction of the speed Vi (vector) which the vehicle 14 should put out at point Pi, i.e., the direction of advance ~i, is designated as the xi axis, and the normal direction of the course S is designated as the yi axis is established as the local coordinate system. Thus, the converted coordinate position yi indicates deviation of the vehicle 14 in the normal direction of the predetermined driving course S (the direction perpendicular to the direction of advance).
The target steering angle ~ required to bring deviation in the normal direction, yi, to zero is computed using equation (3).
The X-axis coordinate position X (current position) of the vehicle 14 in the X-Y fixed coordinate system is converted to xi in the local coordinate system xi-yi in the manner indicated by equation (8), below.
xi = (X - Xi) cos~i + (Y - Yi) sin~i (8) The deviation in the normal direction, yi, CA 022048~7 1997-0~-08 calculated using the aforementioned equation (1) is substituted into the aforementioned equation (2), the acceleration in the lateral (normal) direction of the vehicle 14, as, is calculated, and this lateral direction acceleration as is substituted into the aforementioned equation (3) to calculate the target steering angle ~.
Here, the lateral direction acceleration as includes the normal direction deviation yi integral -K4 ~ K6 yidt, so this integral is added to the target steering angle ~.
Thus, when the steering of the vehicle 14 is controlled in such a way that this target steering angle becomes zero, even if the vehicle 14 should be out of alignment, the aforementioned integral compensates for and cancels out the aberration, making it possible for the vehicle 14 to travel along a straight-line course without deviation.
The target steering angle ~ computed in equation (3) is proportional to 1/V2. Thus, the higher the current speed V of the vehicle 14, the smaller the steering angle becomes, and the lower the speed V, the greater the steering angle becomes. As a result, the steering can be turned at the angle most appropriate for the speed, preventing the vehicle 14 from deviating from the course S.
The calculations given earlier are not complex operations that require calculation of complex polynomial expressions, but are rather simple operations. Thus, the CA 022048~7 1997-0~-08 vehicle 14 can be accurately guided along a curved course by means of a simple process that does not require complex calculations (steps 103, 104, 105).
The current bearing ~ of the vehicle 14 is calculated by the position measurement controller 3 computes and is input to the guidance controller 7. The target speed Vxi, Vyi for the vehicle 14 is then computed on the basis of the current bearing ~, the current speed V, and the bearing ~i with reference to point Pi using equations (9), (10), and (11), below.
( 9 ) Vxi = Vcos~i (10) Vyi = Vsin~i (11) In equation (9), ~ is approximately equal to ~i, so ~i becomes zero and the lateral (normal) direction speed Vyi becomes zero as well. Thus, it is sufficient to simply control the longitudinal (tangent) direction speed Vxi indicated by equation (10); this is output as the target speed to the accelerator controller 9 and the brake controller 10, whereby the accelerator and a brakes are controlled.
As noted earlier, in accordance with the present invention the vehicle steering angle is calculated using simple operations, ma~ing it possible to readily guide the vehicle over a curved driving course by means of a simple process.
Since the calculated steering angle is smaller the greater the traveling speed, the vehicle can be CA 022048~7 1997-0~-08 accurately guided over a curved driving course without deviating from it.
Since reference is made to the integral of deviation in the normal direction of the driving course when calculating the steering angle, the vehicle can be accurately guided along a predetermined driving course even if the vehicle should be out of alignment.
Since the required steering angle is given by a basic steering angle based on the curvature of the driving course, and deviation from the course is corrected by adding a deviation-based steering angle, the vehicle can be guided accurately and without delayed response, even over a curved course whose radius of curvature changes in a complex manner.
INDUSTRIAL APPLICABILITY
The present invention has potential application in both unmanned and manned vehicles. The present invention is not limited to dump trucks and other vehicles which are operated outdoors, but has potential application in vehicles operated indoors, such as unmanned carrier vehicles and the like.
Claims (3)
1. A vehicle guidance system for storing position data pertaining to a predetermined driving course and for guiding the vehicle along the predetermined driving course by controlling the steering angle of the vehicle on the basis of this position data, comprising:
memory means for storing, for each point on the aforementioned predetermined driving course, data indicating the coordinate position for the point in question and the direction in which the vehicle should advance;
position detection means for detecting the current coordinate position of the vehicle;
speed detection means for detecting the current speed of the vehicle;
selection means for selecting from the memory contents of the memory means coordinate position data for the point on the predetermined driving course that is closest to the current coordinate position detected by the position detection means and direction of advance data for this closest point;
deviation calculation means for calculating the current deviation of vehicle position in the direction perpendicular to the direction of vehicle advance corresponding to the selected direction of advance data on the basis of the coordinate position data and direction of advance data selected by the selection means and the current coordinate position detected by the position detection means;
steering angle calculation means for calculating the vehicle steering angle so as to decrease with increased detected travel speed on the basis of the deviation calculated by the deviation calculation means and the current speed detected by the speed detection means in order to reduce deviation to zero; and control means for controlling the steering angle of the vehicle on the basis of the vehicle steering angle calculated by the steering angle calculation means.
memory means for storing, for each point on the aforementioned predetermined driving course, data indicating the coordinate position for the point in question and the direction in which the vehicle should advance;
position detection means for detecting the current coordinate position of the vehicle;
speed detection means for detecting the current speed of the vehicle;
selection means for selecting from the memory contents of the memory means coordinate position data for the point on the predetermined driving course that is closest to the current coordinate position detected by the position detection means and direction of advance data for this closest point;
deviation calculation means for calculating the current deviation of vehicle position in the direction perpendicular to the direction of vehicle advance corresponding to the selected direction of advance data on the basis of the coordinate position data and direction of advance data selected by the selection means and the current coordinate position detected by the position detection means;
steering angle calculation means for calculating the vehicle steering angle so as to decrease with increased detected travel speed on the basis of the deviation calculated by the deviation calculation means and the current speed detected by the speed detection means in order to reduce deviation to zero; and control means for controlling the steering angle of the vehicle on the basis of the vehicle steering angle calculated by the steering angle calculation means.
2. A vehicle guidance system for storing position data pertaining to a predetermined driving course and for guiding the vehicle along the predetermined driving course by controlling the steering angle of the vehicle on the basis of this position data, comprising:
memory means for storing, for each point on the aforementioned predetermined driving course, data indicating the coordinate position for the point in question and the direction in which the vehicle should advance;
position detection means for detecting the current coordinate position of the vehicle;
speed detection means for detecting the current speed of the vehicle;
selection means for selecting from the memory contents of the memory means coordinate position data for the point on the predetermined driving course that is closest to the current coordinate position detected by the position detection means and direction of advance data for this closest point;
deviation calculation means for calculating the current deviation of vehicle position in the direction perpendicular to the direction of vehicle advance corresponding to the selected direction of advance data on the basis of the coordinate position data and direction of advance data selected by the selection means and the current coordinate position detected by the position detection means;
integration operation means for performing integration operations on the deviation calculated by the deviation calculation means;
steering angle calculation for calculating the vehicle steering angle so as to decrease with increased detected travel speed on the basis of the deviation calculated by the deviation calculation means, the integral calculated by the integration operation means, and the current speed detected by the speed detection means in order to reduce the deviation to zero; and control means for controlling the steering angle of the vehicle on the basis of the vehicle steering angle calculated by the steering angle calculation means.
memory means for storing, for each point on the aforementioned predetermined driving course, data indicating the coordinate position for the point in question and the direction in which the vehicle should advance;
position detection means for detecting the current coordinate position of the vehicle;
speed detection means for detecting the current speed of the vehicle;
selection means for selecting from the memory contents of the memory means coordinate position data for the point on the predetermined driving course that is closest to the current coordinate position detected by the position detection means and direction of advance data for this closest point;
deviation calculation means for calculating the current deviation of vehicle position in the direction perpendicular to the direction of vehicle advance corresponding to the selected direction of advance data on the basis of the coordinate position data and direction of advance data selected by the selection means and the current coordinate position detected by the position detection means;
integration operation means for performing integration operations on the deviation calculated by the deviation calculation means;
steering angle calculation for calculating the vehicle steering angle so as to decrease with increased detected travel speed on the basis of the deviation calculated by the deviation calculation means, the integral calculated by the integration operation means, and the current speed detected by the speed detection means in order to reduce the deviation to zero; and control means for controlling the steering angle of the vehicle on the basis of the vehicle steering angle calculated by the steering angle calculation means.
3. A vehicle guidance system for storing position data pertaining to a predetermined driving course and for guiding the vehicle along the predetermined driving course by controlling the steering angle of the vehicle on the basis of this position data, comprising:
memory means for storing, for each point on the aforementioned predetermined driving course, data indicating the coordinate position for the point in question and the direction in which the vehicle should advance;
position detection means for detecting the current coordinate position of the vehicle;
speed detection means for detecting the current speed of the vehicle;
selection means for selecting from the memory contents of the memory means coordinate position data for the point on the predetermined driving course that is closest to the current coordinate position detected by the position detection means and direction of advance data for this closest point;
deviation calculation means for calculating the current deviation of vehicle position in the direction perpendicular to the direction of vehicle advance on the basis of the coordinate position data and direction of advance data selected by the selection means and the current coordinate position detected by the position detection means;
integration operation means for performing integration operations on the deviation calculated by the deviation calculation means;
first steering angle calculation means for calculating a first vehicle steering angle so as to decrease with increased detected travel speed on the basis of the deviation calculated by the deviation calculation means, the integral calculated by the integration operation means, and the current speed detected by the speed detection means in order to reduce the deviation to zero;
second steering angle calculation means for calculating a second vehicle steering angle on the basis of the radius of curvature of the predetermined course at the closest point;
third steering angle calculation means for calculating a third vehicle steering angle by adding the value obtained by multiplying the first vehicle steering angle calculated by the first steering angle calculation means by a prescribed coefficient with a value obtained by multiplying the second vehicle steering angle calculated by the second steering angle calculation means by a prescribed coefficient; and control means for controlling the steering angle of the vehicle on the basis of the third vehicle steering angle calculated by the third steering angle calculation means.
memory means for storing, for each point on the aforementioned predetermined driving course, data indicating the coordinate position for the point in question and the direction in which the vehicle should advance;
position detection means for detecting the current coordinate position of the vehicle;
speed detection means for detecting the current speed of the vehicle;
selection means for selecting from the memory contents of the memory means coordinate position data for the point on the predetermined driving course that is closest to the current coordinate position detected by the position detection means and direction of advance data for this closest point;
deviation calculation means for calculating the current deviation of vehicle position in the direction perpendicular to the direction of vehicle advance on the basis of the coordinate position data and direction of advance data selected by the selection means and the current coordinate position detected by the position detection means;
integration operation means for performing integration operations on the deviation calculated by the deviation calculation means;
first steering angle calculation means for calculating a first vehicle steering angle so as to decrease with increased detected travel speed on the basis of the deviation calculated by the deviation calculation means, the integral calculated by the integration operation means, and the current speed detected by the speed detection means in order to reduce the deviation to zero;
second steering angle calculation means for calculating a second vehicle steering angle on the basis of the radius of curvature of the predetermined course at the closest point;
third steering angle calculation means for calculating a third vehicle steering angle by adding the value obtained by multiplying the first vehicle steering angle calculated by the first steering angle calculation means by a prescribed coefficient with a value obtained by multiplying the second vehicle steering angle calculated by the second steering angle calculation means by a prescribed coefficient; and control means for controlling the steering angle of the vehicle on the basis of the third vehicle steering angle calculated by the third steering angle calculation means.
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP276670/1994 | 1994-11-10 | ||
| JP27667094A JP3266747B2 (en) | 1994-11-10 | 1994-11-10 | Vehicle guidance and travel control device |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CA2204857A1 true CA2204857A1 (en) | 1996-05-23 |
Family
ID=17572686
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CA002204857A Abandoned CA2204857A1 (en) | 1994-11-10 | 1995-11-10 | Guidance system for vehicle |
Country Status (6)
| Country | Link |
|---|---|
| US (1) | US5781870A (en) |
| JP (1) | JP3266747B2 (en) |
| AU (1) | AU687270B2 (en) |
| CA (1) | CA2204857A1 (en) |
| GB (1) | GB2309556A (en) |
| WO (1) | WO1996015483A1 (en) |
Families Citing this family (19)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP3642547B2 (en) * | 1997-08-22 | 2005-04-27 | 株式会社小松製作所 | Self-propelled vehicle speed control device |
| US5999865A (en) * | 1998-01-29 | 1999-12-07 | Inco Limited | Autonomous vehicle guidance system |
| US6314348B1 (en) * | 1998-02-11 | 2001-11-06 | Trimble Navigation Limited | Correction control for guidance control system |
| JP3869108B2 (en) * | 1998-02-23 | 2007-01-17 | 株式会社小松製作所 | Unmanned vehicle interference prediction apparatus and unmanned vehicle guided traveling method |
| US6141613A (en) * | 1998-03-18 | 2000-10-31 | Caterpillar Inc. | Apparatus and method for controlling the steering of a tracked machine |
| DE19822508A1 (en) | 1998-05-19 | 1999-12-02 | Daimler Chrysler Ag | Method for generating coupling paths, usable for guiding a vehicle to a predetermined target path |
| DE10019011A1 (en) * | 2000-04-17 | 2001-10-25 | Geo Tec Electronics Gmbh | Automatic controls for guidance of agricultural machine along defined path uses signals from global positioning system and makes continuous comparison between actual and reference positions |
| WO2004040391A1 (en) * | 2002-10-30 | 2004-05-13 | Mitsubishi Heavy Industries, Ltd. | Method and device for steering vehicle having no contact with track |
| US7991521B2 (en) * | 2006-02-01 | 2011-08-02 | Jervis B. Webb Company | Variable path automated guided vehicle |
| US8190330B2 (en) * | 2009-03-06 | 2012-05-29 | GM Global Technology Operations LLC | Model based predictive control for automated lane centering/changing control systems |
| JP5332952B2 (en) * | 2009-06-26 | 2013-11-06 | トヨタ車体株式会社 | Travel controller for automated guided vehicle |
| CN103236199B (en) * | 2013-04-09 | 2015-02-25 | 北京理工大学 | Automatic testing system and testing method for street crossing of pedestrians |
| CN105857389A (en) * | 2016-04-29 | 2016-08-17 | 百度在线网络技术（北京）有限公司 | Steering control method and device for driverless car |
| CN109416539B (en) * | 2016-11-24 | 2021-12-21 | 百度时代网络技术（北京）有限公司 | Method and system for steering control of an autonomous vehicle using a proportional, integral and derivative (PID) controller |
| JP7412071B2 (en) * | 2017-11-30 | 2024-01-12 | 株式会社小松製作所 | Unmanned vehicle control device and unmanned vehicle control method |
| CN108437981B (en) * | 2018-03-01 | 2020-02-21 | 东软集团股份有限公司 | Automatic reversing method and device |
| JP7208804B2 (en) * | 2019-01-17 | 2023-01-19 | 株式会社小松製作所 | Unmanned vehicle control system and unmanned vehicle control method |
| CN111966103B (en) * | 2020-08-18 | 2021-04-20 | 国以贤智能科技(上海)股份有限公司 | Method, device, equipment and medium for dynamically correcting zero deflection angle of unmanned forklift |
| CN113433942B (en) * | 2021-06-30 | 2022-11-18 | 南京理工大学 | Long-axis vehicle path tracking control method based on optimal course angle |
Family Cites Families (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS5914711A (en) * | 1982-07-13 | 1984-01-25 | 株式会社クボタ | Unmanned running working vehicle |
| JPS5911409A (en) * | 1982-07-13 | 1984-01-21 | Kubota Ltd | Unmanned traveling truck |
| JPS60204012A (en) * | 1983-11-24 | 1985-10-15 | Toyota Central Res & Dev Lab Inc | Running command device of unattended car |
| US4700427A (en) * | 1985-10-17 | 1987-10-20 | Knepper Hans Reinhard | Method of automatically steering self-propelled floor-cleaning machines and floor-cleaning machine for practicing the method |
| US4803640A (en) * | 1986-05-12 | 1989-02-07 | Matsushita Electric Industrial Co., Ltd. | Control arrangement for an industrial robot |
| JPH07101369B2 (en) * | 1987-12-17 | 1995-11-01 | 日本輸送機株式会社 | Automatic steering control system |
| JP2579808B2 (en) * | 1988-10-14 | 1997-02-12 | 株式会社椿本チエイン | Mobile object guidance method and device |
| JPH0517704A (en) * | 1991-07-16 | 1993-01-26 | Nippon Steel Chem Co Ltd | Production of granulated carbon black |
| JP3001701B2 (en) * | 1991-12-25 | 2000-01-24 | 本田技研工業株式会社 | Mobile steering control device |
-
1994
- 1994-11-10 JP JP27667094A patent/JP3266747B2/en not_active Expired - Fee Related
-
1995
- 1995-11-10 CA CA002204857A patent/CA2204857A1/en not_active Abandoned
- 1995-11-10 WO PCT/JP1995/002297 patent/WO1996015483A1/en active Application Filing
- 1995-11-10 AU AU38560/95A patent/AU687270B2/en not_active Ceased
- 1995-11-10 US US08/836,133 patent/US5781870A/en not_active Expired - Lifetime
- 1995-11-10 GB GB9709154A patent/GB2309556A/en not_active Withdrawn
Also Published As
| Publication number | Publication date |
|---|---|
| AU687270B2 (en) | 1998-02-19 |
| JPH08137549A (en) | 1996-05-31 |
| GB2309556A (en) | 1997-07-30 |
| JP3266747B2 (en) | 2002-03-18 |
| WO1996015483A1 (en) | 1996-05-23 |
| US5781870A (en) | 1998-07-14 |
| GB9709154D0 (en) | 1997-06-25 |
| AU3856095A (en) | 1996-06-06 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US5781870A (en) | Vehicle steering angle control device | |
| JP2669031B2 (en) | Autonomous vehicles | |
| US5350912A (en) | System for controlling movement of a mobile body along a target path | |
| US6721638B2 (en) | AGV position and heading controller | |
| CN107085424A (en) | Pre- for automatic Pilot takes aim at crosswise joint | |
| US5663879A (en) | Method and apparatus for smooth control of a vehicle with automatic recovery for interference | |
| CN113581289B (en) | Zero offset dynamic calibration method and device, electronic equipment and storage medium | |
| CN112896147B (en) | Bidirectional positioning parking control method and device for mining vehicle | |
| Choi | The design of a look-down feedback adaptive controller for the lateral control of front-wheel-steering autonomous highway vehicles | |
| Ridley et al. | Autonomous control of an underground mining vehicle | |
| CN112148016A (en) | Vehicle control method and device based on model predictive control algorithm transverse and longitudinal decoupling | |
| CN115686017A (en) | Unmanned mining vehicle, control method and device thereof, and storage medium | |
| JP2002108446A (en) | Method for guiding traveling object | |
| Pradalier et al. | A simple and efficient control scheme to reverse a tractor-trailer system on a trajectory | |
| CN110362088B (en) | Tracking control system and method suitable for unmanned straddle carrier | |
| CN110083158B (en) | Method and equipment for determining local planning path | |
| WO2022209465A1 (en) | System, method, and work vehicle | |
| WO2022168733A1 (en) | Center of gravity determination device and method | |
| JPS59111508A (en) | Automatic car guiding method using point follow-up system | |
| Jurie et al. | High-speed vehicle guidance based on vision | |
| JPH03189805A (en) | Method and device for automatic steering vehicle | |
| JP4269170B2 (en) | Trajectory tracking control method and apparatus | |
| Pérez-Morales et al. | Multi-sensor-based predictive control for autonomous backward perpendicular and diagonal parking | |
| JPH05257529A (en) | Method and device for guide of course learning of running body | |
| JP3846828B2 (en) | Steering angle control device for moving body |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| EEER | Examination request | ||
| FZDE | Discontinued |