WO2020129722A1 - 自動走行作業車のための制御装置 - Google Patents

自動走行作業車のための制御装置 Download PDF

Info

Publication number
WO2020129722A1
WO2020129722A1 PCT/JP2019/048044 JP2019048044W WO2020129722A1 WO 2020129722 A1 WO2020129722 A1 WO 2020129722A1 JP 2019048044 W JP2019048044 W JP 2019048044W WO 2020129722 A1 WO2020129722 A1 WO 2020129722A1
Authority
WO
WIPO (PCT)
Prior art keywords
vehicle
estimated
deviation
traveling
calculates
Prior art date
Application number
PCT/JP2019/048044
Other languages
English (en)
French (fr)
Inventor
須賀博基
宮下隼輔
Original Assignee
株式会社クボタ
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 株式会社クボタ filed Critical 株式会社クボタ
Priority to EP19897852.0A priority Critical patent/EP3900505B1/en
Priority to US17/297,526 priority patent/US11937526B2/en
Publication of WO2020129722A1 publication Critical patent/WO2020129722A1/ja

Links

Images

Classifications

    • A—HUMAN NECESSITIES
    • A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01B—SOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B69/00—Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
    • A01B69/007—Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow
    • A01B69/008—Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow automatic
    • A—HUMAN NECESSITIES
    • A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01D—HARVESTING; MOWING
    • A01D41/00—Combines, i.e. harvesters or mowers combined with threshing devices
    • A01D41/12—Details of combines
    • A01D41/127—Control or measuring arrangements specially adapted for combines
    • A01D41/1278—Control or measuring arrangements specially adapted for combines for automatic steering
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0219—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/20—Control system inputs
    • G05D1/24—Arrangements for determining position or orientation
    • G05D1/247—Arrangements for determining position or orientation using signals provided by artificial sources external to the vehicle, e.g. navigation beacons
    • G05D1/248—Arrangements for determining position or orientation using signals provided by artificial sources external to the vehicle, e.g. navigation beacons generated by satellites, e.g. GPS
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/60—Intended control result
    • G05D1/648—Performing a task within a working area or space, e.g. cleaning
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/60—Intended control result
    • G05D1/65—Following a desired speed profile
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D15/00—Steering not otherwise provided for
    • B62D15/02—Steering position indicators ; Steering position determination; Steering aids
    • B62D15/025—Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D6/00—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
    • B62D6/002—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits computing target steering angles for front or rear wheels

Definitions

  • the present invention relates to a control device for a work vehicle that automatically travels along a target travel route.
  • Patent Document 1 discloses an agricultural work vehicle that automatically travels along a preset target travel route.
  • the steering mechanism is controlled so that the vehicle position calculated using GPS is directed to the target point set on the target travel route.
  • the target point is set such that the distance from the vehicle body front side to the target point becomes smaller as the lateral separation distance between the target travel route and the vehicle body front side becomes larger.
  • Patent Document 2 discloses a work vehicle in which a target steering value is calculated from a position deviation with respect to a target travel route and an azimuth deviation with respect to the target travel route, and a steering drive signal is output based on the target steering value. Specifically, the first steering value calculated based on the lateral position deviation and the calculated value derived based on the azimuth deviation are based on a value adjusted by a weighting coefficient that decreases as the position deviation increases. The target steering value is calculated from the calculated second steering value.
  • the estimated vehicle position is not the current vehicle position but the vehicle position after the predetermined traveling from the vehicle position.
  • the vehicle position is calculated, and steering control is executed based on this estimated own vehicle position.
  • the lateral deviation is the position deviation of the work vehicle in the direction orthogonal to the route direction of the target traveling route.
  • the work vehicle can perform work on the target travel route on an accurate travel locus. From this, in one of the preferred embodiments of the present invention, the estimation that calculates the distance from the estimated vehicle position in the direction orthogonal to the route direction of the target travel route to the target travel route as the estimated lateral deviation
  • a lateral deviation calculator is provided, and the deviation calculator uses the estimated lateral deviation as the deviation.
  • the azimuth deviation is an angular deviation between the extension direction of the target traveling route and the traveling direction of the work vehicle. If the azimuth deviation is large and the work vehicle is equipped with a work device that performs ground work, ground work cannot be performed properly. From this, in one of the preferred embodiments of the present invention, the estimated azimuth deviation is calculated by calculating the angle formed by the estimated traveling azimuth, which is the traveling azimuth at the estimated vehicle position, and the target traveling route as the estimated azimuth deviation. A section is provided, and the deviation calculation section uses the estimated azimuth deviation as the deviation. As a result of steering control that reduces the lateral deviation, the azimuth deviation is also basically reduced. However, in the steering control process of reducing the lateral deviation, the azimuth deviation may increase. Therefore, it is optimal to appropriately combine the steering control for reducing the azimuth deviation and the steering control for reducing the lateral deviation.
  • One specific method for calculating the estimated own vehicle position is to keep the current traveling direction and the work vehicle at a constant vehicle speed for a predetermined time. That is, the traveled position is the estimated own vehicle position.
  • a vehicle speed calculation unit that calculates a vehicle speed of the work vehicle is provided, and the own vehicle position estimation unit causes the work vehicle to travel at the vehicle speed along the traveling direction for a predetermined time.
  • the position of the work vehicle at that time is calculated as the estimated own vehicle position.
  • the predetermined time may be selectable by the user or may be automatically determined according to the working state of the work vehicle.
  • Another specific method for calculating the estimated own vehicle position is another method of calculating the estimated own vehicle position in the current steering state, in which the work vehicle is at a constant vehicle speed. That is, the position where the vehicle has traveled for a predetermined time is set as the estimated own vehicle position.
  • a vehicle speed calculation unit that calculates a vehicle speed of the work vehicle is provided, and the own vehicle position estimation unit is provided when the work vehicle travels in the steering state and the vehicle speed for a predetermined time.
  • the position of the work vehicle is calculated as the estimated own vehicle position.
  • the predetermined time may also be selectable by the user, or may be automatically determined according to the working state of the work vehicle.
  • Another specific method for calculating an estimated own vehicle position, which is the own vehicle position after a predetermined traveling, from the present own vehicle position is another method of calculating the estimated own vehicle position on the extension line of the traveling direction of the current work vehicle. This is to set a position separated from the vehicle position by a predetermined distance as the estimated own vehicle position.
  • the own vehicle position estimation unit calculates the position of the work vehicle when the work vehicle travels a predetermined distance along the traveling direction as the estimated own vehicle position.
  • the predetermined distance here may be selectable by the user or may be automatically determined according to the working state of the work vehicle.
  • Another specific method for calculating the estimated own vehicle position which is the own vehicle position after the predetermined traveling from the present own vehicle position, is another method of calculating the estimated own vehicle position on the expected traveling locus created in the current steering state. This is to set a position separated from the own vehicle position by a predetermined distance as the estimated own vehicle position.
  • the own vehicle position estimation unit calculates the position of the work vehicle when the work vehicle travels a predetermined distance in the steering state as the estimated own vehicle position.
  • the predetermined distance here may be selectable by the user or may be automatically determined according to the working state of the work vehicle.
  • FIG. 1 is a side view of a tractor which is such a work vehicle.
  • a driver's cab 20 is provided in a central portion of a vehicle body 1 supported by front wheels 11 and rear wheels 12.
  • a rotary type tiller serving as a working device 30 is equipped via a hydraulic lifting mechanism.
  • the front wheels 11 function as steering wheels, and the traveling direction of the tractor is changed by changing the steering angle.
  • the steering angle of the front wheels 11 is changed by the operation of the steering mechanism 13.
  • the steering mechanism 13 includes a steering motor 14 for automatic traveling.
  • a general-purpose data processing terminal 4 is arranged in the cab 20.
  • the data processing terminal 4 is a tablet computer including a touch panel 40 that functions as a user operation device and a notification device, and receives various operation inputs by the driver and notifies the driver of various information through the touch panel 40.
  • Fig. 2 schematically shows an example of plowing work with a tractor.
  • the traveling for performing the cultivating work while traveling along the linear work route and the turning traveling for shifting to the next linear work route are alternately repeated.
  • the first linear work route is the teaching route TL by manual traveling
  • the subsequent straight route is set to be parallel in sequence along the teaching route TL.
  • These routes are target traveling routes for automatic traveling, and are indicated by reference numerals LM(1) to LM(6) in FIG.
  • the driver manually positions the vehicle body 1 at the starting point position Ts on the edge of the ridge in the field and operates the manual operation tool 90 (hereinafter, refer to FIG. 3).
  • the driver manually runs the vehicle body 1 linearly along the ridge from the starting point position Ts, moves it to the end point position Tf near the ridge on the opposite side, and then operates the human operation tool 90 again.
  • the teaching path TL connecting the starting point position Ts and the ending point position Tf is calculated from the position coordinates of the vehicle body 1 at the starting point position Ts and the position coordinates of the vehicle body 1 at the ending point position Tf. If the azimuth of the teaching route TL is set in advance, at least a part of this teaching traveling can be performed by automatic steering.
  • 180 degree turning traveling is performed in order to move to the starting point position Ls(1) where the first target traveling route LM(1) adjacent to the teaching route TL is set.
  • the target traveling route LM(1) is set by the route setting unit 54 when the human operation tool 90 is operated.
  • the point at which the manual operation tool 90 is operated is a position suitable for plowing work (generally, a position separated from the position at which the plowing work is interrupted by an integral multiple of the working width), that is, the travel deviation.
  • the travel deviation is checked for tolerance. If the travel deviation is within the allowable range, the automatic travel targeting the set target travel route LM(1) is restarted. If the traveling deviation is outside the permissible range, automatic traveling is not started, and therefore the vehicle body 1 is manually steered so that the traveling deviation falls within the permissible range.
  • the target travel route LM(1) is a target travel route on which the vehicle body 1 first performs work travel after teaching travel.
  • the vehicle travels through the turning traveling, and the next target traveling route LM(2) from the starting point position Ls(2) is unworked on the previous target traveling route LM(1). It is set adjacent to the area side.
  • the target travel routes LM(3), LM(4), LM(5), LM( In the order of 6) are repeated with the turning travel interposed.
  • the tractor includes a satellite positioning module 8a and an inertial measurement module 8b as the positioning unit 8.
  • the satellite positioning module 8a uses a well-known GPS (Global Positioning System) as an example of a satellite positioning system (GNSS: Global Navigation Satellite System) that receives radio waves from satellites to detect the position of the vehicle body 1. Then, it has a satellite positioning function for determining the position of the vehicle body 1.
  • GPS Global Positioning System
  • GNSS Global Navigation Satellite System
  • DGPS Downlink GPS: Relative Positioning Method
  • RTK-GPS Real Time Kinematic GPS: Interfering Positioning Method
  • the inertial measurement module 8b includes a triaxial gyro sensor and a triaxial acceleration sensor.
  • the inertial measurement module 8b has a gyro sensor and an acceleration sensor, can detect the angular velocity of the turning angle of the vehicle body 1 (hereinafter, see FIG. 1), and obtains the angular displacement of the vehicle body direction by integrating the angular velocity. be able to.
  • the inertial measurement module 8b can measure not only the angular velocity of the turning angle of the vehicle body 1, but also the lateral inclination angle of the vehicle body 1, the angular velocity of the longitudinal inclination angle of the vehicle body 1, and the like.
  • the inertial measurement module 8b is arranged at a lower rear position of the driver's seat 41 (see FIG. 1) provided in the operator's cab 20 and at a lower position in the center of the vehicle body 1 in the lateral width direction.
  • the inertial measurement module 8b may be arranged at the same place as the satellite positioning module 8a.
  • the control device 5 includes an input/output processing unit 50 as an input/output interface.
  • the input/output processing unit 50 is connected to the state detector group 70, various human operation tools 90, and the like.
  • the above-described positioning unit 8 is connected to the control device 5 via an in-vehicle LAN.
  • the liquid crystal display 48 which is one of the notification devices, displays various information based on the notification signal transmitted from the notification control unit 720 incorporated in the notification unit 72.
  • the notification unit 72 is connected to the control device 5 via the vehicle-mounted LAN.
  • a state detector group 70 including various sensors and switches includes a traveling device state detector 74 and a working device state detector 75.
  • the traveling device state detector 74 includes sensors for detecting a traveling state such as a vehicle speed sensor, a steering angle sensor, an engine speed sensor, a brake pedal detection sensor, a parking brake detection sensor, and the like. ..
  • the work equipment state detector 75 includes sensors that detect the states of various mechanisms such as the lifting mechanism that make up the work device 30 (hereinafter, see FIG. 1).
  • the manual operation tool 90 is a generic term for levers, switches, buttons, volume, etc. operated by the driver, and a control command is given to the control device 5 by the operation.
  • the control device 5 includes a vehicle position calculation unit 80, a traveling direction calculation unit 81, a traveling control unit 51, a work control unit 52, a teaching management unit 53, a route setting unit 54, a vehicle speed calculation unit 55, a steering state acquisition unit 56, A steering calculation unit 6 and the like are provided.
  • the vehicle position calculation unit 80 calculates the map coordinates (vehicle position) of the vehicle body 1 based on the satellite positioning data sequentially sent from the positioning unit 8. At that time, the position directly calculated from the satellite positioning data is converted into a reference point of the vehicle body 1 (for example, the position of the vehicle body center or the work center of the work device 30).
  • the traveling azimuth calculating unit 81 processes the own vehicle position calculated by the own vehicle position calculating unit 80 with time to calculate the traveling azimuth, which is the front-back direction of the vehicle body 1.
  • the traveling control unit 51 sends a steering control signal to the steering motor 14 (see FIG. 1), and sends a shift control signal and a braking control signal to a traveling device such as a transmission (not shown). Since this tractor is capable of automatic traveling and manual traveling, the traveling control unit 51 includes an automatic traveling control unit 511, a manual traveling control unit 512, and a traveling mode management unit 513.
  • Automatic driving mode is set for automatic driving, and manual driving mode is set for manual driving.
  • Such a driving mode is managed by the driving mode management unit 513.
  • the automatic traveling control unit 511 receives automatic steering data (target steering value) from the steering calculation unit 6.
  • the work control unit 52 controls lifting and lowering of the work device 30 and power transmission to the work device 30 as the vehicle body 1 travels.
  • the teaching management unit 53 calculates data (map coordinates, etc.) of the teaching route TL based on the teaching traveling described above.
  • the route setting unit 54 sets a target traveling route (a route for straight-ahead automatic steering traveling in this embodiment) that is a target for automatic traveling, based on the procedure described with reference to FIG.
  • the vehicle speed calculator 55 calculates the vehicle speed of the tractor based on the signal from the vehicle speed sensor or the amount of change in the vehicle position over time.
  • the steering state acquisition unit 56 acquires the steering state (steering angle or the like) of the contactor based on a signal that detects the state of a steering device such as a steering sensor.
  • the steering calculation unit 6 obtains an estimated vehicle position, which is the position of the tractor after the vehicle has traveled a predetermined amount from the current vehicle position, and calculates a deviation calculated based on the estimated vehicle position (deviation related to position or deviation related to azimuth). , Or both), the target steering value is calculated and output to the automatic travel control unit 511.
  • the steering calculation unit 6 includes a vehicle position estimation unit 61, a deviation calculation unit 62, and a target steering value calculation unit 63.
  • the host vehicle position estimation unit 61 calculates an estimated host vehicle position that is the host vehicle position after the predetermined traveling from the current host vehicle position calculated by the host vehicle position calculation unit 80.
  • the deviation calculation unit 62 calculates the deviation of the work vehicle at the estimated vehicle position calculated by the vehicle position estimation unit 61 from the target travel route.
  • the target steering value calculation unit 63 calculates a target steering value that reduces the deviation based on the deviation calculated by the deviation calculation unit 62.
  • the vehicle position estimation unit 61 calculates the estimated vehicle position.
  • the vehicle body 1 at the current time point is displaced to the right side of the drawing with respect to the target travel route (indicated by TL in FIG. 5 ), and the traveling azimuth line indicating the front-back direction of the vehicle body 1 (see FIG. 5 is assigned the symbol DL) is oblique to the target travel route.
  • a position (reference numeral P1 in FIG. 5 is a position where a reference point of the vehicle body 1 (indicated by reference numeral BP in FIG. 5) is moved in the traveling direction along a traveling azimuth line by a predetermined distance set in advance. Is given as the estimated vehicle position.
  • the position where the reference point of the vehicle body 1 is moved along the traveling azimuth line at the current vehicle speed for a predetermined time set in advance is the estimated own vehicle position. To be done.
  • the reference point of the vehicle body 1 is set in advance along a predicted traveling locus (indicated by a dotted line in FIG. 5 and designated by VL) based on the steering information (steering angle) at the present time.
  • a position moved by a distance in the traveling direction, that is, a position after traveling a predetermined distance (indicated by reference numeral P3 in FIG. 5) is set as the estimated vehicle position.
  • the vehicle position estimation unit 61 employs at least one of these estimated vehicle position calculation methods or methods similar thereto to estimate the estimated vehicle position.
  • the host vehicle position estimation unit 61 may employ a plurality of estimated host vehicle position calculation methods and manually select one of them as the estimated host vehicle position, or the tractor work state may be selected. It may be automatically selected according to.
  • the predetermined distance and the predetermined time used in the vehicle position estimation unit 61 may be configured to be artificially or automatically determined, or may be automatically selected according to the working state of the tractor. Good.
  • the own vehicle position estimation unit 61 further calculates an estimated traveling direction which is the traveling direction of the vehicle body 1 at the estimated own vehicle position.
  • the deviation calculating unit 62 calculates an estimated lateral deviation that is the lateral deviation of the vehicle body 1 at the calculated estimated vehicle position and an estimated azimuth deviation that is the azimuth deviation of the vehicle body 1 at the estimated vehicle position.
  • the estimated lateral deviation is the distance from the reference point of the vehicle body 1 to the target travel route at the estimated vehicle position in the direction orthogonal to the route direction of the target travel route.
  • the estimated heading deviation is an angle formed by the estimated traveling heading and the target traveling route.
  • the deviation calculator 62 includes an estimated lateral deviation calculator 621, an estimated heading deviation calculator 622, and a calculator 623.
  • the estimated lateral deviation calculator 621 calculates the estimated lateral deviation.
  • the calculated estimated azimuth deviation is indicated by reference signs ⁇ d1 to ⁇ d4 in FIG.
  • the estimated azimuth deviation calculator 622 calculates the estimated azimuth deviation.
  • the estimated traveling direction is the same as the current traveling direction of the vehicle body 1 (indicated by ⁇ in FIG. 5).
  • the estimated traveling direction is calculated based on the traveling direction at the estimated own vehicle position on the expected traveling locus.
  • the estimated traveling directions are indicated by ⁇ 3 and ⁇ 4, respectively.
  • the computing unit 623 performs weighting calculation and the like using the estimated lateral deviation calculated by the estimated lateral deviation calculation unit 621 and the estimated azimuth deviation calculated by the estimated azimuth deviation calculation unit 622 as input parameters, and outputs the deviation. Note that either one of the estimated lateral deviation calculation unit 621 and the estimated azimuth deviation calculation unit 622 may be provided, or both may be provided and selected and used.
  • the deviation output from the deviation calculation unit 62 is input to the target steering value calculation unit 63 as an input parameter.
  • the target steering value calculation unit 63 may use the estimated lateral deviation and the estimated heading deviation as input parameters instead of the deviation output from the deviation calculation unit 62.
  • the target steering value calculation unit 63 can be constructed as a PI controller, a PID controller, or the like.
  • the steering of the vehicle body is performed by the front wheels 11 as the steered wheels, and the steering motor 14 is used as the steering device.
  • the steering device controlled by the automatic traveling control unit 511 is a device that changes the speed of the left and right crawlers.
  • the target travel route is shown as a straight line, but the target travel route may be a curved line having a large radius of curvature.
  • the teaching traveling is first performed, and the target traveling route is set based on the teaching route obtained by the teaching traveling.
  • a configuration may be adopted in which all the target travel routes are automatically generated and set based on the shape of the field, etc., without performing the teaching travel.
  • each functional unit shown in FIGS. 3 and 4 are mainly divided for the purpose of explanation. In practice, each functional unit may be integrated with another functional unit or may be divided into a plurality of functional units. Further, at least a part of the functional units built in the control device 5 may be built in the data processing terminal 4.
  • the control device 5 is not limited to the configuration provided in the vehicle body 1, but a part or all of the control device 5 may be provided outside the vehicle body 1 in a state where data communication with the vehicle body 1 is possible.
  • the control device 5 may be installed in a communication terminal or a management computer, and the communication terminal or the management computer may transmit/receive necessary information to/from the vehicle body 1.
  • the configuration of the control device 5 is arbitrary as long as the same functions and processes can be realized. Further, such a function/process is not limited to being realized by hardware, but may be realized by software. In this case, a program that realizes such a function/process is stored in an arbitrary storage unit and executed by a processor such as a CPU or an ECU provided in the control device 5 or the like.
  • control device of the present invention is mounted on the tractor, but good automatic driving performance can be obtained even when mounted on a field work vehicle such as a combine harvester or a rice transplanter.
  • the present invention is applicable to all work vehicles that automatically travel along a target travel route.

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Environmental Sciences (AREA)
  • Soil Sciences (AREA)
  • Mechanical Engineering (AREA)
  • Guiding Agricultural Machines (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

自動走行作業車のための制御装置は、自車位置を算出する自車位置算出部８０と、車体前後方向での走行方位を算出する走行方位算出部８１と、操舵状態を取得する操舵状態取得部５６と、自車位置から所定走行後の自車位置である推定自車位置を算出する自車位置推定部６１と、推定自車位置における作業車の目標走行経路に対する偏差を算出する偏差算出部６２と、偏差に基づいて目標操舵値を算出する目標操舵値算出部６３と、目標操舵値に基づいて操舵制御する自動走行制御部５１１とを備える。

Description

自動走行作業車のための制御装置
　本発明は、目標走行経路に沿って自動走行する作業車のための制御装置に関する。
　特許文献１には、予め設定された目標走行経路に沿って自動走行する農業用作業車が開示されている。この農業用作業車では、ＧＰＳを用いて算出された自車位置が目標走行経路上に設定された目標点に向かうように操向機構が制御される。その際、目標点は、目標走行経路と車体前側との横方向の離間距離が大きいほど車体前側から目標点までの距離が小さくなるように設定される。
　特許文献２には、目標走行経路に対する位置偏差及び目標走行経路に対する方位偏差とから目標操舵値を演算し、この目標操舵値に基づいて操舵駆動信号が出力される作業車が開示されている。具体的には、横位置偏差に基づいて演算された第１操舵値と、方位偏差に基づいて導出された演算値を位置偏差が大きいほどその値が小さくなる重み係数によって調整された値に基づいて演算された第２操舵値とから、目標操舵値が演算される。
日本国特開２００２－１８２７４１号公報 日本国特開２０１６－１５５４９１号公報
　特許文献１及び特許文献２による作業車では、目標走行経路から位置ずれを検出した時点で、その位置ずれを解消するための操舵角を算出し、操舵制御が行われる。このため、位置ずれが検出された時点で、時間経過とともに車体が目標走行経路に向かっていても、その時点での位置ずれが大きければ、大きな操舵角で操舵制御される。これは、過剰操舵制御による不安定な自動走行を導く。逆に、位置ずれが検出された時点で、時間経過とともに車体が目標走行経路からさらに離れていくような状況であっても、その時点での位置ずれが小さければ、小さな操舵角で操舵制御される。これは、過小操舵制御による不安定な自動走行を導く。
　上記実情から、作業車の自動走行において、目標走行経路から外れた車体を適切に戻すことができるように改善された制御装置が要望されている。
　上記課題を解決するため、目標走行経路に沿って自動走行する作業車のための制御装置は、前記作業車の自車位置を算出する自車位置算出部と、前記作業車の車体前後方向での走行方位を算出する走行方位算出部と、前記作業車の操舵状態を取得する操舵状態取得部と、前記自車位置から、所定走行後の前記自車位置である推定自車位置を算出する自車位置推定部と、前記推定自車位置における前記作業車の前記目標走行経路に対する偏差を算出する偏差算出部と、前記偏差に基づいて目標操舵値を算出する目標操舵値算出部と、前記目標操舵値に基づいて操舵制御する自動走行制御部と、を備える。
　この構成によれば、目標走行経路に沿うように車体を自動操舵する際、現状の自車位置ではなくて、当該自車位置から所定の走行が行われたのちの自車位置である推定自車位置が算出され、この推定自車位置に基づいて操舵制御が実行される。操舵制御の基準となる自車位置を先読みすることで、過小操舵制御及び過大操舵制御が抑制された操舵が行われ、適切な自動走行が実現される。
　作業車の目標走行経路に対する偏差の１つは、横偏差である。横偏差は、目標走行経路の経路方位に直交する方向での作業車の位置ずれである。横偏差を小さくすることで、作業車は、目標走行経路に正確な走行軌跡で作業を行うことができる。このことから、本発明の好適な実施形態の１つでは、前記目標走行経路の経路方位に直交する方向での前記推定自車位置から前記目標走行経路までの距離を推定横偏差として算出する推定横偏差算出部が備えられ、前記偏差算出部は、前記偏差として前記推定横偏差を用いる。
　作業車の目標走行経路に対する偏差の１つは、方位偏差である。方位偏差は、目標走行経路の延び方向と作業車の走行方向との間の角度ずれである。方位偏差が大きく、しかも作業車が対地作業を行う作業装置を搭載している場合、適切に対地作業が行われなくなる。このことから、本発明の好適な実施形態の１つでは、前記推定自車位置における前記走行方位である推定走行方位と前記目標走行経路とがなす角度を推定方位偏差として算出する推定方位偏差算出部が備えられ、前記偏差算出部は、前記偏差として前記推定方位偏差を用いる。なお、横偏差を縮小するような操舵制御の結果、基本的には方位偏差も縮小する。しかしながら、横偏差を縮小する操舵制御過程において、方位偏差が拡大することもある。このため、方位偏差を縮小する操舵制御と横偏差を縮小する操舵制御とを適切に組み合わせることが最適である。
　現時点の自車位置から、所定走行後の自車位置である推定自車位置を算出するための具体的は方法の１つは、現状の走行方位のままで、作業車が一定車速で所定時間走行した位置を推定自車位置とすることである。これを実践する本発明の実施形態では、前記作業車の車速を算出する車速算出部が備えられ、前記自車位置推定部は、前記作業車が前記走行方位に沿って前記車速で所定時間走行した際の前記作業車の位置を前記推定自車位置として算出する。所定時間は、ユーザによって選択可能としてもよいし、作業車による作業状態に応じて自動的に決定されるようにしてもよい。
　現時点の自車位置から、所定走行後の自車位置である推定自車位置を算出するための具体的は方法の他の１つは、現状の操舵状態のままで、作業車が一定車速で所定時間走行した位置を推定自車位置とすることである。これを実践する本発明の実施形態では、前記作業車の車速を算出する車速算出部が備えられ、前記自車位置推定部は、前記作業車が前記操舵状態及び前記車速で所定時間走行した際の前記作業車の位置を前記推定自車位置として算出する。ここでは、所定時間も、ユーザによって選択可能としてもよいし、作業車による作業状態に応じて自動的に決定されるようにしてもよい。
　現時点の自車位置から、所定走行後の自車位置である推定自車位置を算出するための具体的は方法の他の１つは、現状の作業車の走行方位の延長線上で現状の自車位置から所定距離だけ離れた位置を推定自車位置とすることである。これを実践する本発明の実施形態では、前記自車位置推定部は、前記走行方位に沿って前記作業車が所定距離走行した際の前記作業車の位置を前記推定自車位置として算出する。ここでの所定距離は、ユーザによって選択可能としてもよいし、作業車による作業状態に応じて自動的に決定されるようにしてもよい。
　現時点の自車位置から、所定走行後の自車位置である推定自車位置を算出するための具体的は方法の他の１つは、現状の操舵状態で作り出される予想走行軌跡上で現状の自車位置から所定距離だけ離れた位置を推定自車位置とすることである。これを実践する本発明の実施形態では、前記自車位置推定部は、前記操舵状態で前記作業車が所定距離走行した際の前記作業車の位置を前記推定自車位置として算出する。ここでの所定距離も、ユーザによって選択可能としてもよいし、作業車による作業状態に応じて自動的に決定されるようにしてもよい。
目標走行経路に沿って自動走行するトラクタの側面図である。 トラクタによる耕耘作業における走行経路を説明するための模式図である。 トラクタの制御系の機能ブロック図である。 推定演算ユニットの機能とデータの流れを示す機能ブロック図である。 推定自車位置、推定横偏差、推定方位偏差を説明するための模式図である。
　次に、図面を用いて、本発明による制御装置を搭載して、目標走行経路に沿って自動走行する作業車の実施形態の１つを説明する。図１は、そのような作業車であるトラクタの側面図である。図１に示されているように、このトラクタは、前輪１１と後輪１２とによって支持された車体１の中央部に運転室２０が設けられている。車体１の後部には油圧式の昇降機構を介して作業装置３０としてのロータリ式の耕耘装置が装備されている。前輪１１は操向輪として機能し、その操舵角を変更することでトラクタの走行方向が変更される。前輪１１の操舵角は操舵機構１３の動作によって変更される。操舵機構１３には自動走行のための操舵モータ１４が含まれている。手動走行の際には、前輪１１の操舵は運転室２０に配置されているステアリングホイール２２の操作によって行われる。このトラクタは、自車位置を検出するために、測位ユニット８を備えている。運転室２０には、汎用型のデータ処理端末４が配置されている。このデータ処理端末４は、ユーザ操作デバイス及び報知デバイスとして機能するタッチパネル４０を備えたタブレット型コンピュータであり、タッチパネル４０を通じて、運転者による各種操作入力の受け入れ、運転者へ種々の情報を報知する。
　図２には、トラクタによる耕耘作業の一例が模式的に示されている。この耕耘作業では、直線状の作業経路に沿って走行しながら耕耘作業を行う走行と、次の直線状の作業経路に移行するための旋回走行とが交互に繰り返される。その際、最初の直線状の作業経路は、手動走行によるティーチング経路ＴＬであり、次からの直線状の経路は、順次、ティーチング経路ＴＬに沿って並列するように設定される。これらの経路は、自動走行のための目標走行経路であり、図２では、符号ＬＭ（１）～ＬＭ（６）で示されている。
　次に、この耕耘作業の走行プロセスを説明する。耕耘作業を開始するにあたって、運転者は、手動で車体１を圃場内の畦際の始点位置Ｔｓに位置させ、人為操作具９０（以下いずれも図３参照）を操作する。運転者が手動で、始点位置Ｔｓから畦に沿って直線状に車体１を走行させ、反対側の畦際近くの終点位置Ｔｆまで移動させてから人為操作具９０を再度操作する。これにより、始点位置Ｔｓにおける車体１の位置座標と終点位置Ｔｆにおける車体１の位置座標とから、始点位置Ｔｓと終点位置Ｔｆとを結ぶティーチング経路ＴＬが算出される。なお、ティーチング経路ＴＬの方位が前もって設定されている場合には、このティーチング走行の少なくとも一部は自動操舵で行うことも可能である。
　ティーチング経路ＴＬの設定完了後、ティーチング経路ＴＬに隣接する、最初の目標走行経路ＬＭ（１）が設定される始点位置Ｌｓ（１）に移行するために、１８０度の旋回走行が行われる。
　この旋回走行が終了し、車体１が次の耕耘作業に適した姿勢になれば、人為操作具９０が操作されると、目標走行経路ＬＭ（１）が経路設定部５４によって設定される。その際、人為操作具９０が操作された地点が耕耘作業に適した位置（一般的には、耕耘作業が中断された位置から作業幅の整数倍離れた位置）であるかどうか、つまり走行ずれが許容範囲であるかどうかがチェックされる。その走行ずれが許容範囲内であれば、設定された目標走行経路ＬＭ（１）を目標とする自動走行が再開される。走行ずれが許容範囲外であれば、自動走行が開始されないので、車体１の走行ずれが許容範囲内に入るように手動操舵される。
　自動走行が開始されると、車体１が目標走行経路ＬＭ（１）に沿うように、自動操舵が行われる。目標走行経路ＬＭ（１）は、ティーチング走行後に車体１が最初に作業走行を行う目標走行経路である。目標走行経路ＬＭ（１）に沿った自動走行が終了すると、旋回走行を経て、始点位置Ｌｓ（２）から次の目標走行経路ＬＭ（２）が先の目標走行経路ＬＭ（１）の未作業領域側に隣接して設定される。同様なプロセスで、始点位置Ｌｓ（３）、Ｌｓ（４）、Ｌｓ（５）、Ｌｓ（６）から、それぞれ、目標走行経路ＬＭ（３），ＬＭ（４），ＬＭ（５），ＬＭ（６）の順番で、旋回走行を挟んで、目標走行経路の設定と、作業走行とが繰り返される。
　次に、図３を用いて、トラクタの制御系における、本発明に特に関係する機能部を説明する。
　このトラクタは、測位ユニット８として、衛星測位モジュール８ａと、慣性計測モジュール８ｂとを備えている。衛星測位モジュール８ａは、衛星からの電波を受信して車体１の位置を検出する衛星測位用システム（ＧＮＳＳ：Ｇｌｏｂａｌ　Ｎａｖｉｇａｔｉｏｎ　Ｓａｔｅｌｌｉｔｅ　Ｓｙｓｔｅｍ）の一例として、周知の技術であるＧＰＳ（Ｇｌｏｂａｌ　Ｐｏｓｉｔｉｏｎｉｎｇ　Ｓｙｓｔｅｍ）を利用して、車体１の位置を求める衛星測位機能を有する。本実施形態では、衛星測位として、ＤＧＰＳ（Ｄｉｆｆｅｒｅｎｔｉａｌ　ＧＰＳ：相対測位方式）が採用されているが、ＲＴＫ－ＧＰＳ（Ｒｅａｌ　Ｔｉｍｅ　Ｋｉｎｅｍａｔｉｃ　ＧＰＳ：干渉測位方式）などの他の方式を採用することも可能である。慣性計測モジュール８ｂは、３軸ジャイロセンサ及び３軸加速度センサを含んでいる。
　慣性計測モジュール８ｂは、ジャイロセンサや加速度センサを有し、車体１（以下、いずれも図１参照）の旋回角度の角速度を検出可能であり、角速度を積分することで車体方位の角度変位を求めることができる。慣性計測モジュール８ｂは、車体１の旋回角度の角速度の他、車体１の左右傾斜角度、車体１の前後傾斜角度の角速度等も計測可能である。慣性計測モジュール８ｂは、運転室２０に設けられる運転座席４１（図１参照）の後側下方位置であって車体１の横幅方向中央の低い位置に配置されている。慣性計測モジュール８ｂは衛星測位モジュール８ａと同じ場所に配置されてもよい。
　制御装置５は、入出力インタフェースとして、入出力処理部５０を備えている。入出力処理部５０は、状態検出器群７０や種々の人為操作具９０などと接続している。この機能ブロック図では、上述した測位ユニット８は、車載ＬＡＮを介して制御装置５と接続している。報知機器の１つである液晶ディスプレイ４８は、報知ユニット７２に組み込まれている報知制御部７２０から送信される報知信号に基づいて、種々の情報を表示する。報知ユニット７２は、車載ＬＡＮを介して制御装置５と接続している。
　種々のセンサやスイッチなどからなる状態検出器群７０には、走行機器状態検出器７４と作業機器状態検出器７５とが含まれている。走行機器状態検出器７４には、図示されていないが、車速センサ、操舵角センサ、エンジン回転数センサ、ブレーキペダル検出センサ、駐車ブレーキ検出センサ、などの走行状態を検出するセンサが含まれている。作業機器状態検出器７５には、作業装置３０（以下、いずれも図１参照）を構成する昇降機構などの各種機構の状態を検出するセンサが含まれている。
　人為操作具９０は、運転者によって操作されるレバー、スイッチ、ボタン、ボリュームなど総称であり、その操作によって制御指令が制御装置５に与えられる。
　制御装置５には、自車位置算出部８０、走行方位算出部８１、走行制御部５１、作業制御部５２、ティーチング管理部５３、経路設定部５４、車速算出部５５、操舵状態取得部５６、操舵演算ユニット６などが備えられている。
　自車位置算出部８０は、測位ユニット８から逐次送られてくる衛星測位データに基づいて、車体１の地図座標（自車位置）を算出する。その際、衛星測位データから直接算出される位置が、車体１の基準点（例えば車体中心や作業装置３０の作業中心の位置）に変換される。走行方位算出部８１は、自車位置算出部８０によって算出された自車位置を経時的に処理して、車体１の前後方向での向きである走行方位を算出する。
　走行制御部５１は、操舵制御信号を操舵モータ１４（図１参照）に送り、変速制御信号や制動制御信号を図示されていないトランスミッションなどの走行機器に送る。このトラクタは、自動走行と手動走行とが可能であるので、走行制御部５１には、自動走行制御部５１１と手動走行制御部５１２と走行モード管理部５１３とが含まれている。
　自動運転を行うために、自動走行モードが設定され、手動運転を行うためには手動走行モードが設定される。このような走行モードは、走行モード管理部５１３によって管理される。自動走行モードが設定されている場合、自動走行制御部５１１は操舵演算ユニット６から自動操舵データ（目標操舵値）を受け取る。
　作業制御部５２は、車体１の走行に伴って作業装置３０の昇降や作業装置３０への動力伝達を制御する。
　ティーチング管理部５３は、上述したティーチング走行に基づいて、ティーチング経路ＴＬのデータ（地図座標など）を算出する。経路設定部５４は、図２を用いて説明した手順に基づいて、自動走行の目標となる目標走行経路（この実施形態では直進自動操舵走行のための経路）を設定する。
　車速算出部５５は、車速センサからの信号、または経時的な自車位置の変化量に基づいてトラクタの車速を算出する。操舵状態取得部５６は、操舵センサなどの操舵機器の状態を検出する信号に基づいて、トタクタの操舵状態（操舵角など）を取得する。
　操舵演算ユニット６は、現状の自車位置から所定走行した後のトラクタの位置である推定自車位置を求め、この推定自車位置に基づいて算出された偏差（位置に関する偏差、または方位に関する偏差、あるいはその両方）に基づいて目標操舵値を算出し、自動走行制御部５１１に出力する。
　操舵演算ユニット６は、図４に示されているように、自車位置推定部６１と、偏差算出部６２と、目標操舵値算出部６３とを備えている。自車位置推定部６１は、自車位置算出部８０によって算出された現状の自車位置から、所定走行後の前記自車位置である推定自車位置を算出する。偏差算出部６２は、自車位置推定部６１によって算出された推定自車位置における前記作業車の前記目標走行経路に対する偏差を算出する。目標操舵値算出部６３は、偏差算出部６２によって算出された偏差に基づいて、その偏差が小さくなる目標操舵値を算出する。
　自車位置推定部６１が推定自車位置を算出するいくつかの方法を、図５を用いて説明する。図５では、現時点の車体１は、目標走行経路（図５では符号ＴＬが付与されている）に対して紙面右側にずれており、車体１の前後方向での向きを示す走行方位線（図５では符号ＤＬが付与されている）は、目標走行経路に対して斜めとなっている。
（１）車体１の基準点（図５では符号ＢＰが付与されている）を、走行方位線に沿って、予め設定された所定距離だけ走行方向に移動させた位置（図５では符号Ｐ１が付与されている）が推定自車位置とされる。
（２）車体１の基準点を、走行方位線に沿って、現時点の車速で予め設定された所定時間だけ移動させた位置（図５では符号Ｐ２が付与されている）が推定自車位置とされる。
（３）車体１の基準点を、現時点での操舵情報（操舵角）に基づく予想走行軌跡（図５では点線で示され、符号ＶＬが付与されている）に沿って、予め設定された所定距離だけ走行方向に移動させた位置、つまり所定距離走行した後の位置（図５では符号Ｐ３が付与されている）が推定自車位置とされる。
（４）車体１の基準点を、現時点での操舵情報（操舵角）に基づく予想走行軌跡に沿って、現時点の車速で予め設定された所定時間だけ移動させた位置（図５では符号Ｐ４が付与されている）が推定自車位置とされる。
　自車位置推定部６１は、これらの推定自車位置算出方法またはそれに類似する方法の少なくとも１つを採用して、推定自車位置を推定する。あるいは、自車位置推定部６１は、複数の推定自車位置算出方法を採用して、そのうちの１つを推定自車位置として、人為選択できるように構成してもよいし、トラクタの作業状態に応じて自動的に選択してもよい。さらに、自車位置推定部６１で用いられる所定距離や所定時間も、人為的または自動的に決定されるように構成してもよいし、トラクタの作業状態に応じて自動的に選択されてもよい。自車位置推定部６１は、さらに、推定自車位置における車体１の走行方位である推定走行方位も算出する。
　偏差算出部６２は、算出された推定自車位置における車体１の横偏差である推定横偏差と、推定自車位置における車体１の方位偏差である推定方位偏差とを算出する。推定横偏差は、目標走行経路の経路方位に直交する方向での推定自車位置における車体１の基準点から目標走行経路までの距離である。推定方位偏差は、推定走行方位と目標走行経路とがなす角度である。
　この実施形態では、偏差算出部６２は、推定横偏差算出部６２１と推定方位偏差算出部６２２と演算器６２３とを備えている。推定横偏差算出部６２１は、推定横偏差を算出する。算出される推定方位偏差は、図５において、符号Δｄ１～Δｄ４で示されている。推定方位偏差算出部６２２は、推定方位偏差を算出する。上記（１）、（２）では、推定走行方位は、現状の車体１の走行方位（図５ではθで示されている）と同じである。上記（３）、（４）では、推定走行方位は、予想走行軌跡上の推定自車位置における走行方位に基づいて算出される。図５では、推定走行方位は、それぞれ、θ３、θ４で示されている。
　演算器６２３は、推定横偏差算出部６２１で算出された推定横偏差及び推定方位偏差算出部６２２で算出された推定方位偏差を入力パラメータとして、重み演算などを行い、偏差を出力する。なお、推定横偏差算出部６２１と推定方位偏差算出部６２２のいずれか一方だけが備えられてもよいし、両方を備えて選択して利用するようにしてもよい。
　偏差算出部６２から出力された偏差は、入力パラメータとして目標操舵値算出部６３に入力される。なお、目標操舵値算出部６３は、偏差算出部６２から出力される偏差に代えて、推定横偏差と推定方位偏差とを入力パラメータとして利用してもよい。目標操舵値算出部６３は、ＰＩ制御器やＰＩＤ制御器などとして構築することができる。
〔別実施の形態〕
　（１）上述した実施形態では、車体の操向は、操舵輪としての前輪１１によって行われ、操舵機器として、操舵モータ１４が用いられていた。操舵方式として、操舵輪に代えてクローラ式の走行装置が用いられた場合は、自動走行制御部５１１によって制御される操舵機器は、左右のクローラの速度を変更する機器である。
　（２）上述した実施形態では、目標走行経路が直線で示されていたが、目標走行経路が大きな曲率半径をもつ湾曲線であってもよい。
　（３）上述した実施形態では、最初にティーチング走行を実施し、ティーチング走行で得られたティーチング経路に基づいて目標走行経路が設定された。これに代えて、ティーチング走行は行われずに、圃場の形状等から自動的にすべての目標走行経路を生成して設定するような構成を採用してもよい。
　（４）図３及び図４で示された各機能部は、主に説明目的で区分けされている。実際には、各機能部は他の機能部と統合されてもよいし、または複数の機能部に分けられてもよい。さらに、制御装置５に構築された機能部のうち少なくとも一部の機能部は、データ処理端末４に構築されてもよい。
　（５）制御装置５は車体１に設けられる構成に限らず、その一部または全部が、車体１とデータ通信可能な状態で、車体１の外部に設けられても良い。例えば、制御装置５は、通信端末や管理コンピュータに搭載され、通信端末や管理コンピュータが、車体１との間で、必要な情報の送受信を行う構成としても良い。
　（６）同様の機能・工程が実現できれば、制御装置５の構成は任意である。また、このような機能・工程はハードウェアで実現される場合に限らず、ソフトウエアにより実現されても良い。この場合、このような機能・工程を実現するプログラムは任意の記憶部に記憶され、制御装置５等に設けられる、ＣＰＵやＥＣＵ等のプロセッサにより実行される。
　（７）上述した実施形態では、本発明の制御装置はトラクタに搭載されていたが、コンバインや田植機などの圃場作業車に搭載しても、良好な自動走行性能が得られる。
　本発明は、目標走行経路に沿って自動走行する作業車のための全てに適用可能である。
１　　　：車体
４　　　：データ処理端末
８　　　：測位ユニット
８ａ　　：衛星測位モジュール
８ｂ　　：慣性計測モジュール
１１　　：前輪
１２　　：後輪
１３　　：操舵機構
１４　　：操舵モータ
２０　　：運転室
２２　　：ステアリングホイール
３０　　：作業装置
４０　　：タッチパネル
４１　　：運転座席
４８　　：液晶ディスプレイ
５　　　：制御装置
５０　　：入出力処理部
５１　　：走行制御部
５１１　：自動走行制御部
５１２　：手動走行制御部
５１３　：走行モード管理部
５２　　：作業制御部
５３　　：ティーチング管理部
５４　　：経路設定部
５５　　：車速算出部
５６　　：操舵状態取得部
６　　　：操舵演算ユニット
６１　　：自車位置推定部
６２　　：偏差算出部
６２１　：推定横偏差算出部
６２２　：推定方位偏差算出部
６２３　：演算器
６３　　：目標操舵値算出部
７０　　：状態検出器群
７２　　：報知ユニット
７２０　：報知制御部
７４　　：走行機器状態検出器
７５　　：作業機器状態検出器
８０　　：自車位置算出部
８１　　：走行方位算出部
９０　　：人為操作具
ＬＭ　　：目標走行経路
ＴＬ　　：ティーチング経路
Ｔｆ　　：終点位置
Ｔｓ　　：始点位置
 

Claims (11)

  1. 　目標走行経路に沿って自動走行する作業車のための制御装置であって、
    　前記作業車の自車位置を算出する自車位置算出部と、
    　前記作業車の車体前後方向での走行方位を算出する走行方位算出部と、
    　前記作業車の操舵状態を取得する操舵状態取得部と、
    　前記自車位置から、所定走行後の前記自車位置である推定自車位置を算出する自車位置推定部と、
    　前記推定自車位置における前記作業車の前記目標走行経路に対する偏差を算出する偏差算出部と、
    　前記偏差に基づいて目標操舵値を算出する目標操舵値算出部と、
    　前記目標操舵値に基づいて操舵制御する自動走行制御部と、を備えた制御装置。
  2. 　前記目標走行経路の経路方位に直交する方向での前記推定自車位置から前記目標走行経路までの距離を推定横偏差として算出する推定横偏差算出部が備えられ、
    　前記偏差算出部は、前記偏差として前記推定横偏差を用いる請求項１に記載の制御装置。
  3. 　前記推定自車位置における前記走行方位である推定走行方位と前記目標走行経路とがなす角度を推定方位偏差として算出する推定方位偏差算出部が備えられ、
    　前記偏差算出部は、前記偏差として前記推定方位偏差を用いる請求項１または２に記載の制御装置。
  4. 　前記作業車の車速を算出する車速算出部が備えられ、
    　前記自車位置推定部は、前記作業車が前記走行方位に沿って前記車速で所定時間走行した際の前記作業車の位置を前記推定自車位置として算出する請求項１から３のいずれか一項に記載の制御装置。
  5. 　前記作業車の車速を算出する車速算出部が備えられ、
    　前記自車位置推定部は、前記作業車が前記操舵状態及び前記車速で所定時間走行した際の前記作業車の位置を前記推定自車位置として算出する請求項１から３のいずれか一項に記載の制御装置。
  6. 　前記所定時間は、ユーザによって選択可能である請求項４または５に記載の制御装置。
  7. 　前記所定時間は、前記作業車による作業状態に応じて自動的に決定される請求項４または５に記載の制御装置。
  8. 　前記自車位置推定部は、前記走行方位に沿って前記作業車が所定距離走行した際の前記作業車の位置を前記推定自車位置として算出する請求項１から３のいずれか一項に記載の制御装置。
  9. 　前記自車位置推定部は、前記操舵状態で前記作業車が所定距離走行した際の前記作業車の位置を前記推定自車位置として算出する請求項１から３のいずれか一項に記載の制御装置。
  10. 　前記所定距離は、ユーザによって選択可能である請求項８または９に記載の制御装置。
  11. 　前記所定距離は、前記作業車による作業状態に応じて自動的に決定される請求項８または９に記載の制御装置。
PCT/JP2019/048044 2018-12-20 2019-12-09 自動走行作業車のための制御装置 WO2020129722A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
EP19897852.0A EP3900505B1 (en) 2018-12-20 2019-12-09 Control device for automatic travel work vehicle
US17/297,526 US11937526B2 (en) 2018-12-20 2019-12-09 Control device for work vehicle configured to travel autonomously

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2018-238895 2018-12-20
JP2018238895A JP7072496B2 (ja) 2018-12-20 2018-12-20 自動走行作業車のための制御装置

Publications (1)

Publication Number Publication Date
WO2020129722A1 true WO2020129722A1 (ja) 2020-06-25

Family

ID=71100769

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2019/048044 WO2020129722A1 (ja) 2018-12-20 2019-12-09 自動走行作業車のための制御装置

Country Status (4)

Country Link
US (1) US11937526B2 (ja)
EP (1) EP3900505B1 (ja)
JP (1) JP7072496B2 (ja)
WO (1) WO2020129722A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP4357871A4 (en) * 2021-06-18 2024-10-23 Beijing Indemind Tech Co Ltd METHOD AND DEVICE FOR EXECUTING ROBOT TASKS, ROBOT AND STORAGE MEDIUM

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6766240B1 (ja) * 2019-09-06 2020-10-07 株式会社クボタ 作業車両
CN114830018A (zh) 2019-12-17 2022-07-29 株式会社Xtia 光谐振器、光调制器及它们的制作方法、光频梳产生器、光振荡器
CN111767507A (zh) * 2020-06-30 2020-10-13 北京百度网讯科技有限公司 一种倒车轨迹追踪方法、装置、电子设备及存储介质
CN112678726B (zh) * 2020-12-18 2022-07-29 江苏智库智能科技有限公司 基于叉车式agv运动学模型的取货定位方法及系统
CN118695903A (zh) 2022-01-21 2024-09-24 株式会社科特拉 排气净化用催化剂
US20230311988A1 (en) * 2022-03-31 2023-10-05 Caterpillar Inc. Systems and methods for machine steering
JP2024116593A (ja) * 2023-02-16 2024-08-28 ヤンマーホールディングス株式会社 自動操舵方法、自動操舵システム、及び自動操舵プログラム

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06300580A (ja) * 1993-04-15 1994-10-28 Fuji Heavy Ind Ltd 車輛の軌道追従制御装置
JP2002182741A (ja) 2000-12-19 2002-06-26 Yanmar Agricult Equip Co Ltd 農業用作業車
JP2010126077A (ja) * 2008-11-28 2010-06-10 Jtekt Corp 走行支援装置
JP2016146061A (ja) * 2015-02-06 2016-08-12 国立研究開発法人農業・食品産業技術総合研究機構 走行制御装置
JP2016155491A (ja) 2015-02-25 2016-09-01 株式会社クボタ 自動走行作業車両
JP2018148858A (ja) * 2017-03-14 2018-09-27 株式会社クボタ 作業車

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2573939B2 (ja) 1987-02-16 1997-01-22 株式会社クボタ 自動走行作業車の走行制御装置

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06300580A (ja) * 1993-04-15 1994-10-28 Fuji Heavy Ind Ltd 車輛の軌道追従制御装置
JP2002182741A (ja) 2000-12-19 2002-06-26 Yanmar Agricult Equip Co Ltd 農業用作業車
JP2010126077A (ja) * 2008-11-28 2010-06-10 Jtekt Corp 走行支援装置
JP2016146061A (ja) * 2015-02-06 2016-08-12 国立研究開発法人農業・食品産業技術総合研究機構 走行制御装置
JP2016155491A (ja) 2015-02-25 2016-09-01 株式会社クボタ 自動走行作業車両
JP2018148858A (ja) * 2017-03-14 2018-09-27 株式会社クボタ 作業車

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
See also references of EP3900505A4

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP4357871A4 (en) * 2021-06-18 2024-10-23 Beijing Indemind Tech Co Ltd METHOD AND DEVICE FOR EXECUTING ROBOT TASKS, ROBOT AND STORAGE MEDIUM

Also Published As

Publication number Publication date
JP7072496B2 (ja) 2022-05-20
US20220007563A1 (en) 2022-01-13
EP3900505A4 (en) 2022-09-14
EP3900505B1 (en) 2024-08-14
US11937526B2 (en) 2024-03-26
EP3900505A1 (en) 2021-10-27
JP2020099226A (ja) 2020-07-02

Similar Documents

Publication Publication Date Title
WO2020129722A1 (ja) 自動走行作業車のための制御装置
JP6766006B2 (ja) 自動操舵システム
CN109154817B (zh) 自动行驶作业车辆
JP7550281B2 (ja) 自動走行システム及び自動走行方法
JP2019165665A (ja) 作業車両用の自動走行システム
JP2017187394A (ja) 測位検出装置及び測位検出装置を備えた作業機
JP7479425B2 (ja) 走行作業機
JP7206105B2 (ja) 圃場作業車
JP6850759B2 (ja) 自律操舵装置
JP2024053067A (ja) 自動走行システム及び自動走行方法
JP6871831B2 (ja) 作業車両用の自律走行システム
JP6945353B2 (ja) 自動走行作業車
JP7386757B2 (ja) 作業車両の自律走行システム
JP2019053471A (ja) 作業車両用の自律走行システム
WO2020129704A1 (ja) 走行作業機
JP6964735B2 (ja) 自動操舵システム
JP7246918B2 (ja) 走行状態表示装置、及び、自動走行システム
JP2020164160A (ja) 自動走行圃場作業車両
JP7094833B2 (ja) 走行経路表示装置
JP2020137463A (ja) 自律走行システム
WO2022149389A1 (ja) 自動走行システム及び自動走行方法
JP7068969B2 (ja) 自動走行システム
JP2023110557A (ja) 自動操舵システム

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 19897852

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

ENP Entry into the national phase

Ref document number: 2019897852

Country of ref document: EP

Effective date: 20210720