WO2020111102A1 - 自動走行制御システム、自動走行制御プログラム、自動走行制御プログラムを記録した記録媒体、自動走行制御方法、制御装置、制御プログラム、制御プログラムを記録した記録媒体、制御方法 - Google Patents

自動走行制御システム、自動走行制御プログラム、自動走行制御プログラムを記録した記録媒体、自動走行制御方法、制御装置、制御プログラム、制御プログラムを記録した記録媒体、制御方法 Download PDF

Info

Publication number
WO2020111102A1
WO2020111102A1 PCT/JP2019/046320 JP2019046320W WO2020111102A1 WO 2020111102 A1 WO2020111102 A1 WO 2020111102A1 JP 2019046320 W JP2019046320 W JP 2019046320W WO 2020111102 A1 WO2020111102 A1 WO 2020111102A1
Authority
WO
WIPO (PCT)
Prior art keywords
work vehicle
traveling
vehicle
target
control
Prior art date
Application number
PCT/JP2019/046320
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
Priority claimed from JP2018223783A external-priority patent/JP7213670B2/ja
Priority claimed from JP2018225679A external-priority patent/JP7206099B2/ja
Application filed by 株式会社クボタ filed Critical 株式会社クボタ
Priority to KR1020217013339A priority Critical patent/KR20210093240A/ko
Priority to CN201980074222.9A priority patent/CN113039501A/zh
Publication of WO2020111102A1 publication Critical patent/WO2020111102A1/ja

Links

Images

Classifications

    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01BSOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B69/00Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
    • A01B69/007Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow
    • A01B69/008Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow automatic
    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01BSOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B69/00Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions

Definitions

  • the present invention relates to an automatic traveling control system that controls automatic traveling of a work vehicle.
  • the present invention also relates to a control device for a work vehicle that automatically travels along a target travel route.
  • Patent Document 1 describes an invention of a work vehicle (“combin” in Patent Document 1) capable of automatic traveling.
  • the operator manually operates the combine at the beginning of the harvesting work, and carries out the mowing traveling so as to go around the outer peripheral portion in the field.
  • the direction in which the work vehicle should travel is recorded. Then, by the automatic traveling based on the recorded azimuth, the mowing traveling in the uncut area in the field is performed.
  • Patent Document 2 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 distance from the front part of the vehicle body to the target point is set to be smaller as the length of the perpendicular line (lateral deviation) drawn from the front part of the vehicle body to the target travel route is larger.
  • the target steering value is calculated based on the lateral deviation with respect to the target traveling route and the bearing deviation with respect to the target traveling route. Then, a steering drive signal is output based on this target steering value. Specifically, the target steering value is calculated from the first steering value and the second steering value. The first steering value is calculated based on the lateral deviation. The second steering value is calculated based on a value obtained by adjusting the calculated value derived based on the heading deviation with a weighting coefficient. The larger the lateral deviation, the smaller this weighting factor.
  • Patent Document 1 does not describe the calculation of the turning output of the work vehicle in detail.
  • the turning output is an output value for determining the control amount of the traveling device for turning the work vehicle.
  • the control amount of the traveling device is determined based on the turning output.
  • the turning output is calculated based on the lateral deviation that is the distance between the target travel route and the work vehicle so that the work vehicle automatically travels along the target travel route. It is conceivable to provide a traveling control unit that controls traveling of the work vehicle by doing so. With this configuration, the turning output is calculated based on the lateral deviation.
  • the appropriate turning output differs depending on the condition of the work vehicle. That is, in a configuration in which the correspondence between the lateral deviation and the turning output is constant regardless of the state of the work vehicle, it is assumed that the turning output does not have an appropriate value.
  • An object of the present invention is to provide an automatic driving control system capable of calculating a turning output according to the state of a work vehicle.
  • a feature of the present invention is that a route calculation unit that calculates a target travel route that passes through an unworked area and a route between the target travel route and the work vehicle are provided so that the work vehicle automatically travels along the target travel route.
  • a travel control unit that controls travel of the work vehicle by calculating a turning output based on a lateral deviation that is a distance; and a detection unit that detects a state of the work vehicle, the travel control unit including: When the work vehicle enters the unworked area from the already-worked area, the correspondence between the lateral deviation and the turning output is determined based on the state detected by the detection unit.
  • the correspondence between the lateral deviation and the turning output is determined based on the state of the work vehicle. Therefore, it is possible to realize an automatic travel control system capable of calculating the turning output according to the state of the work vehicle.
  • the detection unit detects the lateral deviation
  • the traveling control unit determines that the lateral deviation is a first threshold value when the work vehicle enters the unworked area from the already worked area.
  • the correspondence relationship between the lateral deviation and the turning output is determined to be the first correspondence relationship
  • the traveling control unit when the work vehicle enters the unworked area from the already worked area,
  • the correspondence between the lateral deviation and the turning output is determined to be a second correspondence, and the turning output in the first correspondence is in the second correspondence. It is preferable that it is smaller than the turning output.
  • the traveling control unit controls the work vehicle when the lateral deviation exceeds a second threshold value when the work vehicle enters the unworked area from the already-worked area while turning. It is preferable that the vehicle be moved backward and then forward again to perform retry travel, which is an attempt to enter the unworked area.
  • the travel control unit determines a correspondence relationship between the lateral deviation and the turning output to be a third correspondence relationship when the retry travel is performed, and the turning control in the third correspondence relationship is performed.
  • the output is preferably larger than the turning output in the first correspondence relationship.
  • the turning output tends to be relatively large when the retry running is being performed. This makes it easier for the work vehicle to quickly approach the target travel route during retry travel.
  • the traveling control unit does not allow the work vehicle to perform the retry traveling when the lateral deviation exceeds the second threshold value at the start of automatic traveling.
  • the retry running is not performed at the start of automatic running. As a result, it is possible to avoid the situation where the operator feels uncomfortable as described above.
  • Another feature of the present invention is an automatic traveling control program, a route calculation function for calculating a target traveling route passing through an unworked area, and a work vehicle automatically traveling along the target traveling route, A travel control function that controls the travel of the work vehicle by calculating a turning output based on a lateral deviation that is a distance between the target travel route and the work vehicle, and a detection function that detects a state of the work vehicle.
  • the traveling control function is configured to perform the lateral deviation and the turning output based on a state detected by the detection function. To determine the correspondence with.
  • Another feature of the present invention is a recording medium in which an automatic traveling control program is recorded, the route calculating function for calculating a target traveling route passing through an unworked area, and a work vehicle automatically operating along the target traveling route.
  • a traveling control function for controlling traveling of the work vehicle by calculating a turning output based on a lateral deviation that is a distance between the target traveling route and the work vehicle so as to travel, and a state of the work vehicle.
  • a detection function for detecting the following.
  • An automatic traveling control program for causing a computer to realize is detected by the detection function when the work vehicle enters the unworked area from the already worked area. The correspondence between the lateral deviation and the turning output is determined based on the determined state.
  • another feature of the present invention is an automatic traveling control method, wherein a route calculating step of calculating a target traveling route passing through an unworked area, and a work vehicle automatically traveling along the target traveling route, A travel control step of controlling travel of the work vehicle by calculating a turning output based on a lateral deviation that is a distance between the target travel route and the work vehicle, and a detection step of detecting a state of the work vehicle.
  • the traveling control step when the work vehicle enters the unworked area from the already-worked area, the correspondence between the lateral deviation and the turning output is based on the state detected by the detection step. Is to be decided.
  • a control device for a work vehicle that automatically travels along a target travel route includes a vehicle position calculation unit that calculates a vehicle position of the work vehicle, and a target travel route after a predetermined time.
  • a control calculation unit for outputting a control amount for changing the traveling direction of the work vehicle so that the deviation is reduced.
  • the estimated target point is calculated.
  • the estimated target point is a point estimated to become a control target point on the target travel route after a predetermined time.
  • the control amount for reducing the deviation between the estimated target point and the vehicle position is calculated and output.
  • Steering devices such as wheels and crawlers are controlled by the output control amount.
  • the position of the work vehicle on the target travel route after a predetermined time is the estimated target point.
  • the estimated target point is a position that is located away from the current position of the vehicle in the traveling direction of the work vehicle and that is located on the target travel route.
  • the appropriate predetermined time in the control of the present invention differs depending on the type of work vehicle. Further, the appropriate predetermined time may vary depending on various conditions such as the state of the traveling surface of the work vehicle at the work site and the traveling state of the work vehicle. Such types of work vehicles, working conditions, field conditions, etc. are generically referred to as work vehicle conditions herein. It is preferable that the predetermined time is changed according to the state of the work vehicle. Of course, the predetermined time may be automatically set based on the state of the operating device set by the driver for the work vehicle.
  • an estimated azimuth deviation calculator that calculates an angle formed by the straight line passing through the estimated target point and the vehicle position and the target travel route as the estimated azimuth deviation.
  • the correction azimuth calculation unit includes a first controller that outputs a first correction azimuth using the estimated azimuth deviation as an input parameter, and the correction azimuth is calculated based on the first correction azimuth.
  • the correction azimuth calculation unit includes a first controller that outputs a first correction azimuth using an estimated azimuth deviation formed by the straight line passing through the estimated target point and the vehicle position and the target travel route as an input parameter.
  • the corrected azimuth is calculated based on the first corrected azimuth.
  • the first controller is a proportional controller.
  • a lateral deviation calculating unit that calculates a distance from the vehicle position in the direction orthogonal to the route azimuth of the target traveling path to the target traveling path as a lateral deviation.
  • the correction azimuth calculation unit includes a second controller that outputs a second correction azimuth using the lateral deviation as an input parameter, and the correction azimuth calculation unit is configured to correct the correction azimuth based on the first correction azimuth and the second correction azimuth. The azimuth is calculated.
  • the second controller is an integral controller.
  • a vehicle speed calculation unit that calculates the vehicle speed of the work vehicle is provided, and the target point estimation unit projects the target vehicle path from the vehicle position to the target travel route.
  • the position of a point that has moved the target travel route at the vehicle speed for the predetermined time with the point as a starting point is the estimated target point.
  • projection point is an intersection of a perpendicular line and a target travel route when a perpendicular line is drawn from a certain point to the target travel route.
  • the projection point also includes the intersection of the target traveling route and a line which is not perpendicular to the target traveling route from a certain point but is slightly inclined.
  • a vehicle body azimuth calculation unit that calculates a vehicle body azimuth indicating the direction of the vehicle body is provided, and the control calculation unit further uses the vehicle body azimuth as an input parameter.
  • the estimated target point is calculated in consideration of the position of the work vehicle after a predetermined time.
  • the vehicle speed of a working vehicle such as a combine harvester and a rice transplanter that travels in a field is not so high.
  • the target point estimation unit can calculate the estimated target point simply by adding the predetermined distance set in advance to the starting point.
  • a control device for a work vehicle that automatically travels along a target travel route includes: a vehicle position calculation unit that calculates a vehicle position of the work vehicle; A target point estimation unit that calculates, as an estimated target point, a position that is a predetermined distance away from the projection point on the target traveling route in the traveling direction side of the work vehicle on the target traveling route, the estimated target point and the vehicle position. And a correction azimuth calculation unit for calculating a correction azimuth for eliminating the deviation between the deviation and the control azimuth for outputting the control amount for controlling the work vehicle so that the deviation is reduced using the correction azimuth as an input parameter. And a unit.
  • the control device having this configuration can also obtain substantially the same action and effect as those described above.
  • Another feature of the present invention is a control program for a work vehicle that automatically travels along a target travel route, which includes a vehicle position calculation function for calculating the vehicle position of the work vehicle, and a predetermined time
  • a target point estimating function for calculating an estimated target point in the target travel route
  • a correction azimuth calculating function for calculating a correction azimuth for eliminating a deviation between the estimated target point and the vehicle position
  • the correction azimuth is realized by a computer.
  • Another feature of the present invention is a recording medium in which a control program for a work vehicle that automatically travels along a target travel route is recorded, and a vehicle position calculation function for calculating the vehicle position of the work vehicle. And a target point estimation function for calculating an estimated target point in the target travel route after a predetermined time, and a corrected azimuth calculation function for calculating a corrected azimuth for eliminating a deviation between the estimated target point and the vehicle position. And a control calculation function for outputting a control amount for controlling the work vehicle so as to reduce the deviation using the corrected azimuth as an input parameter. ..
  • Another feature of the present invention is a control method for a working vehicle that automatically travels along a target travel route, the method including: a vehicle position calculating step of calculating a vehicle position of the working vehicle; A target point estimating step of calculating an estimated target point in the target travel route, a correction azimuth calculating step of calculating a correction azimuth for eliminating a deviation between the estimated target point and the vehicle position, and the correction azimuth.
  • Another feature of the present invention is a control program for a work vehicle that automatically travels along a target travel route, including a vehicle position calculation function for calculating the vehicle position of the work vehicle, and the vehicle itself.
  • a target point estimation function that calculates a position that is a predetermined distance away from the projection point from the position to the target traveling route on the target traveling route in the traveling direction side of the work vehicle, the estimated target point and the self
  • a correction azimuth calculation function for calculating a correction azimuth for eliminating a deviation from the vehicle position, and a control amount for controlling the work vehicle so as to reduce the deviation using the correction azimuth as an input parameter.
  • the control calculation function is realized by a computer.
  • Another feature of the present invention is a recording medium in which a control program for a work vehicle that automatically travels along a target travel route is recorded, and a vehicle position calculation function for calculating the vehicle position of the work vehicle. And a target point estimation function for calculating a position separated by a predetermined distance in the traveling direction side of the work vehicle on the target traveling route from a projection point from the vehicle position to the target traveling route as an estimated target point, and the estimation A correction azimuth calculation function for calculating a correction azimuth for eliminating the deviation between the target point and the vehicle position, and for controlling the work vehicle so that the deviation is reduced using the correction azimuth as an input parameter. It is to record a control program that causes a computer to implement a control calculation function that outputs a control amount.
  • Another feature of the present invention is a control method for a work vehicle that automatically travels along a target travel route, the method including: a vehicle position calculating step of calculating a vehicle position of the work vehicle; A target point estimation step of calculating, as an estimated target point, a position distant by a predetermined distance in the traveling direction side of the work vehicle from the projection point from the position to the target traveling route, the estimated target point and the self A correction azimuth calculation step for calculating a correction azimuth for eliminating the deviation from the vehicle position, and outputting a control amount for controlling the work vehicle so that the deviation is reduced by using the correction azimuth as an input parameter. And a control calculation step.
  • FIG. 13 It is a figure which shows 1st Embodiment (Hereafter, it is the same as FIG. 13.) It is a left view of a combine. It is a figure which shows the circular traveling in a farm field. It is a figure showing the mowing run along the mowing run course. It is a block diagram which shows the structure regarding a control part. It is a figure which shows the correspondence of lateral deviation and turning output. It is a figure which shows an example at the time of a combine entering an operation target area
  • FIG. 6 is a diagram showing a transition of an on/off state of a side clutch on the inside of a turn when an output level is A1.
  • FIG. 6 is a diagram showing a transition of an on/off state of a side clutch on the inside of a turn when an output level is B3.
  • FIG. 6 is a diagram showing a transition of an on/off state of a side clutch on the inside of a turn when an output level is B2.
  • FIG. 8 is a diagram showing a transition of an on/off state of a side clutch on the inside of a turn when the output level is B1. It is a figure which shows 2nd Embodiment (Hereafter, it is the same as FIG.
  • a normal combine 1 (corresponding to a “work vehicle” according to the present invention) includes a crawler type traveling device 11, a driving unit 12, a threshing device 13, a grain tank 14, a harvesting device H, The transport device 16, the grain discharging device 18, the satellite positioning module 80, and the engine E are provided.
  • the traveling device 11 is provided in the lower portion of the combine 1. The traveling device 11 is driven by the power from the engine E. Then, the combine 1 can be self-propelled by the traveling device 11.
  • the operating unit 12, the threshing device 13, and the grain tank 14 are provided above the traveling device 11.
  • An operator who monitors the work of the combine 1 can be boarded on the operating unit 12. The operator may monitor the work of the combine 1 from the outside of the combine 1.
  • the grain discharging device 18 is provided above the grain tank 14. Further, the satellite positioning module 80 is attached to the upper surface of the driving unit 12.
  • the harvesting device H is provided in the front part of the combine 1.
  • the transport device 16 is provided on the rear side of the harvesting device H. Further, the harvesting device H has a harvesting device 15 and a reel 17.
  • the cutting device 15 cuts the planted grain culms in the field. Further, the reel 17 scrapes the planted grain culm to be harvested while being rotationally driven. With this configuration, the harvesting device H harvests grain in the field. Then, the combine 1 is capable of mowing traveling in which the traveling device 11 travels while mowing the planted culm in the field by the mowing device 15.
  • the harvested culm cut by the harvesting device 15 is transported to the threshing device 13 by the transporting device 16.
  • the cut culm is threshed.
  • the grain obtained by the threshing process is stored in the grain tank 14.
  • the grain stored in the grain tank 14 is discharged to the outside of the machine by the grain discharging device 18 as necessary.
  • the driving unit 12 is provided with a communication terminal 4.
  • the communication terminal 4 is configured to be able to display various information.
  • the communication terminal 4 is fixed to the driving unit 12.
  • the present invention is not limited to this, and the communication terminal 4 may be configured to be attachable/detachable to/from the operating unit 12, or the communication terminal 4 may be located outside the combine 1 machine. ..
  • the combine 1 performs the orbiting while harvesting the grains in the area on the outer peripheral side in the field as shown in FIG. 2, and then performs the cutting operation in the inner area in the field as shown in FIG. , Is configured to harvest grain in the field.
  • the circular traveling shown in FIG. 2 is performed by manual traveling. Further, the reaping traveling in the inner area shown in FIG. 3 is performed by automatic traveling.
  • the present invention is not limited to this, and the lap traveling shown in FIG. 2 may be performed by automatic traveling.
  • the operator can change the rotation speed of the engine E by operating the communication terminal 4.
  • the appropriate work speed differs depending on the type of crop. If the operator operates the communication terminal 4 and sets the rotation speed of the engine E to an appropriate rotation speed, work can be performed at a work speed suitable for the type of crop.
  • the combine 1 is controlled by the automatic traveling control system 2 during the harvesting work in the field.
  • the configuration of the automatic cruise control system 2 will be described below.
  • the automatic cruise control system 2 includes a control unit 20 and a satellite positioning module 80.
  • the controller 20 is provided in the combine 1. Further, as described above, the satellite positioning module 80 is also included in the combine 1.
  • the power output from the engine E is input to the traveling device 11. Accordingly, as described above, the traveling device 11 is driven by the power from the engine E.
  • the control unit 20 also includes a vehicle position calculation unit 21, a region calculation unit 22, a route calculation unit 23, and a travel control unit 24.
  • the satellite positioning module 80 receives a GPS signal from an artificial satellite GS used in GPS (Global Positioning System). Then, as shown in FIG. 4, the satellite positioning module 80 sends positioning data indicating the own vehicle position of the combine 1 to the own vehicle position calculation unit 21 based on the received GPS signal.
  • GPS Global Positioning System
  • the own vehicle position calculation unit 21 calculates the position coordinates of the combine 1 over time based on the positioning data output by the satellite positioning module 80.
  • the calculated position coordinates of the combine 1 over time are sent to the area calculation unit 22 and the travel control unit 24.
  • the area calculation unit 22 based on the position coordinates of the combine 1 over time received from the own vehicle position calculation unit 21, as shown in FIG. 3, the outer peripheral area SA (corresponding to the "working area” according to the present invention) And a work target area CA (corresponding to the “unworked area” according to the present invention).
  • the area calculation unit 22 calculates the traveling locus of the combine 1 during the round trip on the outer peripheral side of the field based on the position coordinates of the combine 1 received from the vehicle position calculation unit 21 over time. .. Then, the area calculation unit 22 calculates, as the outer peripheral area SA, the area on the outer peripheral side of the field in which the combine 1 traveled around while harvesting the grains, based on the calculated traveling locus of the combine 1. Further, the area calculation unit 22 calculates an area inside the farm field with respect to the calculated outer peripheral area SA as the work target area CA.
  • the traveling path of the combine 1 for traveling on the outer peripheral side of the field is shown by an arrow.
  • the combine 1 makes three round trips. Then, when the mowing traveling along the traveling route is completed, the field becomes the state shown in FIG.
  • the area calculation unit 22 calculates, as the outer area SA, the area on the outer circumference side of the field in which the combine 1 traveled around while harvesting the grains. Further, the area calculation unit 22 calculates an area inside the farm field with respect to the calculated outer peripheral area SA as the work target area CA. Then, as shown in FIG. 4, the calculation result by the area calculation unit 22 is sent to the route calculation unit 23 and the travel control unit 24.
  • the path calculation unit 23 Based on the calculation result received from the area calculation unit 22, the path calculation unit 23, as shown in FIG. 3, is a cutting travel path LI that is a travel path for cutting travel in the work target area CA (“ “Corresponding to the target travel route") is calculated.
  • the mowing traveling route LI is a plurality of parallel lines that are parallel to each other. Further, the plurality of parallel lines need not be straight lines and may be curved.
  • the route calculation unit 23 calculates the mowing traveling route LI passing through the work target area CA.
  • the mowing traveling route LI calculated by the route calculating unit 23 is sent to the traveling control unit 24.
  • the traveling control unit 24 is configured to control the traveling device 11. Then, the traveling control unit 24 is based on the position coordinates of the combine 1 received from the own vehicle position calculation unit 21, the calculation result received from the area calculation unit 22, and the mowing traveling route LI received from the route calculation unit 23. Then, the automatic traveling of the combine 1 is controlled. More specifically, as shown in FIG. 3, the traveling control unit 24 controls the traveling of the combine 1 so that the harvesting traveling is performed by the automatic traveling along the harvesting traveling route LI.
  • the route calculation unit 23 calculates a departure return route LW which is a traveling route for non-crop traveling in the outer peripheral area SA, as shown in FIG. 3, based on the calculation result received from the region calculation unit 22.
  • the leaving return path LW is a line having a shape along the outer shape of the field.
  • the departure return route LW calculated by the route calculation unit 23 is sent to the travel control unit 24.
  • the traveling control unit 24 controls the automatic traveling of the combine 1 based on the position coordinates of the combine 1 received from the own vehicle position calculation unit 21 and the departure return route LW received from the route calculation unit 23. More specifically, the traveling control unit 24 controls the traveling of the combine 1 such that when the combine 1 leaves the cutting traveling route LI, the non-crop traveling is performed by the automatic traveling along the separation return route LW. To do.
  • the operator manually operates the combine 1 and, as shown in FIG. 2, in the outer peripheral portion of the field, carries out the cutting operation so as to circulate along the boundary line of the field.
  • the combine 1 makes three round trips.
  • this round traveling is completed, the field becomes the state shown in FIG.
  • the area calculation unit 22 calculates the traveling locus of the combine 1 during the round trip shown in FIG. 2, based on the position coordinates of the combine 1 over time received from the own vehicle position calculation unit 21. Then, as shown in FIG. 3, the area calculation unit 22 determines, based on the calculated traveling locus of the combine 1, the area on the outer peripheral side of the field in which the combine 1 traveled around while cutting the planted grain culms as the outer peripheral area SA. Calculate as Further, the area calculation unit 22 calculates an area inside the farm field with respect to the calculated outer peripheral area SA as the work target area CA.
  • the route calculation unit 23 sets the reaping traveling route LI in the work target area CA as shown in FIG. 3 based on the calculation result received from the region calculation unit 22. Further, at this time, the route calculation unit 23 calculates the departure return route LW in the outer peripheral region SA based on the calculation result received from the region calculation unit 22.
  • an automatic travel start button (not shown)
  • automatic travel along the cutting travel route LI is started as shown in FIG.
  • the traveling control unit 24 controls the traveling of the combine 1 so that the reaping traveling is performed by the automatic traveling along the reaping traveling route LI.
  • the combine 1 When the automatic traveling is started, as shown in FIG. 3, the combine 1 repeats traveling along the cutting traveling route LI and turning by U-turn so as to cover the entire work target area CA. Perform mowing run.
  • the harvested grain culms harvested by the harvesting device 15 are transported to the threshing device 13 by the transport device 16. Then, in the threshing device 13, the cut grain culm is threshed.
  • the carrier CV is parked outside the field. Then, in the outer peripheral area SA, a stop position PP is set near the transport vehicle CV. As shown in FIG. 3, the vehicle stop position PP is set at a position overlapping the departure return route LW.
  • the carrier CV can collect and transport the grains discharged from the grain discharging device 18 by the combine 1. At the time of discharging the grain, the combine 1 stops at the stop position PP, and the grain discharging device 18 discharges the grain to the transport vehicle CV.
  • the traveling control unit 24 controls the traveling of the combine 1 so as to separate from the mowing traveling route LI.
  • the traveling control unit 24 controls the combine 1 to travel toward the detachment return route LW.
  • the traveling control unit 24 controls the traveling of the combine 1 so that the non-crop traveling is performed by the automatic traveling along the departure return route LW.
  • the combine 1 is stopped at the stop position PP, and the grain discharging device 18 discharges the grains to the carrier CV.
  • the traveling control unit 24 includes a lateral deviation detection unit 25 (corresponding to a “detection unit” according to the present invention), a turning output calculation unit 26, an output conversion unit 27, a retry determination unit 28, and an entry determination unit. 29, and a start time determination unit 30.
  • the lateral deviation detector 25 is configured to detect the state of the combine 1. More specifically, the lateral deviation detection unit 25 detects the lateral deviation based on the position coordinates of the combine 1 received from the vehicle position calculation unit 21 and the cutting travel route LI received from the route calculation unit 23. To do. The lateral deviation is the distance between the mowing traveling route LI and the combine 1.
  • the lateral deviation detected by the lateral deviation detector 25 is sent to the turning output calculator 26.
  • the turning output calculation unit 26 calculates the turning output based on the lateral deviation received from the lateral deviation detection unit 25. The larger the lateral deviation, the larger the turning output calculated by the turning output calculation unit 26.
  • the turning output is an output value for determining the output level.
  • the output level is a control amount of the traveling device 11 for turning the combine 1.
  • the turning output calculated by the turning output calculation unit 26 is sent to the output conversion unit 27.
  • the output conversion unit 27 determines the output level based on the turning output received from the turning output calculation unit 26.
  • the traveling control unit 24 controls the traveling of the combine 1 by controlling the traveling device 11 according to the output level determined by the output conversion unit 27. At this time, the traveling control unit 24 controls the traveling of the combine 1 so that the combine 1 automatically travels along the harvesting travel route LI.
  • the traveling control unit 24 controls the traveling of the combine 1 by calculating the turning output based on the lateral deviation so that the combine 1 automatically travels along the cutting traveling route LI.
  • the traveling control unit 24 controls the traveling device 11 so that the turning radius of the combine 1 becomes smaller as the output level becomes higher.
  • the approach determination unit 29 causes the combine 1 to move from the outer peripheral area SA to the work target area CA based on the position coordinates of the combine 1 received from the own vehicle position calculation unit 21 and the calculation result received from the area calculation unit 22. It is determined whether or not the vehicle is about to enter. The determination result by the entry determination unit 29 is sent to the turning output calculation unit 26.
  • the turning output calculation unit 26 receives the lateral deviation received from the lateral deviation detection unit 25. Based on the above, the correspondence between the lateral deviation and the turning output is determined.
  • the traveling control unit 24 determines the correspondence between the lateral deviation and the turning output based on the state detected by the lateral deviation detection unit 25. decide.
  • the entry determination unit 29 determines that the combine 1 is about to enter the work target area CA from the outer peripheral area SA
  • the lateral deviation is the first.
  • the turning output calculation unit 26 determines the correspondence between the lateral deviation and the turning output as the first correspondence M1.
  • the entry determination unit 29 determines that the combine 1 is about to enter the work target area CA from the outer peripheral area SA, when the lateral deviation does not exceed the first threshold value d1, the turning output calculation is performed.
  • the unit 26 determines the correspondence between the lateral deviation and the turning output as the second correspondence M2.
  • the slope of the first correspondence M1 when the horizontal deviation is plotted on the horizontal axis of the graph and the turning output is plotted on the vertical axis is smaller than the slope of the second correspondence M2. That is, the turning output in the first correspondence M1 is smaller than the turning output in the second correspondence M2.
  • the traveling control unit 24 determines the correspondence between the lateral deviation and the turning output when the lateral deviation exceeds the first threshold d1. 1 Correspondence M1 is determined.
  • the traveling control unit 24 makes the second correspondence the lateral deviation and the turning output.
  • the relationship M2 is determined.
  • the lateral deviation detected by the lateral deviation detection unit 25 is sent to the retry determination unit 28.
  • the determination result by the entry determination unit 29 is also sent to the retry determination unit 28.
  • start time determination unit 30 determines whether or not it is the start time of the automatic travel, based on the information such as the operation of the above-described automatic travel start button. The determination result by the start time determination unit 30 is also sent to the retry determination unit 28.
  • the retry determination unit 28 based on the position coordinates of the combine 1 received from the vehicle position calculation unit 21, the mowing traveling route LI received from the route calculation unit 23, and the determination result received from the entry determination unit 29, It is determined whether or not the combine 1 is turning and is about to enter the work target area CA from the outer peripheral area SA.
  • the retry determination unit 28 also determines whether or not the lateral deviation exceeds the second threshold value d2 based on the lateral deviation received from the lateral deviation detection unit 25.
  • the retry determination unit 28 determines whether or not the retry condition is satisfied based on the above determination result by the retry determination unit 28 and the determination result received from the start time determination unit 30.
  • the retry condition is a condition for causing the combine 1 to perform the retry running.
  • the retry condition is “not at the start of automatic traveling, and when the combine 1 is turning and trying to enter the work target area CA from the outer peripheral area SA, and the lateral deviation is the second threshold value. It exceeds d2”.
  • the retry running is a running in which the vehicle is once moved backward and then moved forward to try to enter the work target area CA.
  • the direction of the machine body of the combine 1 is the same as or substantially the same as the direction in which the target mowing travel route LI extends, and while cutting forward in the mowing travel route LI, the mowing operation is performed in the lateral direction of the machine body.
  • the case of approaching the aircraft to the position of the travel route LI does not correspond to "a state in which the combine 1 is turning and is about to enter the work target area CA from the outer peripheral area SA".
  • the traveling control unit 24 controls the traveling of the combine 1 so that the combine 1 performs the retry traveling.
  • the travel control section 24 once moves backward to the combine 1. Then, the vehicle is advanced again to perform the retry travel which is an attempt to enter the work target area CA.
  • the above-mentioned retry condition is not satisfied. That is, even when the combine 1 is turning and is about to enter the work target area CA from the outer peripheral area SA, and the lateral deviation exceeds the second threshold value d2, at the time of starting automatic traveling.
  • the retry determination unit 28 determines that the retry condition is not satisfied. Therefore, in this case, the traveling control unit 24 does not cause the combine 1 to perform the retry traveling.
  • the traveling control unit 24 does not allow the combine 1 to perform the retry traveling when the lateral deviation exceeds the second threshold value d2 at the start of the automatic traveling.
  • the determination result by the retry determination unit 28 is sent to the turning output calculation unit 26.
  • the turning output calculation unit 26 determines the correspondence relationship between the lateral deviation and the turning output based on the determination result of the retry determination unit 28.
  • the turning output calculation unit 26 determines the correspondence between the lateral deviation and the turning output as the third correspondence M3. To do.
  • the traveling control unit 24 determines the correspondence between the lateral deviation and the turning output as the third correspondence M3 when the retry travel is being performed.
  • the slope of the third correspondence M3 when the horizontal deviation is plotted on the horizontal axis of the graph and the turning output is plotted on the vertical axis is larger than the slope of the first correspondence M1, and the second correspondence It is smaller than the slope of the relationship M2. That is, the turning output in the third corresponding relationship M3 is larger than the turning output in the first corresponding relationship M1 and smaller than the turning output in the second corresponding relationship M2.
  • the turning output calculation unit 26 determines the correspondence relationship between the lateral deviation and the turning output by determining the gain (coefficient) in the control based on the lateral deviation. That is, determining the gain corresponds to “determining the correspondence between the lateral deviation and the turning output” according to the present invention. Further, in the graph shown in FIG. 5, the larger the gain, the larger the inclination.
  • the combine 1 travels from the position P1 in the outer peripheral area SA toward the position P3 that is the starting point of the cutting travel route LI. That is, in the example shown in FIG. 6, the combine 1 enters the work target area CA from the outer peripheral area SA.
  • the entry determination unit 29 determines that the combine 1 is about to enter the work target area CA from the outer peripheral area SA. The determination result by the entry determination unit 29 is sent to the turning output calculation unit 26 and the retry determination unit 28.
  • the lateral deviation at the position P1 is larger than the first threshold d1.
  • the lateral deviation at this time is detected by the lateral deviation detection unit 25, and is sent to the turning output calculation unit 26 and the retry determination unit 28.
  • the direction of the machine body of the combine 1 is the same as or substantially the same as the direction in which the target mowing travel route LI extends, and while advancing toward the mowing travel route LI, the mowing travel route in the machine lateral direction
  • the case of approaching the aircraft to the position of LI does not correspond to the “state in which the combine 1 is turning and trying to enter the work target area CA from the outer peripheral area SA”.
  • the retry determination unit 28 determines that the retry condition is not satisfied.
  • the determination result by the retry determination unit 28 is sent to the turning output calculation unit 26.
  • the turning output calculation unit 26 determines the correspondence between the lateral deviation and the turning output as the first correspondence M1.
  • the lateral deviation will decrease as the combine 1 runs.
  • the lateral deviation becomes equal to the first threshold d1.
  • the turning output calculation unit 26 determines the correspondence between the lateral deviation and the turning output as the second correspondence M2.
  • the correspondence between the lateral deviation and the turning output is the first correspondence M1.
  • the correspondence between the lateral deviation and the turning output changes to the second correspondence M2.
  • the combine 1 starts U-turn traveling from the end of the first route LI1 which is one of the mowing traveling routes LI, and the second route LI2 which is another mowing traveling route LI. Drive toward the beginning of.
  • the position P4 in FIG. 7 is the end of the first route LI1.
  • the position P7 is the start end of the second route LI2. That is, the combine 1 makes a U-turn travel from the position P4 toward the position P7.
  • the target turning line at this time is shown by a broken line connecting position P4 and position P7.
  • the combine 1 deviates from the target turning line and reaches the position P5.
  • the lateral deviation at the position P5 is larger than the second threshold d2.
  • the lateral deviation at this time is detected by the lateral deviation detection unit 25, and is sent to the turning output calculation unit 26 and the retry determination unit 28.
  • the entry determination unit 29 determines that the combine 1 is in a state of approaching the work target area CA from the outer peripheral area SA.
  • the determination result by the entry determination unit 29 is sent to the turning output calculation unit 26 and the retry determination unit 28.
  • the start time determination unit 30 determines that it is not the start time of the automatic travel. The determination result by the start time determination unit 30 is sent to the retry determination unit 28.
  • the case where the combine 1 starts the U-turn traveling from the end of the mowing traveling route LI and travels toward the starting end of another mowing traveling route LI is " A state in which the user is about to enter the work target area CA from the area SA”.
  • the retry determination unit 28 determines that the retry condition is satisfied. Thereby, the traveling control unit 24 controls the traveling of the combine 1 so that the combine 1 performs the retry traveling. Therefore, the combine 1 performs retry travel from the position P5.
  • the determination result by the retry determination unit 28 is sent to the turning output calculation unit 26. Since the retry determination unit 28 determines that the retry condition is satisfied, the turning output calculation unit 26 determines the correspondence between the lateral deviation and the turning output as the third correspondence M3.
  • combine 1 moves backward from position P5 and reaches position P6. Then, it moves forward again from the position P6 and tries to enter the work target area CA. As a result, the combine 1 reaches the position P7 and enters the work target area CA.
  • the correspondence relationship between the lateral deviation and the turning output is maintained at the third correspondence relationship M3 from the time when the combine 1 starts to move backward from the position P5 until the combine 1 reaches the position P7.
  • the combine 1 starts automatic traveling from the position P8 in the outer peripheral area SA.
  • the start time determination unit 30 determines that it is the start time of automatic traveling.
  • the determination result by the start time determination unit 30 is sent to the retry determination unit 28.
  • the orientation of the aircraft of the combine 1 is perpendicular to the direction in which the target mowing traveling route LI extends. Therefore, the combine 1 travels from the position P8 toward the starting point of the cutting travel route LI while turning.
  • Combine 1 reaches position P9.
  • the lateral deviation at the position P9 is larger than the second threshold d2.
  • the lateral deviation at this time is detected by the lateral deviation detection unit 25, and is sent to the turning output calculation unit 26 and the retry determination unit 28.
  • the start time determination unit 30 determines that it is the start time of the automatic traveling.
  • the retry determination unit 28 determines that the retry condition is not satisfied. Therefore, in the example shown in FIG. 8, retry travel is not performed.
  • the traveling control unit 24 determines that the start determination unit 30 determines that the automatic traveling is started, and the lateral deviation detected by the lateral deviation detection unit 25 exceeds the second threshold value d2. If so, the combine 1 is stopped.
  • combine 1 stops at position P9.
  • the output conversion unit 27 determines the output level based on the turning output received from the turning output calculation unit 26. Then, the traveling control unit 24 controls the traveling of the combine 1 by controlling the traveling device 11 according to the output level determined by the output conversion unit 27.
  • FIG. 9 shows a correspondence relationship between the turning output and the output level determined by the output conversion unit 27.
  • the output level becomes B1.
  • the output level is B2.
  • the output level is B3.
  • the output level becomes A1.
  • the output level becomes A2.
  • the higher the turning output the higher the output level will be A3, A4, A5....
  • the output level is shown only up to A3.
  • the traveling control unit 24 controls the side brake (not shown) on the inside of the turn of the traveling device 11 to the braking state. At this time, the traveling control unit 24 controls the side brake so that the braking force of the side brake increases as the output level increases.
  • the traveling control unit 24 controls the side clutch (not shown) on the inside of the turn in the traveling device 11 to be in the disengaged state. At this time, the side brake is not controlled to the braking state.
  • the traveling control unit 24 When the output level is A1 or less, the traveling control unit 24 periodically controls the side clutch on the inside of the turn in the traveling device 11, as shown in FIGS. 10 to 13. The length of each cycle is T.
  • the side clutch on the inside of the turn is controlled to be always disengaged in each cycle. That is, the side clutch on the inside of the turn is maintained in the disengaged state while the output level is A1.
  • the side clutch on the inside of the turn is controlled to the disengaged state over time t1. After that, the side clutch on the inside of the turn is controlled to be in the on state over the time s1.
  • the time t1 is longer than the time s1.
  • the side clutch on the inside of the turn is controlled to the disengaged state over time t2. After that, the side clutch on the inside of the turn is controlled to be in the on state over the time s2.
  • the time t2 is longer than the time s2 and shorter than the time t1.
  • the side clutch on the inside of the turn is controlled to the disengaged state over time t3. After that, the side clutch on the inside of the turn is controlled to be in the on state for the time s3.
  • the time t3 is shorter than the time s3 and shorter than the time t2.
  • the time t1 is three times as long as the time t3. Further, the time t2 is twice as long as the time t3.
  • both left and right side clutches are maintained in the on state. That is, when the output level is 0 (zero), the combine 1 goes straight without turning.
  • the automatic travel control system 2 capable of calculating the turning output according to the state of the combine 1 can be realized.
  • the traveling device 11 may be a wheel type or a semi-crawler type.
  • the mowing traveling route LI calculated by the route calculation unit 23 is a plurality of parallel lines that are parallel to each other.
  • the present invention is not limited to this, and the mowing traveling route LI calculated by the route calculation unit 23 does not have to be a plurality of parallel lines parallel to each other.
  • the mowing traveling route LI calculated by the route calculating unit 23 may be a plurality of mesh lines extending in the vertical and horizontal directions, or may be a spiral traveling route.
  • the operator manually operates the combine 1 and, as shown in FIG. 2, in the outer peripheral portion of the field, carries out the cutting operation so as to circulate along the boundary line of the field.
  • the present invention is not limited to this, and the combine 1 may be configured to run automatically and to perform the cutting operation so as to circulate along the boundary line of the field in the outer peripheral portion of the field.
  • the number of turns at this time may be a number other than three. For example, the number of turns at this time may be two.
  • vehicle position calculation unit 21, the area calculation unit 22, the route calculation unit 23, and the travel control unit 24 may be provided outside the combiner 1, and for example, the combiner may be used. It may be provided in a management server provided outside of 1.
  • the correspondence between the lateral deviation and the turning output remains the third correspondence M3 from the time when the combine 1 starts to move backward from the position P5 until the combine 1 reaches the position P7.
  • the present invention is not limited to this, and the correspondence between the lateral deviation and the turning output is the third correspondence M3 from the time when the combine 1 starts to move backward from the position P5 until the combine 1 reaches the position P6.
  • Correspondence relationships other than may be used. In this case, when the combine 1 starts to move forward from the position P6, the correspondence between the lateral deviation and the turning output may change to the third correspondence M3.
  • the traveling control unit 24 may be configured to cause the combine 1 to perform retry traveling when the lateral deviation exceeds the second threshold value d2 at the start of automatic traveling.
  • the turning output in the third correspondence M3 may be smaller than the turning output in the first correspondence M1.
  • the travel control unit 24 may determine the correspondence relationship between the lateral deviation and the turning output to be a correspondence relationship other than the third correspondence relationship M3 when the retry travel is performed. For example, the traveling control unit 24 may determine the correspondence between the lateral deviation and the turning output as the first correspondence M1 when the retry travel is being performed.
  • the traveling control unit 24 does not perform retry traveling on the combine 1 when the combine 1 is entering the work target area CA from the outer peripheral area SA while turning, and the lateral deviation exceeds the second threshold value d2.
  • the combine 1 may be configured to be stopped.
  • the turning output in the first correspondence M1 may be larger than the turning output in the second correspondence M2.
  • the “detection unit” according to the present invention is not limited to the lateral deviation detection unit 25 in the above embodiment.
  • a vehicle speed detection unit that detects the vehicle speed of the combine 1 may be provided as a member corresponding to the “detection unit” according to the present invention.
  • the traveling control unit 24 determines the correspondence between the lateral deviation and the turning output based on the vehicle speed detected by the vehicle speed detection unit when the combine 1 enters the work target area CA from the outer peripheral area SA. It may be configured to.
  • a work content detection unit that detects the work content of the combine 1 may be provided as a member corresponding to the “detection unit” according to the present invention.
  • the work content is, for example, the type of harvested crop.
  • the traveling control unit 24 determines the correspondence relationship between the lateral deviation and the turning output based on the work content detected by the work content detection unit when the combine 1 enters the work target area CA from the outer peripheral area SA. It may be configured to do.
  • the first threshold d1 may be larger than the second threshold d2, smaller than the second threshold d2, or the same as the second threshold d2.
  • the output conversion unit 27 does not have to be provided.
  • the retry determination unit 28 does not have to be provided.
  • the start time determination unit 30 may not be provided.
  • It may be configured as an automatic traveling control program that causes a computer to realize the functions of the respective members in the above embodiment. Further, it may be configured as a recording medium in which an automatic travel control program for causing a computer to realize the functions of the respective members in the above embodiment is recorded. Further, the embodiment may be configured as an automatic travel control method in which what is performed by each member is performed by one or a plurality of steps.
  • FIGS. 14 to 22 A second embodiment of the present invention will be described below with reference to FIGS. 14 to 22 by taking a normal combine harvester as an example of an automatically traveling work vehicle equipped with a control device according to the present invention.
  • "front” (direction of arrow F shown in FIG. 14) means forward with respect to the vehicle body front-rear direction (running direction) and "rear” (direction of arrow B shown in FIG. 14) unless otherwise specified. ) Means rearward with respect to the front-rear direction of the vehicle body (traveling direction).
  • the left-right direction or the lateral direction means a vehicle body transverse direction (vehicle body width direction) orthogonal to the vehicle body front-rear direction.
  • “Upper” (direction of arrow U shown in FIG. 14) and “lower” (direction of arrow D shown in FIG. 14) are positional relationships in the vertical direction (vertical direction) of the vehicle body 110, and are relationships at the ground height. Indicates.
  • this combine has a vehicle body 110, a crawler type traveling device 111, a driving unit 112, a threshing device 113, a grain tank 114 as a harvest tank, a harvesting unit 115, a transport device 116, and a grain discharge.
  • the device 118 and the own vehicle position detection unit 180 are provided.
  • the traveling device 111 is provided below the vehicle body 110.
  • the combine is configured to be self-propelled by the traveling device 111.
  • the operation unit 112, the threshing device 113, and the grain tank 114 are provided above the traveling device 111.
  • a driver who drives the combine and a monitor who monitors the operation of the combine can be boarded on the drive unit 112.
  • the supervisor may monitor the combine work from outside the combine.
  • the grain discharging device 118 is connected to the lower rear portion of the grain tank 114.
  • the vehicle position detection unit 180 is attached to the upper surface of the driving unit 112.
  • the harvesting section 115 is provided in the front part of the combine.
  • the transport device 116 is provided behind the harvesting unit 115.
  • the combine can perform work traveling in which the traveling unit 111 travels while harvesting the grain in the field by the harvesting unit 115.
  • the cut culm cut by the harvesting section 115 is transferred to the threshing device 113 by the transfer device 116.
  • the cut culms are threshed.
  • the grain obtained by the threshing process is stored in the grain tank 114.
  • the grain stored in the grain tank 114 is discharged to the outside of the machine by the grain discharging device 118 as necessary (eg, full).
  • a general-purpose terminal 104 is arranged in the operation unit 112.
  • the general-purpose terminal 104 is fixed to the driving unit 112.
  • the present invention is not limited to this, and the general-purpose terminal 104 may be configured to be attachable to and detachable from the driving unit 112. Further, the general-purpose terminal 104 may be able to be carried out of the combine machine.
  • the vehicle position detection unit 180 includes a satellite positioning module 181 and an inertial measurement module 182.
  • the satellite positioning module 181 receives a GNSS (global navigation satellite system) signal (including a GPS signal) that is position information transmitted from the artificial satellite GS, and outputs positioning data for calculating the own vehicle position.
  • the inertial measurement module 182 incorporates a gyro acceleration sensor and a magnetic direction sensor. Then, the inertial measurement module 182 outputs a signal indicating the instantaneous traveling direction.
  • the inertial measurement module 182 is used to complement the calculation of the vehicle position by the satellite positioning module 181.
  • the inertial measurement module 182 may be arranged in a place different from the satellite positioning module 181.
  • the driver/monitor operates the combine, and as shown in FIG. 15, in the outer peripheral portion of the field, while harvesting while cutting around the boundary line of the field.
  • the area where the mowing and harvesting work has been completed by the surrounding cutting operation is set as the outer peripheral area SA.
  • the inner area left inside the outer peripheral area SA is the uncut area CA1.
  • the uncut area CA1 is set as an area for future work.
  • the surrounding cutting traveling is performed so that the uncut area CA1 becomes a quadrangle.
  • a triangular or pentagonal uncut area CA1 may be adopted.
  • the outer peripheral area SA is used as a space for the combine to change direction when carrying out harvesting in the uncut area CA1 which is the area to be worked. Further, the outer peripheral area SA is also used as a moving space when the harvesting operation is finished and the grain is discharged to the grain discharge place, or the fuel is supplied to the grain supply place. Therefore, in order to secure the width of the outer peripheral area SA to some extent, the surrounding cutting traveling is performed for two or three laps automatically or manually.
  • the carrier CV shown in FIG. 15 collects the grains discharged from the grain discharging device 118 by the combine and transports them to a drying facility or the like.
  • the combine moves to the vicinity of the carrier CV through the outer peripheral area SA, and then discharges the grain to the carrier CV by the grain discharging device 118. After that, the combine returns to the work starting point, which is the position where the work is interrupted, through the outer peripheral area SA.
  • the unworked map data showing the shape of the uncut area CA1 is created based on the inner circumference shape of the outer circumference area SA which is the already worked area. Based on the unworked map data, a linear (straight line, curved line, or bent line) route is set in the uncut region CA1 as a work travel route in order to work in the uncut region CA1 by automatic operation. Further, a turning traveling route for shifting from one working traveling route to the next working traveling route is set in the outer peripheral area SA. The unworked map data is updated as the work on the uncut area CA1 progresses.
  • the traveling patterns used when the work traveling (harvest traveling) is performed in the uncut area CA1 include a reciprocating traveling pattern shown in FIG. 16 and a spiral traveling pattern shown in FIG.
  • the route along which the combine travels in the reciprocating traveling pattern includes a work traveling route that is parallel to one side of the polygon showing the outer shape of the uncut area CA1.
  • the route along which the combine travels in the reciprocating traveling pattern includes a U-turn turning route.
  • the route along which the combine travels in the spiral traveling pattern includes a work traveling route that is parallel to one side of the polygon showing the outer shape of the uncut area CA1.
  • the route along which the combine travels in the spiral traveling pattern includes an alpha turn route.
  • the alpha-turn route is a turning route that is composed of a straight traveling route, a backward turning route, and a forward turning route, and connects work traveling routes that are adjacent to each other in the circumferential direction.
  • Fig. 18 shows the combine control system.
  • the control system includes a control device 105 and various input/output devices.
  • the controller 105 comprises one or more electronic control units.
  • the electronic control unit is called an ECU.
  • signal communication is performed between various input/output devices and the control device 105 through a wiring network such as an in-vehicle LAN.
  • the control device 105 is the core element of this control system. Further, control device 105 is shown as an assembly of a plurality of ECUs. The signal from the vehicle position detection unit 180 is input to the control device 105 through the vehicle-mounted LAN.
  • the control device 105 includes an informing unit 501, an input processing unit 502, and an output processing unit 503 as an input/output interface.
  • the notification unit 501 generates notification data based on a command from each functional unit of the control device 105 and gives the notification data to the notification device 162.
  • the notification device 162 is a device for notifying the driver or the like of the work traveling state and various warnings.
  • the notification device 162 is, for example, a buzzer, a lamp, a speaker, a display, or the like.
  • the input processing unit 502 is connected with a running state sensor group 163, a work state sensor group 164, an artificial operation tool 165, and the like.
  • the work state sensor group 164 includes sensors that detect the amount of stored grains in the grain tank 114.
  • the manual operation tool 165 is a general term for levers, switches, buttons, and the like.
  • the manual operation tool 165 is manually operated by the driver. Then, the operation signal of the manual operation tool 165 is input to the control device 105.
  • the output processing unit 503 is connected to various operating devices 170 via a device driver 173.
  • the operating devices 170 include a traveling device group 171 that is a traveling-related device and a working device group 172 that is a work-related device.
  • the traveling device group 171 includes steering devices that steer the vehicle body 110. This steering device is a device that changes the speed of the left and right crawlers when the crawler type traveling device 111 is adopted as in this embodiment. When the steered wheel type traveling device 111 is adopted, the steering device is a device that changes the steering angle of the steered wheels.
  • the control device 105 includes a vehicle position calculation unit 140, a vehicle body direction calculation unit 141, a vehicle speed calculation unit 142, a travel control unit 151, a work control unit 152, a travel mode management unit 153, a work area determination unit 154, a travel route calculation unit. 155, a lateral deviation calculation unit 156, a target point estimation unit 157, a correction azimuth calculation unit 109A, and a control calculation unit 109B are provided.
  • the own vehicle position calculation unit 140 calculates the own vehicle position in the form of map coordinates (or field coordinates) based on the positioning data sequentially sent from the own vehicle position detection unit 180. At that time, a position of a specific portion (for example, the center of the vehicle body or an end portion of the harvesting section 115) serving as a reference point of the vehicle body 110 can be set as the vehicle position.
  • a position of a specific portion for example, the center of the vehicle body or an end portion of the harvesting section 115 serving as a reference point of the vehicle body 110 can be set as the vehicle position.
  • the vehicle body azimuth calculation unit 141 calculates the vehicle body azimuth based on the plurality of vehicle positions calculated by the vehicle position calculation unit 140 over time.
  • the vehicle body direction indicates the direction of the vehicle body 110. Note that it is also possible to calculate the vehicle body direction based on the direction data included in the output data from the inertial measurement module 182.
  • the vehicle speed calculation unit 142 calculates the vehicle speed from the vehicle speed sensor or the gear shift state of the transmission.
  • the work area determination unit 154 has a traveling locus calculation function and an uncut area determination function.
  • the traveling locus calculation function is a function of calculating traveling locus data by plotting the own vehicle position calculated by the own vehicle position calculation unit 140 with time.
  • the uncut area determination function is a function of creating unworked map data based on the traveling locus data calculated by the traveling locus calculation function.
  • the unworked map data is data indicating the shape of the uncut area CA1 that is the area to be worked.
  • the travel route calculation unit 155 uses the registered route calculation algorithm to be a travel route that is a target travel route for automatic travel that covers the uncut area CA1 (working travel route, U-turn traveling route, alpha-turn route, etc.). ) Is calculated.
  • the traveling control unit 151 has an engine control function, a traveling device control function (including steering control of the vehicle body 110 and vehicle speed control), and the like.
  • the traveling control unit 151 gives a traveling control signal to the traveling device group 171.
  • the work control unit 152 gives a work control signal to the work equipment group 172 in order to control the movement of the harvesting work device (the harvesting unit 115, the threshing device 113, the transport device 116, the grain discharging device 118, etc.).
  • the traveling control unit 151 includes a manual traveling control unit 511, an automatic traveling control unit 512, and a target traveling route setting unit 513.
  • the automatic travel mode is set, the combine travels automatically.
  • the manual travel mode is set, the combine travel is manual travel.
  • the switching of the driving modes is managed by the driving mode management unit 153.
  • the target travel route setting unit 513 sets the target travel route using the work travel route and the turning travel route calculated by the travel route calculation unit 155 when the automatic travel mode is set.
  • the lateral deviation calculating unit 156 calculates the distance from the vehicle position in the direction orthogonal to the route azimuth of the target traveling route (extending direction of the route) set by the target traveling route setting unit 513 to the target traveling route as the lateral deviation. To do.
  • the manual traveling control unit 511 gives a control signal to the corresponding traveling equipment group 171 based on the operation by the driver. At this time, the control signal is given through the device driver 173. As a result, manual traveling is realized.
  • the automatic traveling control unit 512 gives the corresponding traveling device group 171 a control signal for changing the vehicle speed including automatic steering and stopping. At this time, the control signal is given through the device driver 173. As a result, automatic driving is realized.
  • the automatic travel control unit 512 outputs a control signal for automatic steering based on the control amount output from the control calculation unit 109B, as described below.
  • RP indicates a reference point of the vehicle body 110 (center of vehicle body, center of working device, etc.).
  • the reference point: RP is calculated based on the vehicle position calculated by the vehicle position calculation unit 140.
  • TL is a target travel route for automatic travel set by the target travel route setting unit 513.
  • RL is an imaginary line that passes through the reference point: RP of the vehicle body 110 and is parallel to the target travel route: TL.
  • DL is a vehicle body azimuth line indicating a vehicle body azimuth, which is the front-back direction of the vehicle body 110.
  • the vehicle body azimuth line: DL is inclined with respect to the imaginary line: RL, and the inclination angle is indicated by ⁇ .
  • the combine body 110 is separated from the target travel route TL on the right side of the drawing.
  • the vehicle body azimuth line: DL of the vehicle body 110 is oriented away from the target travel route TL as the vehicle travels in the vehicle travel direction.
  • d is the lateral deviation of the vehicle body 110 calculated by the lateral deviation calculator 156.
  • VP is an estimated target point calculated by the target point estimation unit 157.
  • AP is an auxiliary point.
  • the auxiliary point: AP is a projection point from the reference point: RP of the vehicle body 110 at the vehicle position to the target travel route: TL.
  • AL1 is the first auxiliary line.
  • the first auxiliary line is a straight line that passes through the estimated target point: VP and the reference point of the vehicle body 110: RP.
  • AL2 is the second auxiliary line.
  • This second auxiliary line is a straight line extending radially from the reference point: RP at an angle with respect to the first auxiliary line: AL1 by a correction angle (indicated by ⁇ ) corresponding to a second correction azimuth described later. Is.
  • the target point estimation unit 157 calculates an estimated target point: VP, which is a position on the target travel route: TL, which corresponds to the position after the vehicle body 110 has traveled from the present time (future vehicle position).
  • the estimated target point: VP can be calculated, for example, by the following method.
  • Auxiliary point: AP is a starting point, and a position after moving a target traveling route: TL for a predetermined time is an estimated target point: VP.
  • the vehicle speed calculated by the vehicle speed calculation unit 142 is used.
  • the predetermined time may be set in advance, or may be automatically or artificially (driver or manager) selected according to the state of the harvested product or the state of the field.
  • the predetermined time is preferably about 0.5 to 5 seconds.
  • An auxiliary target point: AP is set as a starting point, and a position separated by a predetermined distance on the target traveling route: TL is set as an estimated target point: VP.
  • the predetermined distance may be set in advance, or may be automatically or artificially (driver or manager) selected depending on the state of the harvested product or the state of the field. In the case of combine, the predetermined distance is preferably about 1 m to several m.
  • the correction azimuth calculation unit 109A calculates a correction azimuth that eliminates the deviation between the estimated target point: VP and the vehicle position.
  • This corrected azimuth is a target steering azimuth (steering amount in steering control) for the vehicle body 110 to get on the target travel route TL.
  • the correction azimuth calculation unit 109A calculates the correction azimuth by using an estimated azimuth deviation calculator 190, a first controller 191, a second controller 192, and a calculation. And a container 193.
  • the estimated azimuth deviation calculation unit 190 calculates, as the estimated azimuth deviation, an angle (indicated by ⁇ in FIG. 20) formed by the first auxiliary line: AL1 and the virtual line: RL.
  • the first controller 191 outputs the first corrected azimuth that should be a temporary steering target of the vehicle body 110, using the estimated azimuth deviation as an input parameter.
  • the first corrected azimuth is a steering azimuth in steering control that is calculated to eliminate the estimated azimuth deviation.
  • the estimated azimuth deviation corresponds to the angle ⁇ for moving the vehicle body 110 toward the estimated target point: VP, so that the output from the first controller 191 is preferably proportional to the estimated azimuth deviation that is an input. Therefore, in this embodiment, the first controller 191 is configured as a proportional controller.
  • the second controller 192 outputs the second corrected azimuth using the lateral deviation: d as an input parameter.
  • the second controller 192 calculates a correction angle (indicated by ⁇ in FIG. 20) based on the lateral deviation: d, and the second correction azimuth corresponds to the correction angle: ⁇ . Is the steering direction.
  • the second controller 192 calculates the steering azimuth for changing the direction of the vehicle body 110 so as to reduce the lateral deviation: d, and is configured as an integral controller in this embodiment.
  • the second controller 192 may be configured as a proportional controller.
  • Calculator 193 performs addition calculation of the first corrected azimuth and the second corrected azimuth and outputs the corrected azimuth as the calculation result.
  • This addition operation corresponds to ⁇ + ⁇ if it is expressed by an angle with reference to FIG.
  • This corrected azimuth is an output value of the corrected azimuth calculation unit 109A and is given to the control calculation unit 109B.
  • a weight operation or the like may be used other than the simple addition.
  • the second controller 192 may be omitted. In that case, the arithmetic unit 193 becomes unnecessary.
  • the control calculation unit 109B includes a calculator 195 and a steering controller 196 in order to output a control amount for the vehicle body 110 to travel along the target travel route: TL.
  • the steering controller 196 is configured as a PI controller or a P controller.
  • the control calculation unit 109B uses not only the corrected azimuth from the correction azimuth calculation unit 109A but also the current vehicle body azimuth calculated by the vehicle azimuth calculation unit 141 as an input parameter.
  • the vehicle body azimuth at this point of time corresponds to the angle (indicated by ⁇ in FIG. 20) formed by the imaginary line: RL and the vehicle body azimuth line: DL.
  • the calculator 195 performs addition calculation of the corrected heading and the vehicle body heading.
  • the calculation output of the calculator 195 is given to the steering controller 196 as a control target value of the steering controller 196. Further, the output value from the steering controller 196 is given to the automatic travel control unit 512 as a control amount for steering.
  • the automatic travel control unit 512 converts the control amount (referred to as steering input) given from the control arithmetic unit 109B into 16 bits and outputs it as steering output.
  • steering input the control amount
  • the steering input is evenly assigned to each bit and the steering output is derived.
  • FIG. 22 shows an operation in which the bit expansion function is introduced in order to improve such operation and realize precise steering for a small input control amount close to zero.
  • one bit corresponding to the minimum area of the steering input is further divided into four.
  • the estimated target point: the auxiliary point (starting point) used to estimate the VP: AP changes from the reference point: RP of the vehicle body 110 to the target travel route: TL. It was the intersection (projection point) between the lowered perpendicular and the target travel route: TL. Instead of this, the intersection point (projection point) between the target traveling route: TL and the line drawn from the reference point: RP to the target traveling route: TL at an angle of 90° plus or minus a predetermined angle is an auxiliary point: AP.
  • the predetermined angle is an angle larger than 0 and up to several tens of degrees, and may be a fixed value, or may be changed manually or automatically depending on the vehicle speed and the field condition. Further, when the intersection between the vehicle body azimuth line: DL and the target travel route: TL is located downstream of the auxiliary point: AP in the traveling direction of the vehicle body 110, the intersection between the vehicle body azimuth line: DL and the target travel route: TL. May be an auxiliary point: AP.
  • the substantial harvesting work is performed by traveling along the straight traveling route of the combine.
  • This linear travel route is not limited to one straight line. It may be a bent route, a route curved with a large radius of curvature, or a meandering route.
  • the shape of the uncut area CA1 is a quadrangle, but it may be another polygon such as a triangle or a pentagon.
  • the functional block group of the control device 105 shown in FIGS. 18 and 19 is intended for easy understanding, and each functional block may be further divided, integrated, or omitted. Further, all or some of the functional blocks may be built in the general-purpose terminal 104.
  • It may be configured as a control program that causes a computer to realize the function of each member in the above-described embodiment. Further, it may be configured as a recording medium in which a control program for causing a computer to realize the functions of the respective members in the above-described embodiment is recorded. Further, in the above-described embodiment, it may be configured as a control method in which what is performed by each member is performed by one or a plurality of steps.
  • the present invention can be applied not only to ordinary combine harvesters, but also to various work vehicles such as self-removing combine harvesters, rice transplanters, tractors, and construction work machines.
  • control device can be used not only for a normal combine harvester, but also for a self-removing combine harvester, such as a field work vehicle such as a rice transplanter or a tractor, and a lawn mower or a front loader. It can also be applied to cars.
  • a self-removing combine harvester such as a field work vehicle such as a rice transplanter or a tractor, and a lawn mower or a front loader. It can also be applied to cars.
  • (First embodiment) 1 combine (work vehicle) 2 Automatic travel control system 23 Route calculation unit 24 Travel control unit 25 Lateral deviation detection unit (detection unit) CA work area (non-work area) LI reaping travel route (target travel route) M1 1st correspondence relationship M2 2nd correspondence relationship M3 3rd correspondence relationship SA Peripheral area (already working area) d1 first threshold d2 second threshold

Landscapes

  • Engineering & Computer Science (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Mechanical Engineering (AREA)
  • Soil Sciences (AREA)
  • Environmental Sciences (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Guiding Agricultural Machines (AREA)

Abstract

自動走行制御システム2は、未作業領域を通る目標走行経路を算出する経路算出部23と、作業車が目標走行経路に沿って自動走行するように、目標走行経路と作業車との間の距離である横偏差に基づいて旋回出力を算出することにより作業車の走行を制御する走行制御部24と、作業車の状態を検出する検出部25と、を備え、走行制御部24は、作業車が既作業領域から未作業領域に進入する際、検出部25により検出された状態に基づいて、横偏差と旋回出力との対応関係を決定する。

Description

自動走行制御システム、自動走行制御プログラム、自動走行制御プログラムを記録した記録媒体、自動走行制御方法、制御装置、制御プログラム、制御プログラムを記録した記録媒体、制御方法
 本発明は、作業車の自動走行を制御する自動走行制御システムに関する。
 また、本発明は、目標走行経路に沿って自動走行する作業車のための制御装置に関する。
 [1]特許文献1には、自動走行が可能な作業車(特許文献1では「コンバイン」)の発明が記載されている。この作業車を利用した収穫作業において、オペレータは、収穫作業の最初にコンバインを手動で操作し、圃場内の外周部分を一周するように刈取走行を行う。
 この外周部分での走行において、作業車の走行すべき方位が記録される。そして、記録された方位に基づく自動走行によって、圃場における未刈領域での刈取走行が行われる。
 [2]特許文献2には、予め設定された目標走行経路に沿って自動走行する農業用作業車が開示されている。この農業用作業車では、GPSを用いて算出された自車位置が目標走行経路上に設定された目標点に向かうように、操向機構が制御される。その際、車体前側部分から目標点までの距離は、車体前側部分から目標走行経路に下ろした垂線の長さ(横偏差)が大きいほど小さくなるように設定される。
 特許文献3に開示されている作業車においては、目標走行経路に対する横偏差と、目標走行経路に対する方位偏差と、に基づいて、目標操舵値が演算される。そして、この目標操舵値に基づいて、操舵駆動信号が出力される。具体的には、第1操舵値と第2操舵値とから目標操舵値が演算される。第1操舵値は、横偏差に基づいて演算される。第2操舵値は、方位偏差に基づいて導出された演算値を重み係数によって調整して得られる値に基づいて演算される。横偏差が大きいほど、この重み係数は小さくなる。
日本国実開平2-107911号公報 日本国特開2002-182741号公報 日本国特開2016-155491号公報
 [1]背景技術[1]に対応する課題は、以下の通りである。
 特許文献1には、作業車の旋回出力の算出については詳述されていない。尚、旋回出力とは、作業車を旋回させるための走行装置の制御量を決定するための出力値である。旋回出力に基づいて、走行装置の制御量が決定される。
 ここで、特許文献1に記載の作業車において、作業車が目標走行経路に沿って自動走行するように、目標走行経路と作業車との間の距離である横偏差に基づいて旋回出力を算出することにより作業車の走行を制御する走行制御部を備えることが考えられる。この構成であれば、旋回出力は横偏差に基づいて算出される。
 しかしながら、作業車の状態によって、適切な旋回出力は異なる。即ち、横偏差と旋回出力との対応関係が、作業車の状態によらず一定である構成では、旋回出力が適切な値にならない事態が想定される。
 本発明の目的は、作業車の状態に応じた旋回出力を算出可能な自動走行制御システムを提供することである。
 [2]背景技術[2]に対応する課題は、以下の通りである。
 特許文献2による作業車では、車体が目標走行経路から横方向に大きく外れている場合には、大きな操舵角によって位置ずれが解消される。また、車体が目標走行経路から横方向に小さく外れている場合には、小さな操舵角によって位置ずれが解消される。大きな操舵角を用いることで、位置ずれは迅速に解消される。しかしながら、作業地を走行装置(車輪やクローラ)によって荒らしてしまうという問題が生じる。特に、作業地が圃場などの場合、この問題は深刻である。
 特許文献3による作業車では、横偏差が大きい場合には、方位偏差をある程度無視して、横偏差の解消を重視して算出された目標操舵値が出力される。このため、この作業車においても、横偏差が大きい場合には、大きな操舵角が用いられることとなる。その結果、特許文献2による作業車と同様な問題が生じる。即ち、作業地を走行装置(車輪やクローラ)によって荒らしてしまう。
 上記実情から、目標走行経路から外れた自動走行作業車を元に戻すための改善された制御装置が要望されている。
 [1]課題[1]に対応する解決手段は、以下の通りである。
 本発明の特徴は、未作業領域を通る目標走行経路を算出する経路算出部と、作業車が前記目標走行経路に沿って自動走行するように、前記目標走行経路と前記作業車との間の距離である横偏差に基づいて旋回出力を算出することにより前記作業車の走行を制御する走行制御部と、前記作業車の状態を検出する検出部と、を備え、前記走行制御部は、前記作業車が既作業領域から前記未作業領域に進入する際、前記検出部により検出された状態に基づいて、前記横偏差と前記旋回出力との対応関係を決定することにある。
 本発明であれば、作業車の状態に基づいて、横偏差と旋回出力との対応関係が決定される。従って、作業車の状態に応じた旋回出力を算出可能な自動走行制御システムを実現できる。
 さらに、本発明において、前記検出部は、前記横偏差を検出し、前記走行制御部は、前記作業車が前記既作業領域から前記未作業領域に進入する際、前記横偏差が第1閾値を超えている場合、前記横偏差と前記旋回出力との対応関係を第1対応関係に決定し、前記走行制御部は、前記作業車が前記既作業領域から前記未作業領域に進入する際、前記横偏差が前記第1閾値を超えていない場合、前記横偏差と前記旋回出力との対応関係を第2対応関係に決定し、前記第1対応関係における前記旋回出力は、前記第2対応関係における前記旋回出力よりも小さいと好適である。
 この構成によれば、作業車が、横偏差を0(ゼロ)に近づけるように、機体左右方向において目標走行経路へ寄りながら前進していく場合、横偏差が第1閾値を超えている間は、旋回出力が比較的小さくなりやすい。
 これにより、横偏差が第1閾値を超えている間は、作業車が目標走行経路へ緩やかに寄りやすくなる。従って、作業車が目標走行経路へ急激に接近していくことにより目標走行経路を超えてしまうオーバーシュートが起こりにくくなる。
 さらに、本発明において、前記走行制御部は、前記作業車が旋回しながら前記既作業領域から前記未作業領域に進入する際、前記横偏差が第2閾値を超えている場合、前記作業車に、一旦後進してから再度前進して前記未作業領域への進入を試みる走行であるリトライ走行を行わせると好適である。
 この構成によれば、作業車が旋回しながら既作業領域から未作業領域に進入する際、横偏差が第2閾値を超えると、作業車は、自動的にリトライ走行を行う。これにより、横偏差が第2閾値よりも大きい状態で作業車が既作業領域から未作業領域に進入してしまう事態を回避できる。
 しかも、この構成によれば、リトライ走行によって、横偏差を縮小させた上で、未作業領域への進入を試みることができる。
 さらに、本発明において、前記走行制御部は、前記リトライ走行が行われている場合、前記横偏差と前記旋回出力との対応関係を第3対応関係に決定し、前記第3対応関係における前記旋回出力は、前記第1対応関係における前記旋回出力よりも大きいと好適である。
 この構成によれば、リトライ走行が行われている場合、旋回出力が比較的大きくなりやすい。これにより、リトライ走行において、作業車が目標走行経路へ速やかに近づきやすくなる。
 さらに、本発明において、前記走行制御部は、自動走行開始時において、前記横偏差が前記第2閾値を超えている場合、前記作業車に前記リトライ走行を行わせないと好適である。
 自動走行開始時にリトライ走行が行われた場合、作業車が後進することにより、作業車に搭乗しているオペレータが違和感を覚える事態が想定される。
 ここで、上記の構成によれば、自動走行開始時においては、リトライ走行は行われない。これにより、上述のようにオペレータが違和感を覚える事態を回避できる。
 また、本発明の別の特徴は、自動走行制御プログラムであって、未作業領域を通る目標走行経路を算出する経路算出機能と、作業車が前記目標走行経路に沿って自動走行するように、前記目標走行経路と前記作業車との間の距離である横偏差に基づいて旋回出力を算出することにより前記作業車の走行を制御する走行制御機能と、前記作業車の状態を検出する検出機能と、をコンピュータに実現させ、前記走行制御機能は、前記作業車が既作業領域から前記未作業領域に進入する際、前記検出機能により検出された状態に基づいて、前記横偏差と前記旋回出力との対応関係を決定することにある。
 また、本発明の別の特徴は、自動走行制御プログラムを記録した記録媒体であって、未作業領域を通る目標走行経路を算出する経路算出機能と、作業車が前記目標走行経路に沿って自動走行するように、前記目標走行経路と前記作業車との間の距離である横偏差に基づいて旋回出力を算出することにより前記作業車の走行を制御する走行制御機能と、前記作業車の状態を検出する検出機能と、をコンピュータに実現させる自動走行制御プログラムを記録しており、前記走行制御機能は、前記作業車が既作業領域から前記未作業領域に進入する際、前記検出機能により検出された状態に基づいて、前記横偏差と前記旋回出力との対応関係を決定することにある。
 また、本発明の別の特徴は、自動走行制御方法であって、未作業領域を通る目標走行経路を算出する経路算出ステップと、作業車が前記目標走行経路に沿って自動走行するように、前記目標走行経路と前記作業車との間の距離である横偏差に基づいて旋回出力を算出することにより前記作業車の走行を制御する走行制御ステップと、前記作業車の状態を検出する検出ステップと、備え、前記走行制御ステップにおいて、前記作業車が既作業領域から前記未作業領域に進入する際、前記検出ステップにより検出された状態に基づいて、前記横偏差と前記旋回出力との対応関係が決定されることにある。
 [2]課題[2]に対応する解決手段は、以下の通りである。
 上記課題を解決するため、目標走行経路に沿って自動走行する作業車のための制御装置は、前記作業車の自車位置を算出する自車位置算出部と、所定時間後の前記目標走行経路における推定目標点を算出する目標点推定部と、前記推定目標点と前記自車位置との間の偏差を解消する補正方位を演算する補正方位演算ユニットと、前記補正方位を入力パラメータとして、前記偏差が縮小されるように前記作業車の走行方向を変更するための制御量を出力する制御演算ユニットとを備える。
 この構成では、作業車を目標走行経路に沿って走行させる制御を行う際に、まずは、推定目標点が算出される。推定目標点とは、所定時間後に目標走行経路上の制御目標点となると推定される点である。そして、推定目標点と自車位置との間の偏差を縮小するための制御量が、演算され、出力される。出力された制御量によって、車輪やクローラなどの操向機器が制御される。作業車を目標走行経路に沿って走行させる制御を行う際には、所定時間後の目標走行経路上での作業車の位置が、推定目標点となる。言い換えれば、現状の自車位置から作業車の進行方向へ離れた地点に位置しており、且つ、目標走行経路上に位置している位置が、推定目標点となる。そして、当該所定時間が長いほど、推定目標点に対する車体方位(車体前後方向の向き)のずれは小さくなる。従って、当該所定時間が長いほど、操向機器を制御するための制御量は小さくなる。この所定時間を、この制御装置を搭載する作業車に応じて適切に設定することにより、作業車に適した操舵制御が実現する。
 本発明の制御における、適切な所定時間は、作業車の種類によって異なる。また、適切な所定時間は、作業地における作業車の走行面の状態、作業車の走行状態など種々の条件によって異なる可能性がある。このような作業車の種類、作業状態、圃場状態などを、ここでは作業車の状態と総称する。前記所定時間は、前記作業車の状態によって変更されることが好ましい。もちろん、作業車に対して運転者が設定した操作機器の状態に基づいて、自動的に前記所定時間が設定されてもよい。
 自車が目標走行経路上の推定目標点に向かうように走行方向が調節されると、作業車の目標走行経路からの位置ずれは縮小される。このことから、本発明の好適な実施形態の1つでは、前記推定目標点と前記自車位置とを通る直線と前記目標走行経路とがなす角度を推定方位偏差として算出する推定方位偏差算出部が備えられ、前記補正方位演算ユニットは、前記推定方位偏差を入力パラメータとして第1補正方位を出力する第1制御器を備え、前記第1補正方位に基づいて前記補正方位が演算される。前記補正方位演算ユニットは、前記推定目標点と前記自車位置とを通る直線と前記目標走行経路とがなす推定方位偏差を入力パラメータとして第1補正方位を出力する第1制御器を備え、前記第1補正方位に基づいて前記補正方位が演算される。
 推定方位偏差が大きいほど、車体の走行方向を変更するための制御量が大きくなる。したがって、この制御をスムーズに行うために、前記第1制御器は比例制御器で構成されることが好ましい。
 推定方位偏差だけを入力パラメータとして車体の走行方向を変更するための補正方位を演算するよりは、目標走行経路の左右方向での車体と目標走行経路との距離(横偏差と称する)も入力パラメータとして利用し、車体の走行方向を変更するための補正方位を演算する方が、目標走行経路から外れた車体をより適切に戻すことができる。このため、本発明の好適な実施形態の1つでは、前記目標走行経路の経路方位に直交する方向での前記自車位置から前記目標走行経路までの距離を横偏差として算出する横偏差算出部が備えられ、前記補正方位演算ユニットは、前記横偏差を入力パラメータとして第2補正方位を出力する第2制御器を備え、前記第1補正方位と前記第2補正方位とに基づいて、前記補正方位が演算される。
 横偏差に基づく車体の走行方向を変更するための補正方位を求める際に、単純な比例演算を用いる構成においては、横偏差が大きい場合、演算結果としての補正方位が大きくなり過ぎることがある。この問題を避けるため、本発明の好適な実施形態の1つでは、前記第2制御器は積分制御器で構成される。
 車体の走行方向を変更する場合、その車体の挙動は、車速によって異なる。高い車速での走行方向の大きな変更は避ける必要がある。このため、車速が大きいほど、推定目標点が、車体から遠ざかることが好ましい。このことから、本発明の好適な実施形態の1つでは、前記作業車の車速を算出する車速算出部が備えられ、前記目標点推定部は、前記自車位置から前記目標走行経路への射影点を出発点として、前記目標走行経路を前記車速で前記所定時間移動した点の位置を前記推定目標点とする。これにより、車速が高いほど、推定目標点は車体から走行方向に離れることになる。上記射影点という語句は、厳密には、ある点から目標走行経路に垂線を下ろしたときの垂線と目標走行経路との交点である。しかしながら、ここでは、ある点から目標走行経路に対して垂直ではなくてやや傾きをもって下ろした線と、目標走行経路と、の交点も射影点に含めるものとする。
 車体の走行方向を変更する場合、その時の車体の向きである車体方位も考慮すれば、目標走行経路から外れた車体は、より適切に目標走行経路に戻ることができる。このことから、本発明の好適な実施形態の1つでは、車体の向きを示す車体方位を算出する車体方位算出部が備えられ、前記制御演算ユニットは、さらに前記車体方位を入力パラメータとして用いる。
 これまでの本発明の説明では、推定目標点は、所定時間後の作業車の位置を考慮して、算出されている。車速に所定時間をかけることにより、所定時間での作業車の移動距離を得ることができる。例えばコンバインや田植機など、圃場を走行する作業車の作業時の車速は、それほど大きくない。おおよその車速が前もって決められていれば、所定時間で作業車が移動する距離を、前もって算出できる。この場合、目標点推定部は、前もって設定されている所定距離を出発点に加算するだけで、推定目標点を算出できる。このことを利用した、本発明による、目標走行経路に沿って自動走行する作業車のための制御装置は、前記作業車の自車位置を算出する自車位置算出部と、前記自車位置から前記目標走行経路への射影点から前記目標走行経路上で前記作業車の走行方向側に所定距離離れた位置を推定目標点として算出する目標点推定部と、前記推定目標点と前記自車位置との間の偏差を解消する補正方位を演算する補正方位演算ユニットと、前記補正方位を入力パラメータとして、前記偏差が縮小されるように前記作業車を制御するための制御量を出力する制御演算ユニットとを備える。この構成の制御装置も、実質的に上述した作用効果と同じ作用効果を得ることができる。
 また、本発明の別の特徴は、目標走行経路に沿って自動走行する作業車のための制御プログラムであって、前記作業車の自車位置を算出する自車位置算出機能と、所定時間後の前記目標走行経路における推定目標点を算出する目標点推定機能と、前記推定目標点と前記自車位置との間の偏差を解消する補正方位を演算する補正方位演算機能と、前記補正方位を入力パラメータとして、前記偏差が縮小されるように前記作業車を制御するための制御量を出力する制御演算機能と、をコンピュータに実現させることにある。
 また、本発明の別の特徴は、目標走行経路に沿って自動走行する作業車のための制御プログラムを記録した記録媒体であって、前記作業車の自車位置を算出する自車位置算出機能と、所定時間後の前記目標走行経路における推定目標点を算出する目標点推定機能と、前記推定目標点と前記自車位置との間の偏差を解消する補正方位を演算する補正方位演算機能と、前記補正方位を入力パラメータとして、前記偏差が縮小されるように前記作業車を制御するための制御量を出力する制御演算機能と、をコンピュータに実現させる制御プログラムを記録していることにある。
 また、本発明の別の特徴は、目標走行経路に沿って自動走行する作業車のための制御方法であって、前記作業車の自車位置を算出する自車位置算出ステップと、所定時間後の前記目標走行経路における推定目標点を算出する目標点推定ステップと、前記推定目標点と前記自車位置との間の偏差を解消する補正方位を演算する補正方位演算ステップと、前記補正方位を入力パラメータとして、前記偏差が縮小されるように前記作業車を制御するための制御量を出力する制御演算ステップと、を備えることにある。
 また、本発明の別の特徴は、目標走行経路に沿って自動走行する作業車のための制御プログラムであって、前記作業車の自車位置を算出する自車位置算出機能と、前記自車位置から前記目標走行経路への射影点から前記目標走行経路上で前記作業車の走行方向側に所定距離離れた位置を推定目標点として算出する目標点推定機能と、前記推定目標点と前記自車位置との間の偏差を解消する補正方位を演算する補正方位演算機能と、前記補正方位を入力パラメータとして、前記偏差が縮小されるように前記作業車を制御するための制御量を出力する制御演算機能と、をコンピュータに実現させることにある。
 また、本発明の別の特徴は、目標走行経路に沿って自動走行する作業車のための制御プログラムを記録した記録媒体であって、前記作業車の自車位置を算出する自車位置算出機能と、前記自車位置から前記目標走行経路への射影点から前記目標走行経路上で前記作業車の走行方向側に所定距離離れた位置を推定目標点として算出する目標点推定機能と、前記推定目標点と前記自車位置との間の偏差を解消する補正方位を演算する補正方位演算機能と、前記補正方位を入力パラメータとして、前記偏差が縮小されるように前記作業車を制御するための制御量を出力する制御演算機能と、をコンピュータに実現させる制御プログラムを記録していることにある。
 また、本発明の別の特徴は、目標走行経路に沿って自動走行する作業車のための制御方法であって、前記作業車の自車位置を算出する自車位置算出ステップと、前記自車位置から前記目標走行経路への射影点から前記目標走行経路上で前記作業車の走行方向側に所定距離離れた位置を推定目標点として算出する目標点推定ステップと、前記推定目標点と前記自車位置との間の偏差を解消する補正方位を演算する補正方位演算ステップと、前記補正方位を入力パラメータとして、前記偏差が縮小されるように前記作業車を制御するための制御量を出力する制御演算ステップと、を備えることにある。
第1実施形態を示す図であって(以下、図13まで同じ。)、コンバインの左側面図である。 圃場における周回走行を示す図である。 刈取走行経路に沿った刈取走行を示す図である。 制御部に関する構成を示すブロック図である。 横偏差と旋回出力との対応関係を示す図である。 コンバインが外周領域から作業対象領域に進入する場合の例を示す図である。 リトライ走行が行われる場合の例を示す図である。 リトライ走行が行われない場合の例を示す図である。 旋回出力と出力レベルとの対応関係を示す図である。 出力レベルがA1である場合における旋回内側のサイドクラッチの入切状態の推移を示す図である。 出力レベルがB3である場合における旋回内側のサイドクラッチの入切状態の推移を示す図である。 出力レベルがB2である場合における旋回内側のサイドクラッチの入切状態の推移を示す図である。 出力レベルがB1である場合における旋回内側のサイドクラッチの入切状態の推移を示す図である。 第2実施形態を示す図であって(以下、図22まで同じ。)、圃場作業車の一例としての普通型のコンバインの側面図である。 コンバインの周囲刈り走行を示す説明図である。 Uターンでつながれた往復走行を繰り返すUターン走行パターンを示す説明図である。 アルファターン走行を用いた渦巻き走行のための走行パターンを示す説明図である。 コンバインの制御系の構成を示す機能ブロック図である。 補正方位演算ユニットと制御演算ユニットとの構成と、補正方位演算ユニットに入力されるデータとを説明する機能ブロック図である。 補正方位演算ユニットにおける偏差の解消原理を模式的に示す説明図である。 操舵入力と操舵出力の関係を示すグラフである。 操舵制御特性を改善するために改良された操舵入力と操舵出力の関係を示すグラフである。
[第1実施形態]
 以下、図1~図13を参照しながら、第1実施形態について説明する。尚、方向についての記載は、特に断りがない限り、図1に示す矢印Fの方向を「前」、矢印Bの方向を「後」とする。また、図1に示す矢印Uの方向を「上」、矢印Dの方向を「下」とする。
 〔コンバインの全体構成〕
 図1に示すように、普通型のコンバイン1(本発明に係る「作業車」に相当)は、クローラ式の走行装置11、運転部12、脱穀装置13、穀粒タンク14、収穫装置H、搬送装置16、穀粒排出装置18、衛星測位モジュール80、エンジンEを備えている。
 走行装置11は、コンバイン1における下部に備えられている。また、走行装置11は、エンジンEからの動力によって駆動する。そして、コンバイン1は、走行装置11によって自走可能である。
 また、運転部12、脱穀装置13、穀粒タンク14は、走行装置11の上側に備えられている。運転部12には、コンバイン1の作業を監視するオペレータが搭乗可能である。尚、オペレータは、コンバイン1の機外からコンバイン1の作業を監視していても良い。
 穀粒排出装置18は、穀粒タンク14の上側に設けられている。また、衛星測位モジュール80は、運転部12の上面に取り付けられている。
 収穫装置Hは、コンバイン1における前部に備えられている。そして、搬送装置16は、収穫装置Hの後側に設けられている。また、収穫装置Hは、刈取装置15及びリール17を有している。
 刈取装置15は、圃場の植立穀稈を刈り取る。また、リール17は、回転駆動しながら収穫対象の植立穀稈を掻き込む。この構成により、収穫装置Hは、圃場の穀物を収穫する。そして、コンバイン1は、刈取装置15によって圃場の植立穀稈を刈り取りながら走行装置11によって走行する刈取走行が可能である。
 刈取装置15により刈り取られた刈取穀稈は、搬送装置16によって脱穀装置13へ搬送される。脱穀装置13において、刈取穀稈は脱穀処理される。脱穀処理により得られた穀粒は、穀粒タンク14に貯留される。穀粒タンク14に貯留された穀粒は、必要に応じて、穀粒排出装置18によって機外に排出される。
 また、図1に示すように、運転部12には、通信端末4が配置されている。通信端末4は、種々の情報を表示可能に構成されている。本実施形態において、通信端末4は、運転部12に固定されている。しかしながら、本発明はこれに限定されず、通信端末4は、運転部12に対して着脱可能に構成されていても良いし、通信端末4は、コンバイン1の機外に位置していても良い。
 ここで、コンバイン1は、図2に示すように圃場における外周側の領域で穀物を収穫しながら周回走行を行った後、図3に示すように圃場における内側の領域で刈取走行を行うことにより、圃場の穀物を収穫するように構成されている。
 本実施形態においては、図2に示す周回走行は手動走行により行われる。また、図3に示す内側の領域での刈取走行は、自動走行により行われる。
 尚、本発明はこれに限定されず、図2に示す周回走行は自動走行により行われても良い。
 尚、オペレータは、通信端末4を操作することにより、エンジンEの回転速度を変更することができる。
 作物の種類によって、脱粒しやすさや倒伏しやすさ等の生育特性は異なる。従って、作物の種類によって、適切な作業速度は異なる。オペレータが通信端末4を操作し、エンジンEの回転速度を適切な回転速度に設定すれば、作物の種類に適した作業速度で作業を行うことができる。
 圃場での収穫作業において、コンバイン1は、自動走行制御システム2によって制御される。以下では、自動走行制御システム2の構成について説明する。
 〔自動走行制御システムの構成〕
 図4に示すように、自動走行制御システム2は、制御部20及び衛星測位モジュール80を備えている。尚、制御部20は、コンバイン1に備えられている。また、上述の通り、衛星測位モジュール80も、コンバイン1に備えられている。
 また、エンジンEから出力された動力は、走行装置11に入力される。これにより、上述の通り、走行装置11は、エンジンEからの動力によって駆動する。
 また、制御部20は、自車位置算出部21、領域算出部22、経路算出部23、走行制御部24を備えている。
 図1に示すように、衛星測位モジュール80は、GPS(グローバル・ポジショニング・システム)で用いられる人工衛星GSからのGPS信号を受信する。そして、図4に示すように、衛星測位モジュール80は、受信したGPS信号に基づいて、コンバイン1の自車位置を示す測位データを自車位置算出部21へ送る。
 自車位置算出部21は、衛星測位モジュール80により出力された測位データに基づいて、コンバイン1の位置座標を経時的に算出する。算出されたコンバイン1の経時的な位置座標は、領域算出部22及び走行制御部24へ送られる。
 領域算出部22は、自車位置算出部21から受け取ったコンバイン1の経時的な位置座標に基づいて、図3に示すように、外周領域SA(本発明に係る「既作業領域」に相当)及び作業対象領域CA(本発明に係る「未作業領域」に相当)を算出する。
 より具体的には、領域算出部22は、自車位置算出部21から受け取ったコンバイン1の経時的な位置座標に基づいて、圃場の外周側における周回走行でのコンバイン1の走行軌跡を算出する。そして、領域算出部22は、算出されたコンバイン1の走行軌跡に基づいて、コンバイン1が穀物を収穫しながら周回走行した圃場の外周側の領域を外周領域SAとして算出する。また、領域算出部22は、算出された外周領域SAよりも圃場内側の領域を、作業対象領域CAとして算出する。
 例えば、図2においては、圃場の外周側における周回走行のためのコンバイン1の走行経路が矢印で示されている。図2に示す例では、コンバイン1は、3周の周回走行を行う。そして、この走行経路に沿った刈取走行が完了すると、圃場は、図3に示す状態となる。
 図3に示すように、領域算出部22は、コンバイン1が穀物を収穫しながら周回走行した圃場の外周側の領域を外周領域SAとして算出する。また、領域算出部22は、算出された外周領域SAよりも圃場内側の領域を、作業対象領域CAとして算出する。そして、図4に示すように、領域算出部22による算出結果は、経路算出部23及び走行制御部24へ送られる。
 経路算出部23は、領域算出部22から受け取った算出結果に基づいて、図3に示すように、作業対象領域CAにおける刈取走行のための走行経路である刈取走行経路LI(本発明に係る「目標走行経路」に相当)を算出する。尚、図3に示すように、本実施形態においては、刈取走行経路LIは、互いに平行な複数の平行線である。また、複数の平行線は直線でなくても良く、湾曲していても良い。
 このように、経路算出部23は、作業対象領域CAを通る刈取走行経路LIを算出する。
 図4に示すように、経路算出部23により算出された刈取走行経路LIは、走行制御部24へ送られる。
 走行制御部24は、走行装置11を制御可能に構成されている。そして、走行制御部24は、自車位置算出部21から受け取ったコンバイン1の位置座標と、領域算出部22から受け取った算出結果と、経路算出部23から受け取った刈取走行経路LIと、に基づいて、コンバイン1の自動走行を制御する。より具体的には、走行制御部24は、図3に示すように、刈取走行経路LIに沿った自動走行によって刈取走行が行われるように、コンバイン1の走行を制御する。
 また、経路算出部23は、領域算出部22から受け取った算出結果に基づいて、図3に示すように、外周領域SAにおける非刈取走行のための走行経路である離脱復帰経路LWを算出する。尚、図3に示すように、本実施形態においては、離脱復帰経路LWは、圃場の外形に沿う形状の線である。
 図4に示すように、経路算出部23により算出された離脱復帰経路LWは、走行制御部24へ送られる。
 走行制御部24は、自車位置算出部21から受け取ったコンバイン1の位置座標と、経路算出部23から受け取った離脱復帰経路LWと、に基づいて、コンバイン1の自動走行を制御する。より具体的には、走行制御部24は、コンバイン1が刈取走行経路LIから離脱した場合に、離脱復帰経路LWに沿った自動走行によって非刈取走行が行われるように、コンバイン1の走行を制御する。
 〔自動走行制御システムを利用した収穫作業の流れ〕
 以下では、自動走行制御システム2を利用した収穫作業の例として、コンバイン1が、図2に示す圃場で収穫作業を行う場合の流れについて説明する。
 最初に、オペレータは、コンバイン1を手動で操作し、図2に示すように、圃場内の外周部分において、圃場の境界線に沿って周回するように刈取走行を行う。図2に示す例では、コンバイン1は、3周の周回走行を行う。この周回走行が完了すると、圃場は、図3に示す状態となる。
 領域算出部22は、自車位置算出部21から受け取ったコンバイン1の経時的な位置座標に基づいて、図2に示す周回走行でのコンバイン1の走行軌跡を算出する。そして、図3に示すように、領域算出部22は、算出されたコンバイン1の走行軌跡に基づいて、コンバイン1が植立穀稈を刈り取りながら周回走行した圃場の外周側の領域を外周領域SAとして算出する。また、領域算出部22は、算出された外周領域SAよりも圃場内側の領域を、作業対象領域CAとして算出する。
 次に、経路算出部23は、領域算出部22から受け取った算出結果に基づいて、図3に示すように、作業対象領域CAにおける刈取走行経路LIを設定する。また、このとき、経路算出部23は、領域算出部22から受け取った算出結果に基づいて、外周領域SAにおける離脱復帰経路LWを算出する。
 そして、オペレータが自動走行開始ボタン(図示せず)を押すことにより、図3に示すように、刈取走行経路LIに沿った自動走行が開始される。このとき、走行制御部24は、刈取走行経路LIに沿った自動走行によって刈取走行が行われるように、コンバイン1の走行を制御する。
 自動走行が開始されると、図3に示すように、コンバイン1は、刈取走行経路LIに沿った走行と、Uターンによる旋回と、を繰り返すことにより、作業対象領域CAの全体を網羅するように刈取走行を行う。
 ここで、コンバイン1により刈取走行が行われている間、上述の通り、刈取装置15により刈り取られた刈取穀稈は、搬送装置16によって脱穀装置13へ搬送される。そして、脱穀装置13において、刈取穀稈は脱穀処理される。
 尚、本実施形態においては、図2及び図3に示すように、圃場外に運搬車CVが駐車している。そして、外周領域SAにおいて、運搬車CVの近傍位置には、停車位置PPが設定されている。図3に示すように、停車位置PPは、離脱復帰経路LWに重複する位置に設定されている。
 運搬車CVは、コンバイン1が穀粒排出装置18から排出した穀粒を収集し、運搬することができる。穀粒排出の際、コンバイン1は停車位置PPに停車し、穀粒排出装置18によって穀粒を運搬車CVへ排出する。
 コンバイン1が刈取走行を続け、穀粒タンク14内の穀粒の量が所定量に達すると、走行制御部24は、刈取走行経路LIから離脱するようにコンバイン1の走行を制御する。
 コンバイン1が刈取走行経路LIから離脱した後、走行制御部24は、離脱復帰経路LWへ向かって走行するようにコンバイン1を制御する。そして、コンバイン1が離脱復帰経路LWの近傍に到達すると、走行制御部24は、離脱復帰経路LWに沿った自動走行によって非刈取走行が行われるように、コンバイン1の走行を制御する。
 そして、コンバイン1は停車位置PPに停車し、穀粒排出装置18によって穀粒を運搬車CVへ排出する。
 〔旋回出力の算出に関する構成〕
 図4に示すように、走行制御部24は、横偏差検出部25(本発明に係る「検出部」に相当)、旋回出力算出部26、出力変換部27、リトライ判定部28、進入判定部29、開始時判定部30を有している。
 横偏差検出部25は、コンバイン1の状態を検出するように構成されている。より具体的には、横偏差検出部25は、自車位置算出部21から受け取ったコンバイン1の位置座標と、経路算出部23から受け取った刈取走行経路LIと、に基づいて、横偏差を検出する。尚、横偏差とは、刈取走行経路LIとコンバイン1との間の距離である。
 横偏差検出部25により検出された横偏差は、旋回出力算出部26へ送られる。旋回出力算出部26は、横偏差検出部25から受け取った横偏差に基づいて、旋回出力を算出する。横偏差が大きいほど、旋回出力算出部26により算出される旋回出力は大きくなる。
 尚、旋回出力とは、出力レベルを決定するための出力値である。また、出力レベルとは、コンバイン1を旋回させるための走行装置11の制御量である。
 旋回出力算出部26により算出された旋回出力は、出力変換部27へ送られる。出力変換部27は、旋回出力算出部26から受け取った旋回出力に基づいて、出力レベルを決定する。
 そして、走行制御部24は、出力変換部27により決定された出力レベルに応じて走行装置11を制御することにより、コンバイン1の走行を制御する。このとき、走行制御部24は、コンバイン1が刈取走行経路LIに沿って自動走行するように、コンバイン1の走行を制御する。
 即ち、走行制御部24は、コンバイン1が刈取走行経路LIに沿って自動走行するように、横偏差に基づいて旋回出力を算出することによりコンバイン1の走行を制御する。
 尚、旋回出力が大きいほど、出力変換部27により決定される出力レベルは高くなる。そして、走行制御部24は、出力レベルが高いほどコンバイン1の旋回半径が小さくなるように、走行装置11を制御する。
 また、進入判定部29は、自車位置算出部21から受け取ったコンバイン1の位置座標と、領域算出部22から受け取った算出結果と、に基づいて、コンバイン1が外周領域SAから作業対象領域CAに進入しようとしている状態であるか否かを判定する。進入判定部29による判定結果は、旋回出力算出部26へ送られる。
 そして、進入判定部29により、コンバイン1が外周領域SAから作業対象領域CAに進入しようとしている状態であると判定された場合、旋回出力算出部26は、横偏差検出部25から受け取った横偏差に基づいて、横偏差と旋回出力との対応関係を決定する。
 このように、走行制御部24は、コンバイン1が外周領域SAから作業対象領域CAに進入する際、横偏差検出部25により検出された状態に基づいて、横偏差と旋回出力との対応関係を決定する。
 より具体的には、図6に示すように、進入判定部29により、コンバイン1が外周領域SAから作業対象領域CAに進入しようとしている状態であると判定されているとき、横偏差が第1閾値d1を超えている場合、旋回出力算出部26は、横偏差と旋回出力との対応関係を第1対応関係M1に決定する。
 また、進入判定部29により、コンバイン1が外周領域SAから作業対象領域CAに進入しようとしている状態であると判定されているとき、横偏差が第1閾値d1を超えていない場合、旋回出力算出部26は、横偏差と旋回出力との対応関係を第2対応関係M2に決定する。
 そして、図5に示すように、グラフの横軸に横偏差、縦軸に旋回出力を取ったときの第1対応関係M1の傾きは、第2対応関係M2の傾きよりも小さい。即ち、第1対応関係M1における旋回出力は、第2対応関係M2における旋回出力よりも小さい。
 このように、走行制御部24は、コンバイン1が外周領域SAから作業対象領域CAに進入する際、横偏差が第1閾値d1を超えている場合、横偏差と旋回出力との対応関係を第1対応関係M1に決定する。
 また、走行制御部24は、コンバイン1が外周領域SAから作業対象領域CAに進入する際、横偏差が第1閾値d1を超えていない場合、横偏差と旋回出力との対応関係を第2対応関係M2に決定する。
 また、図4に示すように、横偏差検出部25により検出された横偏差は、リトライ判定部28へ送られる。また、進入判定部29による判定結果も、リトライ判定部28へ送られる。
 また、開始時判定部30は、上述の自動走行開始ボタンの操作等の情報に基づいて、自動走行の開始時であるか否かを判定する。開始時判定部30による判定結果も、リトライ判定部28へ送られる。
 リトライ判定部28は、自車位置算出部21から受け取ったコンバイン1の位置座標と、経路算出部23から受け取った刈取走行経路LIと、進入判定部29から受け取った判定結果と、に基づいて、コンバイン1が旋回しながら外周領域SAから作業対象領域CAに進入しようとしている状態であるか否かを判定する。
 また、リトライ判定部28は、横偏差検出部25から受け取った横偏差に基づいて、横偏差が第2閾値d2を超えているか否かを判定する。
 そして、リトライ判定部28は、リトライ判定部28による上記の判定結果と、開始時判定部30から受け取った判定結果と、に基づいて、リトライ条件が満たされているか否かを判定する。尚、リトライ条件とは、コンバイン1にリトライ走行を行わせるための条件である。本実施形態において、リトライ条件は、「自動走行開始時ではなく、且つ、コンバイン1が旋回しながら外周領域SAから作業対象領域CAに進入しようとしている状態であり、且つ、横偏差が第2閾値d2を超えていること」である。また、リトライ走行とは、一旦後進してから再度前進して作業対象領域CAへの進入を試みる走行である。
 尚、図6に示すように、コンバイン1の機体の向きが目標とする刈取走行経路LIの延びる方向と同じまたは略同じであり、刈取走行経路LIへ向かって前進しながら、機体左右方向において刈取走行経路LIの位置へ機体を寄せていくケースは、「コンバイン1が旋回しながら外周領域SAから作業対象領域CAに進入しようとしている状態」には該当しない。
 また、図7に示すように、コンバイン1が、刈取走行経路LIの終端からUターン走行を開始し、別の刈取走行経路LIの始端へ向かって走行していくケースは、「コンバイン1が旋回しながら外周領域SAから作業対象領域CAに進入しようとしている状態」に該当する。
 そして、リトライ判定部28によってリトライ条件が満たされていると判定された場合、走行制御部24は、コンバイン1がリトライ走行を行うように、コンバイン1の走行を制御する。
 このように、走行制御部24は、コンバイン1が旋回しながら外周領域SAから作業対象領域CAに進入する際、横偏差が第2閾値d2を超えている場合、コンバイン1に、一旦後進してから再度前進して作業対象領域CAへの進入を試みる走行であるリトライ走行を行わせる。
 ここで、自動走行開始時である場合には、上述のリトライ条件は満たされない。即ち、コンバイン1が旋回しながら外周領域SAから作業対象領域CAに進入しようとしている状態であり、且つ、横偏差が第2閾値d2を超えている場合であっても、自動走行開始時においては、リトライ判定部28はリトライ条件が満たされていないと判定する。従って、この場合、走行制御部24は、コンバイン1にリトライ走行を行わせない。
 このように、走行制御部24は、自動走行開始時において、横偏差が第2閾値d2を超えている場合、コンバイン1にリトライ走行を行わせない。
 また、図4に示すように、リトライ判定部28による判定結果は、旋回出力算出部26へ送られる。旋回出力算出部26は、リトライ判定部28による判定結果に基づいて、横偏差と旋回出力との対応関係を決定する。
 より具体的には、リトライ判定部28により、リトライ条件が満たされていると判定された場合、旋回出力算出部26は、横偏差と旋回出力との対応関係を、第3対応関係M3に決定する。
 即ち、走行制御部24は、リトライ走行が行われている場合、横偏差と旋回出力との対応関係を第3対応関係M3に決定する。
 そして、図5に示すように、グラフの横軸に横偏差、縦軸に旋回出力を取ったときの第3対応関係M3の傾きは、第1対応関係M1の傾きよりも大きく、第2対応関係M2の傾きよりも小さい。即ち、第3対応関係M3における旋回出力は、第1対応関係M1における旋回出力よりも大きく、第2対応関係M2における旋回出力よりも小さい。
 尚、本実施形態において、旋回出力算出部26は、横偏差に基づく制御におけるゲイン(係数)を決定することにより、横偏差と旋回出力との対応関係を決定する。即ち、このゲインを決定することは、本発明に係る「横偏差と旋回出力との対応関係を決定する」ことに相当する。また、図5に示すグラフにおいては、このゲインが大きいほど、傾きが大きくなる。
 〔自動走行制御システムによる走行制御〕
 以下では、自動走行制御システム2による走行制御の例として、コンバイン1が図6から図8に示すように走行した場合について説明する。
 図6に示す例では、コンバイン1は、外周領域SAにおける位置P1から、刈取走行経路LIの始点である位置P3へ向かって走行する。即ち、図6に示す例では、コンバイン1は、外周領域SAから作業対象領域CAに進入する。このとき、進入判定部29は、コンバイン1が外周領域SAから作業対象領域CAに進入しようとしている状態であると判定する。進入判定部29による判定結果は、旋回出力算出部26及びリトライ判定部28へ送られる。
 ここで、位置P1における横偏差は、第1閾値d1より大きい。このときの横偏差は、横偏差検出部25により検出され、旋回出力算出部26及びリトライ判定部28へ送られる。
 また、上述の通り、コンバイン1の機体の向きが、目標とする刈取走行経路LIの延びる方向と同じまたは略同じであり、刈取走行経路LIへ向かって前進しながら、機体左右方向において刈取走行経路LIの位置へ機体を寄せていくケースは、「コンバイン1が旋回しながら外周領域SAから作業対象領域CAに進入しようとしている状態」には該当しない。
 そのため、図6に示す例では、リトライ判定部28は、リトライ条件が満たされていないと判定する。リトライ判定部28による判定結果は、旋回出力算出部26へ送られる。
 以上のことから、コンバイン1が位置P1に位置しているとき、旋回出力算出部26は、横偏差と旋回出力との対応関係を第1対応関係M1に決定する。
 その後、コンバイン1の走行に伴って横偏差は減少していく。そして、コンバイン1が位置P2に到達したとき、横偏差は第1閾値d1に等しくなる。このとき、旋回出力算出部26は、横偏差と旋回出力との対応関係を第2対応関係M2に決定する。
 即ち、コンバイン1が位置P2に到達する直前まで、横偏差と旋回出力との対応関係は第1対応関係M1である。そして、コンバイン1が位置P2に到達したとき、横偏差と旋回出力との対応関係は第2対応関係M2に変化する。
 その後、コンバイン1が位置P3に到達するまで、横偏差と旋回出力との対応関係は第2対応関係M2のまま維持される。
 また、図7に示す例では、コンバイン1は、刈取走行経路LIのうちの1つである第1経路LI1の終端からUターン走行を開始し、別の刈取走行経路LIである第2経路LI2の始端へ向かって走行していく。
 ここで、図7における位置P4は、第1経路LI1の終端である。また、位置P7は、第2経路LI2の始端である。即ち、コンバイン1は、位置P4から、位置P7へ向かってUターン走行を行う。
 図7においては、このときの目標旋回ラインが、位置P4と位置P7とを結ぶ破線により示されている。しかしながら、図7に示す例では、コンバイン1は、この目標旋回ラインを逸脱し、位置P5に到達する。ここで、位置P5における横偏差は、第2閾値d2より大きい。このときの横偏差は、横偏差検出部25により検出され、旋回出力算出部26及びリトライ判定部28へ送られる。
 また、このUターン走行において、進入判定部29は、コンバイン1が外周領域SAから作業対象領域CAに進入しようとしている状態であると判定する。進入判定部29による判定結果は、旋回出力算出部26及びリトライ判定部28へ送られる。
 また、このUターン走行において、開始時判定部30は、自動走行の開始時ではないと判定する。開始時判定部30による判定結果は、リトライ判定部28へ送られる。
 また、上述の通り、コンバイン1が、刈取走行経路LIの終端からUターン走行を開始し、別の刈取走行経路LIの始端へ向かって走行していくケースは、「コンバイン1が旋回しながら外周領域SAから作業対象領域CAに進入しようとしている状態」に該当する。
 従って、コンバイン1が位置P5に到達したとき、リトライ判定部28は、リトライ条件が満たされていると判定する。これにより、走行制御部24は、コンバイン1がリトライ走行を行うように、コンバイン1の走行を制御する。そのため、コンバイン1は、位置P5からリトライ走行を行う。
 また、リトライ判定部28による判定結果は、旋回出力算出部26へ送られる。リトライ判定部28により、リトライ条件が満たされていると判定されたため、旋回出力算出部26は、横偏差と旋回出力との対応関係を、第3対応関係M3に決定する。
 このリトライ走行において、コンバイン1は、位置P5から一旦後進し、位置P6に到達する。そして、位置P6から再度前進し、作業対象領域CAへの進入を試みる。その結果、コンバイン1は、位置P7へ到達すると共に、作業対象領域CAへ進入する。
 尚、コンバイン1が位置P5から後進を開始した時点から、コンバイン1が位置P7に到達するまで、横偏差と旋回出力との対応関係は第3対応関係M3のまま維持される。
 また、図8に示す例では、コンバイン1は、外周領域SAにおける位置P8から自動走行を開始する。このとき、開始時判定部30は、自動走行の開始時であると判定する。開始時判定部30による判定結果は、リトライ判定部28へ送られる。
 位置P8において、コンバイン1の機体の向きは、目標とする刈取走行経路LIの延びる方向に対して垂直な方向である。そのため、コンバイン1は、位置P8から、旋回しながら刈取走行経路LIの始点へ向かって走行する。
 そして、コンバイン1は位置P9に到達する。位置P9における横偏差は、第2閾値d2より大きい。このときの横偏差は、横偏差検出部25により検出され、旋回出力算出部26及びリトライ判定部28へ送られる。
 即ち、コンバイン1が位置P9に到達したとき、横偏差は第2閾値d2を超えている。しかしながら、上述の通り、開始時判定部30は、自動走行の開始時であると判定している。
 そのため、リトライ判定部28は、リトライ条件が満たされていないと判定する。従って、図8に示す例では、リトライ走行は行われない。
 尚、本実施形態において、走行制御部24は、開始時判定部30により自動走行の開始時であると判定され、且つ、横偏差検出部25により検出された横偏差が第2閾値d2を超えた場合、コンバイン1の走行を停止する。
 そのため、図8に示す例では、位置P9においてコンバイン1は停車する。
 〔出力レベルについて〕
 上述の通り、出力変換部27は、旋回出力算出部26から受け取った旋回出力に基づいて、出力レベルを決定する。そして、走行制御部24は、出力変換部27により決定された出力レベルに応じて走行装置11を制御することにより、コンバイン1の走行を制御する。
 図9では、旋回出力と、出力変換部27により決定される出力レベルと、の対応関係が示されている。
 図9に示すように、旋回出力が0(ゼロ)以上且つY1未満のとき、出力レベルは0(ゼロ)となる。
 また、旋回出力がY1以上且つY2未満のとき、出力レベルはB1となる。
 また、旋回出力がY2以上且つY3未満のとき、出力レベルはB2となる。
 また、旋回出力がY3以上且つX1未満のとき、出力レベルはB3となる。
 また、旋回出力がX1以上且つX2未満のとき、出力レベルはA1となる。
 また、旋回出力がX2以上且つX3未満のとき、出力レベルはA2となる。
 以降、同様に、旋回出力が大きいほど、出力レベルはA3、A4、A5……と高くなる。尚、図9においては、出力レベルはA3までしか示されていない。
 出力レベルがA2以上である場合、走行制御部24は、走行装置11における旋回内側のサイドブレーキ(図示せず)を制動状態に制御する。このとき、走行制御部24は、出力レベルが高いほど、サイドブレーキの制動力が大きくなるようにサイドブレーキを制御する。
 また、出力レベルがA1以下である場合、走行制御部24は、走行装置11における旋回内側のサイドクラッチ(図示せず)を切状態に制御する。尚、このとき、サイドブレーキは制動状態に制御されない。
 以下では、出力レベルがA1以下である場合について詳述する。
 出力レベルがA1以下である場合、図10から図13に示すように、走行制御部24は、走行装置11における旋回内側のサイドクラッチを、周期的に制御する。尚、各周期の長さはTである。
 出力レベルがA1である場合、図10に示すように、各周期において、旋回内側のサイドクラッチは常に切状態に制御される。即ち、出力レベルがA1である間は、旋回内側のサイドクラッチは切状態に維持される。
 出力レベルがB3である場合、図11に示すように、各周期において、まず、時間t1に亘って、旋回内側のサイドクラッチが切状態に制御される。その後、時間s1に亘って、旋回内側のサイドクラッチが入状態に制御される。尚、時間t1は時間s1よりも長い。
 これにより、出力レベルがB3である場合は、出力レベルがA1である場合に比べて、コンバイン1が緩やかに旋回する。
 出力レベルがB2である場合、図12に示すように、各周期において、まず、時間t2に亘って、旋回内側のサイドクラッチが切状態に制御される。その後、時間s2に亘って、旋回内側のサイドクラッチが入状態に制御される。尚、時間t2は時間s2よりも長く、時間t1よりも短い。
 これにより、出力レベルがB2である場合は、出力レベルがB3である場合に比べて、コンバイン1が緩やかに旋回する。
 出力レベルがB1である場合、図13に示すように、各周期において、まず、時間t3に亘って、旋回内側のサイドクラッチが切状態に制御される。その後、時間s3に亘って、旋回内側のサイドクラッチが入状態に制御される。尚、時間t3は時間s3よりも短く、時間t2よりも短い。
 これにより、出力レベルがB1である場合は、出力レベルがB2である場合に比べて、コンバイン1が緩やかに旋回する。
 尚、本実施形態においては、図11から図13に示すように、時間t1は時間t3の3倍の長さである。また、時間t2は時間t3の2倍の長さである。
 また、出力レベルが0(ゼロ)である場合は、左右のサイドクラッチは何れも入状態に維持される。即ち、出力レベルが0(ゼロ)である場合は、コンバイン1は旋回せず直進する。
 以上で説明した構成であれば、コンバイン1の状態に基づいて、横偏差と旋回出力との対応関係が決定される。従って、コンバイン1の状態に応じた旋回出力を算出可能な自動走行制御システム2を実現できる。
[第1実施形態の別実施形態]
 以下、上記した実施形態を変更した別実施形態について説明する。以下の各別実施形態で説明している事項以外は、上記した実施形態で説明している事項と同様である。上記した実施形態及び以下の各別実施形態は、矛盾が生じない範囲で、適宜組み合わせてもよい。なお、本発明の範囲は、上記した実施形態及び以下の各別実施形態に限定されるものではない。
 (1)走行装置11は、ホイール式であっても良いし、セミクローラ式であっても良い。
 (2)上記実施形態においては、経路算出部23により算出される刈取走行経路LIは、互いに平行な複数の平行線である。しかしながら、本発明はこれに限定されず、経路算出部23により算出される刈取走行経路LIは、互いに平行な複数の平行線でなくても良い。例えば、経路算出部23により算出される刈取走行経路LIは、縦横方向に延びる複数のメッシュ線であっても良いし、渦巻き状の走行経路であっても良い。
 (3)上記実施形態においては、オペレータは、コンバイン1を手動で操作し、図2に示すように、圃場内の外周部分において、圃場の境界線に沿って周回するように刈取走行を行う。しかしながら、本発明はこれに限定されず、コンバイン1が自動で走行し、圃場内の外周部分において、圃場の境界線に沿って周回するように刈取走行を行うように構成されていても良い。また、このときの周回数は、3周以外の数であっても良い。例えば、このときの周回数は2周であっても良い。
 (4)自車位置算出部21、領域算出部22、経路算出部23、走行制御部24のうち、一部または全てがコンバイン1の外部に備えられていても良いのであって、例えば、コンバイン1の外部に設けられた管理サーバに備えられていても良い。
 (5)図7に示す例では、コンバイン1が位置P5から後進を開始した時点から、コンバイン1が位置P7に到達するまで、横偏差と旋回出力との対応関係は第3対応関係M3のまま維持される。しかしながら、本発明はこれに限定されず、コンバイン1が位置P5から後進を開始した時点から、コンバイン1が位置P6に到達するまで、横偏差と旋回出力との対応関係は、第3対応関係M3以外の対応関係であっても良い。この場合、コンバイン1が位置P6から前進を開始した時点で、横偏差と旋回出力との対応関係が第3対応関係M3に変化しても良い。
 (6)走行制御部24は、自動走行開始時において、横偏差が第2閾値d2を超えている場合、コンバイン1にリトライ走行を行わせるように構成されていても良い。
 (7)第3対応関係M3における旋回出力は、第1対応関係M1における旋回出力よりも小さくても良い。
 (8)走行制御部24は、リトライ走行が行われている場合、横偏差と旋回出力との対応関係を第3対応関係M3以外の対応関係に決定しても良い。例えば、走行制御部24は、リトライ走行が行われている場合、横偏差と旋回出力との対応関係を第1対応関係M1に決定しても良い。
 (9)走行制御部24は、コンバイン1が旋回しながら外周領域SAから作業対象領域CAに進入する際、横偏差が第2閾値d2を超えている場合、コンバイン1にリトライ走行を行わせず、コンバイン1を停車させるように構成されていても良い。
 (10)第1対応関係M1における旋回出力は、第2対応関係M2における旋回出力よりも大きくても良い。
 (11)本発明に係る「検出部」は、上記実施形態における横偏差検出部25に限定されない。例えば、本発明に係る「検出部」に相当する部材として、コンバイン1の車速を検出する車速検出部が備えられていても良い。この場合、走行制御部24は、コンバイン1が外周領域SAから作業対象領域CAに進入する際、車速検出部により検出された車速に基づいて、横偏差と旋回出力との対応関係を決定するように構成されていても良い。
 また、例えば、本発明に係る「検出部」に相当する部材として、コンバイン1の作業内容を検出する作業内容検出部が備えられていても良い。作業内容とは、例えば、収穫対象作物の種類等である。この場合、走行制御部24は、コンバイン1が外周領域SAから作業対象領域CAに進入する際、作業内容検出部により検出された作業内容に基づいて、横偏差と旋回出力との対応関係を決定するように構成されていても良い。
 (12)第1閾値d1は、第2閾値d2より大きくても良いし、第2閾値d2より小さくても良いし、第2閾値d2と同一であっても良い。
 (13)出力変換部27は、設けられていなくても良い。
 (14)リトライ判定部28は、設けられていなくても良い。
 (15)開始時判定部30は、設けられていなくても良い。
 (16)上記実施形態における各部材の機能をコンピュータに実現させる自動走行制御プログラムとして構成されていても良い。また、上記実施形態における各部材の機能をコンピュータに実現させる自動走行制御プログラムが記録された記録媒体として構成されていても良い。また、上記実施形態において各部材により行われることを一つまたは複数のステップにより行う自動走行制御方法として構成されていても良い。
[第2実施形態]
 以下、図14~図22を参照しながら、本発明による制御装置を搭載した自動走行可能な作業車の一例として、普通型のコンバインを取り上げ、本発明の第2実施形態として説明する。なお、以下では、特に断りがない限り、「前」(図14に示す矢印Fの方向)は車体前後方向(走行方向)に関して前方を意味し、「後」(図14に示す矢印Bの方向)は車体前後方向(走行方向)に関して後方を意味する。また、左右方向または横方向は、車体前後方向に直交する車体横断方向(車体幅方向)を意味する。「上」(図14に示す矢印Uの方向)及び「下」(図14に示す矢印Dの方向)は、車体110の鉛直方向(垂直方向)での位置関係であり、地上高さにおける関係を示す。
 図14に示すように、このコンバインは、車体110、クローラ式の走行装置111、運転部112、脱穀装置113、収穫物タンクとしての穀粒タンク114、収穫部115、搬送装置116、穀粒排出装置118、自車位置検出ユニット180を備えている。
 走行装置111は、車体110の下部に備えられている。コンバインは、走行装置111によって自走可能に構成されている。運転部112、脱穀装置113、穀粒タンク114は、走行装置111の上方に備えられている。運転部112には、コンバインを運転する運転者及びコンバインの作業を監視する監視者が搭乗可能である。なお、監視者は、コンバインの機外からコンバインの作業を監視してもよい。
 穀粒排出装置118は、穀粒タンク114の後下部に連結されている。また、自車位置検出ユニット180は、運転部112の上面に取り付けられている。
 収穫部115は、コンバインにおける前部に備えられている。そして、搬送装置116は、収穫部115の後方に設けられている。コンバインは、収穫部115によって圃場の穀物を収穫しながら走行装置111によって走行する作業走行が可能である。
 収穫部115で刈り取られた刈取穀稈は、搬送装置116によって脱穀装置113へ搬送される。脱穀装置113において、刈取穀稈は脱穀処理される。脱穀処理により得られた穀粒は、穀粒タンク114に貯留される。穀粒タンク114に貯留された穀粒は、必要に応じて(満杯など)、穀粒排出装置118によって機外に排出される。
 また、運転部112には、汎用端末104が配置されている。本実施形態において、汎用端末104は、運転部112に固定されている。しかしながら、本発明はこれに限定されず、汎用端末104は、運転部112に対して着脱可能に構成されていても良い。また、汎用端末104は、コンバインの機外に持ち出し可能であってもよい。
 図15に示すように、このコンバインは、圃場において設定された走行経路に沿って自動走行する。これには、自車位置の情報が必要である。自車位置検出ユニット180には、衛星測位モジュール181と慣性計測モジュール182とが含まれている。衛星測位モジュール181は、人工衛星GSから送信される位置情報であるGNSS(global navigation satellite system)信号(GPS信号を含む)を受信して、自車位置を算出するための測位データを出力する。慣性計測モジュール182には、ジャイロ加速度センサ及び磁気方位センサが組み込まれている。そして、慣性計測モジュール182は、瞬時の走行方向を示す信号を出力する。慣性計測モジュール182は、衛星測位モジュール181による自車位置の算出を補完するために用いられる。慣性計測モジュール182は、衛星測位モジュール181とは別の場所に配置されてもよい。
 このコンバインによって圃場での収穫作業を行う場合の手順は、以下に説明する通りである。まず、運転者兼監視者は、コンバインを操作し、図15に示すように、圃場内の外周部分において、圃場の境界線に沿って周囲刈り走行しながら収穫を行う。周囲刈り走行により刈取り収穫作業の終わった領域は、外周領域SAとして設定される。そして、外周領域SAの内側に残された内部領域は未刈領域CA1である。未刈領域CA1は、今後の作業対象の領域として設定される。この実施形態では、未刈領域CA1が四角形となるように、周囲刈り走行が行われる。もちろん、三角形や五角形の未刈領域CA1が採用されてもよい。
 外周領域SAは、作業対象の領域である未刈領域CA1において収穫走行を行うときに、コンバインが方向転換するためのスペースとして利用される。また、外周領域SAは、収穫走行を一旦終えて穀粒の排出場所へ移動する際や、燃料の補給場所へ移動する際等の移動用のスペースとしても利用される。このため、外周領域SAの幅をある程度広く確保するために、自動または手動によって、2~3周の周囲刈り走行が行われる。
 なお、図15に示す運搬車CVは、コンバインが穀粒排出装置118から排出した穀粒を収集し、乾燥施設等へ運搬する。穀粒排出の際、コンバインは、外周領域SAを通って運搬車CVの近傍へ移動した後、穀粒排出装置118によって穀粒を運搬車CVへ排出する。その後、コンバインは、外周領域SAを通って、作業を中断した位置である作業開始点に戻る。
 未刈領域CA1の形状を示す未作業マップデータが、既作業領域である外周領域SAの内周形状に基づいて作成される。この未作業マップデータに基づいて、未刈領域CA1を自動運転で作業するために、線状(直線又は湾曲線または屈曲線)の経路が作業用走行経路として未刈領域CA1に設定される。また、1つの作業用走行経路から次の作業用走行経路に移行するための旋回走行経路が外周領域SAに設定される。未作業マップデータは、未刈領域CA1に対する作業の進行に伴って更新される。
 未刈領域CA1を作業走行(収穫走行)する際に用いられる走行パターンとして、図16に示す往復走行パターンと、図17に示す渦巻き走行パターンとがある。往復走行パターンでコンバインが走行する経路は、未刈領域CA1の外形を示す多角形の一辺に平行な作業用走行経路を含む。また、往復走行パターンでコンバインが走行する経路は、Uターン旋回経路を含む。渦巻き走行パターンでコンバインが走行する経路は、未刈領域CA1の外形を示す多角形の一辺に平行な作業用走行経路を含む。また。渦巻き走行パターンでコンバインが走行する経路は、アルファターン経路を含む。アルファターン経路は、直進経路と後進旋回経路と前進旋回経路とからなり、周方向で隣り合う作業用走行経路をつなぐ旋回経路である。
 図18に、コンバインの制御系が示されている。この制御系は、制御装置105と、各種入出力機器と、から構成されている。制御装置105は、1つ以上の電子制御ユニットからなる。電子制御ユニットは、ECUと呼ばれる。また、各種入出力機器と制御装置105との間で、車載LANなどの配線網を通じて、信号通信(データ通信)が行われる。
 制御装置105は、この制御系の中核要素である。また、制御装置105は、複数のECUの集合体として示されている。自車位置検出ユニット180からの信号は、車載LANを通じて制御装置105に入力される。
 制御装置105は、入出力インタフェースとして、報知部501と入力処理部502と出力処理部503とを備えている。
 報知部501は、制御装置105の各機能部からの指令等に基づいて報知データを生成し、報知デバイス162に与える。報知デバイス162は、運転者等に作業走行状態や種々の警告を報知するためのデバイスである。報知デバイス162は、例えば、ブザー、ランプ、スピーカ、ディスプレイなどである。
 入力処理部502には、走行状態センサ群163、作業状態センサ群164、人為操作具165、などが接続されている。作業状態センサ群164には、穀粒タンク114内の穀粒貯留量を検出するセンサが含まれている。人為操作具165は、レバー、スイッチ、ボタンなどの総称である。人為操作具165は、運転者によって手動操作される。そして、人為操作具165の操作信号は、制御装置105に入力される。
 出力処理部503は、機器ドライバ173を介して種々の動作機器170と接続している。動作機器170として、走行関係の機器である走行機器群171と作業関係の機器である作業機器群172とがある。走行機器群171には、車体110を操舵する操舵機器が含まれている。この操舵機器は、この実施形態のようにクローラ式の走行装置111が採用されている場合には、左右のクローラの速度を変更する機器である。操舵輪方式の走行装置111が採用されている場合には、操舵機器は、操舵輪の操舵角を変更する機器である。
 制御装置105には、自車位置算出部140、車体方位算出部141、車速算出部142、走行制御部151、作業制御部152、走行モード管理部153、作業領域決定部154、走行経路算出部155、横偏差算出部156、目標点推定部157、補正方位演算ユニット109A、制御演算ユニット109Bが備えられている。
 自車位置算出部140は、自車位置検出ユニット180から逐次送られてくる測位データに基づいて、自車位置を地図座標(または圃場座標)の形式で算出する。その際、自車位置として、車体110の基準点となる特定箇所(例えば車体中心や収穫部115の端部など)の位置を設定することができる。
 車体方位算出部141は、自車位置算出部140によって経時的に算出された複数の自車位置に基づいて、車体方位を算出する。車体方位は、車体110の向きを示している。なお、慣性計測モジュール182からの出力データに含まれている方位データに基づいて、車体方位を算出することも可能である。車速算出部142は、車速センサまたはトランスミッションの変速状態から車速を算出する。
 作業領域決定部154は、走行軌跡算出機能、及び、未刈領域決定機能を有する。走行軌跡算出機能とは、自車位置算出部140によって算出された自車位置を経時的にプロットすることによって走行軌跡データを算出する機能である。未刈領域決定機能とは、走行軌跡算出機能により算出された走行軌跡データに基づいて、未作業マップデータを作成する機能である。未作業マップデータとは、作業対象の領域となる未刈領域CA1の形状を示すデータである。
 走行経路算出部155は、登録されている経路算出アルゴリズムによって、未刈領域CA1を網羅する自動走行のための目標走行経路となる走行経路(作業用走行経路、Uターン走行経路、アルファターン経路など)を算出する。
 走行制御部151は、エンジン制御機能や走行装置制御機能(車体110の操舵制御や車速制御を含む)などを有している。走行制御部151は、走行機器群171に走行制御信号を与える。作業制御部152は、収穫作業装置(収穫部115、脱穀装置113、搬送装置116、穀粒排出装置118など)の動きを制御するために、作業機器群172に作業制御信号を与える。
 走行制御部151には、手動走行制御部511と自動走行制御部512と目標走行経路設定部513とが含まれている。自動走行モードが設定されると、コンバインの走行は、自動走行となる。また、手動走行モードが設定されると、コンバインの走行は、手動走行となる。このような走行モードの切り替えは、走行モード管理部153によって管理される。目標走行経路設定部513は、自動走行モードが設定された場合に、走行経路算出部155によって算出された作業用走行経路と旋回走行経路とを用いて、目標走行経路を設定する。
 横偏差算出部156は、目標走行経路設定部513によって設定された目標走行経路の経路方位(経路の延び方向)に直交する方向での自車位置から目標走行経路までの距離を横偏差として算出する。
 手動走行モードが選択されている場合、運転者による操作に基づいて、手動走行制御部511が、対応する走行機器群171に、制御信号を与える。このとき、制御信号は、機器ドライバ173を介して与えられる。これにより、手動走行が実現する。
 自動走行モードが設定されている場合、自動走行制御部512が、対応する走行機器群171に、自動操舵及び停止を含む車速変更の制御信号を与える。このとき、制御信号は、機器ドライバ173を介して与えられる。これにより、自動走行が実現する。自動走行制御部512は、以下に説明するように、制御演算ユニット109Bから出力される制御量に基づいて、自動操舵のための制御信号を出力する。
 次に、図19と図20とを用いて、補正方位演算ユニット109A及び制御演算ユニット109Bにおける演算時のデータの流れを説明する。なお、図20に示されている符号は次のように定義されている。RPは、車体110の基準点(車体中心や作業装置中心など)を示している。基準点:RPは、自車位置算出部140により算出された自車位置に基づいて算出される。TLは、目標走行経路設定部513によって設定された、自動走行のための目標走行経路である。RLは、車体110の基準点:RPを通って、目標走行経路:TLに平行な仮想線である。DLは、車体110の前後方向の向きである車体方位を示す車体方位線である。図20では、車体方位線:DLは、仮想線:RLに対して傾斜しており、その傾斜角度はγで示されている。コンバインの車体110は、目標走行経路:TLに対して紙面右側に離れている。車体110の車体方位線:DLは、車体走行方向に進むほど目標走行経路:TLから離れる向きとなっている。dは、横偏差算出部156によって算出される車体110の横偏差である。VPは、目標点推定部157によって算出される推定目標点である。APは補助点である。補助点:APは、自車位置における車体110の基準点:RPから目標走行経路:TLへの射影点である。AL1は第1補助線である。この第1補助線は、推定目標点:VPと車体110の基準点:RPとを通る直線である。AL2は第2補助線である。この第2補助線は、後述する第2補正方位に対応する補正角(αで示されている)だけ、第1補助線:AL1に対して角度をもって基準点:RPから径方向に延びた直線である。
 目標点推定部157は、現時点から車体110が走行した後の位置(未来自車位置)に対応する、目標走行経路:TL上の位置である推定目標点:VPを算出する。この推定目標点:VPの算出は、例えば、次の方法で算出できる。
(1)補助点:APを出発点として、目標走行経路:TLを所定時間だけ移動した後の位置を推定目標点:VPとする。その際の移動速度を現時点の車速とする場合は、車速算出部142によって算出された車速が用いられる。所定時間は、予め設定されていてもよいし、収穫物の状態や圃場状態によって自動的にあるいは人為的(運転者や管理者)に選択されてもよい。コンバインの場合、所定時間は、0.5秒から5秒ぐらいが好ましい。
(2)補助点:APを出発点として、目標走行経路:TL上で所定距離だけ離れた位置を推定目標点:VPとする。当該所定距離は、予め設定されていてもよいし、収穫物の状態や圃場状態によって自動的にあるいは人為的(運転者や管理者)に選択されてもよい。コンバインの場合、所定距離は、1mから数mぐらいが好ましい。
 補正方位演算ユニット109Aは、推定目標点:VPと自車位置との間の偏差を解消する補正方位を演算する。この補正方位は、車体110が目標走行経路:TLに乗るための目標となる操舵方位(操舵制御における操舵量)である。この実施形態では、図19に示すように、補正方位演算ユニット109Aは、補正方位を演算するために、推定方位偏差算出部190と、第1制御器191と、第2制御器192と、演算器193とを備えている。
 推定方位偏差算出部190は、第1補助線:AL1と仮想線:RLとがなす角度(図20ではβで示されている)を推定方位偏差として算出する。第1制御器191は、推定方位偏差を入力パラメータとして、車体110の仮の操舵目標となるべき第1補正方位を出力する。第1補正方位は、推定方位偏差を解消するために演算された、操舵制御における操舵方位である。推定方位偏差は、車体110が推定目標点:VPに向かうための角度:βに対応しているので、第1制御器191からの出力は、入力である推定方位偏差に比例することが好ましい。このことから、この実施形態では、第1制御器191は比例制御器として構成されている。
 第2制御器192は、横偏差:dを入力パラメータとして第2補正方位を出力する。第2制御器192は、横偏差:dに基づく補正角度(図20ではαで示されている)を演算しており、この第2補正方位は、この補正角度:αに対応する、操舵制御における操舵方位である。第2制御器192は、横偏差:dを縮小するように車体110の向きを変更するための操舵方位を算出するものであり、この実施形態では、積分制御器として構成されている。もちろん、第2制御器192は、比例制御器として構成されてもよい。
 演算器193は、第1補正方位と第2補正方位との加算演算を行い、演算結果として補正方位を出力する。この加算演算は、図20を参照して角度で表現すれば、α+βに対応する。この補正方位が、補正方位演算ユニット109Aの出力値であり、制御演算ユニット109Bに与えられる。演算器193における加算演算として、単純加算以外に重み演算などが用いられてもよい。また、第2制御器192が省略されてもよい。その場合には、演算器193は不要となる。
 制御演算ユニット109Bは、車体110が目標走行経路:TLに沿って走行するための制御量を出力するために、演算器195と操舵制御器196とを備えている。操舵制御器196は、PI制御器またはP制御器として構成されている。この実施形態では、制御演算ユニット109Bは、入力パラメータとして、補正方位演算ユニット109Aからの補正方位だけでなく、車体方位算出部141で算出された現時点の車体方位も用いる。この現時点の車体方位は、仮想線:RLと車体方位線:DLとのなす角度(図20ではγで示されている)に相当する。演算器195は、補正方位と車体方位との加算演算を行う。この加算演算は、図20を参照して角度で表現すれば、θ(=α+β+γ)に対応する。演算器195の演算出力は、操舵制御器196の制御目標値として操舵制御器196に与えられる。さらに、操舵制御器196からの出力値は、操舵のための制御量として、自動走行制御部512に与えられる。
 次に、自動走行制御部512で行われる、制御演算ユニット109Bから与えられた制御量を入力制御量として操舵出力を導出する演算を図21と図22とを用いて説明する。
 自動走行制御部512は、制御演算ユニット109Bから与えられた制御量(操舵入力と称する)を、16ビット化して、操舵出力として出力している。一般には、図21に示すグラフのように、操舵入力は各ビットに均等に割り当てられ、操舵出力が導出される。このような演算を改善して、ゼロに近い小さな入力制御量に対して精密な操舵が実現するために、ビット拡張機能が導入された演算が、図22に示されている。ここでは、操舵入力の最小領域に対応する、1ビットは、さらに4分割される。これにより、ゼロに近い小さな制御量が制御演算ユニット109Bから入力されても、それに見合った小さな制御出力が導出される。その結果、微細な制御信号を出力することができ、精密な操舵が実現する。
[第2実施形態の別実施形態]
 以下、上記した実施形態を変更した別実施形態について説明する。以下の各別実施形態で説明している事項以外は、上記した実施形態で説明している事項と同様である。上記した実施形態及び以下の各別実施形態は、矛盾が生じない範囲で、適宜組み合わせてもよい。なお、本発明の範囲は、上記した実施形態及び以下の各別実施形態に限定されるものではない。
(1)図20を用いて説明した実施形態では、推定目標点:VPを推定するために用いられる補助点(出発点):APは、車体110の基準点:RPから目標走行経路:TLに下ろした垂線と目標走行経路:TLとの交点(射影点)であった。これに代えて、基準点:RPから目標走行経路:TLに対して90°に所定角をプラスマイナスした角度で下した線と目標走行経路:TLとの交点(射影点)を補助点:APとしてもよい。その際、当該所定角は0より大きく数十度までの角度であり、固定値でもよいし、車速や圃場状態によって手動または自動で変更されてもよい。さらに、車体方位線:DLと目標走行経路:TLとの交点が補助点:APより車体110の進行方向下流側に位置する場合には、車体方位線:DLと目標走行経路:TLとの交点を補助点:APとしてもよい。
(2)上述した実施形態では、実質的な収穫作業は、コンバインの直線状の走行経路に沿った走行によって行われている。この直線状の走行経路は、1本の直線に限定されない。折れ曲がった経路でもよいし、大きな曲率半径で湾曲した経路でもよいし、蛇行形状の経路でもよい。
(3)上述した実施形態では、未刈領域CA1の形状は四角形であったが、これが三角形や五角形などの他の多角形であってもよい。
(4)図18及び図19で示された制御装置105の機能ブロック群は、わかりやすい説明を目的としており、各機能ブロックは、さらに分割されたり、統合されたり、省略されたりしてもよい。また、その機能ブロックの全てまたは一部は、汎用端末104に構築されていても良い。
(5)上記実施形態における各部材の機能をコンピュータに実現させる制御プログラムとして構成されていても良い。また、上記実施形態における各部材の機能をコンピュータに実現させる制御プログラムが記録された記録媒体として構成されていても良い。また、上記実施形態において各部材により行われることを一つまたは複数のステップにより行う制御方法として構成されていても良い。
 本発明は、普通型のコンバインだけでなく、自脱型のコンバイン、田植機、トラクタ、建設作業機等の種々の作業車に利用可能である。
 また、本発明による制御装置は、普通型のコンバインだけでなく、自脱型のコンバインにも利用可能であり、田植機やトラクタなどの圃場作業車、さらには、芝刈機やフロントローダなどの作業車にも適用できる。
 (第1実施形態)
 1   コンバイン(作業車)
 2   自動走行制御システム
 23  経路算出部
 24  走行制御部
 25  横偏差検出部(検出部)
 CA  作業対象領域(未作業領域)
 LI  刈取走行経路(目標走行経路)
 M1  第1対応関係
 M2  第2対応関係
 M3  第3対応関係
 SA  外周領域(既作業領域)
 d1  第1閾値
 d2  第2閾値
 (第2実施形態)
 105   制御装置
 109A  補正方位演算ユニット
 109B  制御演算ユニット
 110   車体
 111   走行装置
 140   自車位置算出部
 141   車体方位算出部
 142   車速算出部
 151   走行制御部
 511   手動走行制御部
 512   自動走行制御部
 513   目標走行経路設定部
 156   横偏差算出部
 157   目標点推定部
 165   人為操作具
 180   自車位置検出ユニット
 181   衛星測位モジュール
 182   慣性計測モジュール
 190   推定方位偏差算出部
 191   第1制御器
 192   第2制御器
 193   演算器
 195   演算器
 196   操舵制御器
 

Claims (23)

  1.  未作業領域を通る目標走行経路を算出する経路算出部と、
     作業車が前記目標走行経路に沿って自動走行するように、前記目標走行経路と前記作業車との間の距離である横偏差に基づいて旋回出力を算出することにより前記作業車の走行を制御する走行制御部と、
     前記作業車の状態を検出する検出部と、を備え、
     前記走行制御部は、前記作業車が既作業領域から前記未作業領域に進入する際、前記検出部により検出された状態に基づいて、前記横偏差と前記旋回出力との対応関係を決定する自動走行制御システム。
  2.  前記検出部は、前記横偏差を検出し、
     前記走行制御部は、前記作業車が前記既作業領域から前記未作業領域に進入する際、前記横偏差が第1閾値を超えている場合、前記横偏差と前記旋回出力との対応関係を第1対応関係に決定し、
     前記走行制御部は、前記作業車が前記既作業領域から前記未作業領域に進入する際、前記横偏差が前記第1閾値を超えていない場合、前記横偏差と前記旋回出力との対応関係を第2対応関係に決定し、
     前記第1対応関係における前記旋回出力は、前記第2対応関係における前記旋回出力よりも小さい請求項1に記載の自動走行制御システム。
  3.  前記走行制御部は、前記作業車が旋回しながら前記既作業領域から前記未作業領域に進入する際、前記横偏差が第2閾値を超えている場合、前記作業車に、一旦後進してから再度前進して前記未作業領域への進入を試みる走行であるリトライ走行を行わせる請求項2に記載の自動走行制御システム。
  4.  前記走行制御部は、前記リトライ走行が行われている場合、前記横偏差と前記旋回出力との対応関係を第3対応関係に決定し、
     前記第3対応関係における前記旋回出力は、前記第1対応関係における前記旋回出力よりも大きい請求項3に記載の自動走行制御システム。
  5.  前記走行制御部は、自動走行開始時において、前記横偏差が前記第2閾値を超えている場合、前記作業車に前記リトライ走行を行わせない請求項3または4に記載の自動走行制御システム。
  6.  未作業領域を通る目標走行経路を算出する経路算出機能と、
     作業車が前記目標走行経路に沿って自動走行するように、前記目標走行経路と前記作業車との間の距離である横偏差に基づいて旋回出力を算出することにより前記作業車の走行を制御する走行制御機能と、
     前記作業車の状態を検出する検出機能と、をコンピュータに実現させ、
     前記走行制御機能は、前記作業車が既作業領域から前記未作業領域に進入する際、前記検出機能により検出された状態に基づいて、前記横偏差と前記旋回出力との対応関係を決定する自動走行制御プログラム。
  7.  未作業領域を通る目標走行経路を算出する経路算出機能と、
     作業車が前記目標走行経路に沿って自動走行するように、前記目標走行経路と前記作業車との間の距離である横偏差に基づいて旋回出力を算出することにより前記作業車の走行を制御する走行制御機能と、
     前記作業車の状態を検出する検出機能と、をコンピュータに実現させる自動走行制御プログラムを記録しており、
     前記走行制御機能は、前記作業車が既作業領域から前記未作業領域に進入する際、前記検出機能により検出された状態に基づいて、前記横偏差と前記旋回出力との対応関係を決定する自動走行制御プログラムを記録した記録媒体。
  8.  未作業領域を通る目標走行経路を算出する経路算出ステップと、
     作業車が前記目標走行経路に沿って自動走行するように、前記目標走行経路と前記作業車との間の距離である横偏差に基づいて旋回出力を算出することにより前記作業車の走行を制御する走行制御ステップと、
     前記作業車の状態を検出する検出ステップと、備え、
     前記走行制御ステップにおいて、前記作業車が既作業領域から前記未作業領域に進入する際、前記検出ステップにより検出された状態に基づいて、前記横偏差と前記旋回出力との対応関係が決定される自動走行制御方法。
  9.  目標走行経路に沿って自動走行する作業車のための制御装置であって、
     前記作業車の自車位置を算出する自車位置算出部と、
     所定時間後の前記目標走行経路における推定目標点を算出する目標点推定部と、
     前記推定目標点と前記自車位置との間の偏差を解消する補正方位を演算する補正方位演算ユニットと、
     前記補正方位を入力パラメータとして、前記偏差が縮小されるように前記作業車を制御するための制御量を出力する制御演算ユニットと、
    を備えた制御装置。
  10.  前記推定目標点と前記自車位置とを通る直線と前記目標走行経路とがなす角度を推定方位偏差として算出する推定方位偏差算出部が備えられ、
     前記補正方位演算ユニットは、前記推定方位偏差を入力パラメータとして第1補正方位を出力する第1制御器を備え、前記第1補正方位に基づいて前記補正方位が演算される請求項9に記載の制御装置。
  11.  前記第1制御器は比例制御器である請求項10に記載の制御装置。
  12.  前記目標走行経路の経路方位に直交する方向での前記自車位置から前記目標走行経路までの距離を横偏差として算出する横偏差算出部が備えられ、
     前記補正方位演算ユニットは、前記横偏差を入力パラメータとして第2補正方位を出力する第2制御器を備え、前記第1補正方位と前記第2補正方位とに基づいて、前記補正方位が演算される請求項10または11に記載の制御装置。
  13.  前記第2制御器は積分制御器である請求項12に記載の制御装置。
  14.  前記作業車の車速を算出する車速算出部が備えられ、
     前記目標点推定部は、前記自車位置から前記目標走行経路への射影点を出発点として、前記目標走行経路を前記車速で前記所定時間移動した点の位置を前記推定目標点とする請求項9から13のいずれか一項に記載の制御装置。
  15.  車体の向きを示す車体方位を算出する車体方位算出部が備えられ、
     前記制御演算ユニットは、さらに前記車体方位を入力パラメータとして用いる請求項9から14のいずれか一項に記載の制御装置。
  16.  前記所定時間は、前記作業車の状態によって変更される請求項9から15のいずれか一項に記載の制御装置。
  17.  目標走行経路に沿って自動走行する作業車のための制御装置であって、
     前記作業車の自車位置を算出する自車位置算出部と、
     前記自車位置から前記目標走行経路への射影点から前記目標走行経路上で前記作業車の走行方向側に所定距離離れた位置を推定目標点として算出する目標点推定部と、
     前記推定目標点と前記自車位置との間の偏差を解消する補正方位を演算する補正方位演算ユニットと、
     前記補正方位を入力パラメータとして、前記偏差が縮小されるように前記作業車を制御するための制御量を出力する制御演算ユニットと、
    を備えた制御装置。
  18.  目標走行経路に沿って自動走行する作業車のための制御プログラムであって、
     前記作業車の自車位置を算出する自車位置算出機能と、
     所定時間後の前記目標走行経路における推定目標点を算出する目標点推定機能と、
     前記推定目標点と前記自車位置との間の偏差を解消する補正方位を演算する補正方位演算機能と、
     前記補正方位を入力パラメータとして、前記偏差が縮小されるように前記作業車を制御するための制御量を出力する制御演算機能と、
    をコンピュータに実現させる制御プログラム。
  19.  目標走行経路に沿って自動走行する作業車のための制御プログラムを記録した記録媒体であって、
     前記作業車の自車位置を算出する自車位置算出機能と、
     所定時間後の前記目標走行経路における推定目標点を算出する目標点推定機能と、
     前記推定目標点と前記自車位置との間の偏差を解消する補正方位を演算する補正方位演算機能と、
     前記補正方位を入力パラメータとして、前記偏差が縮小されるように前記作業車を制御するための制御量を出力する制御演算機能と、
    をコンピュータに実現させる制御プログラムを記録した記録媒体。
  20.  目標走行経路に沿って自動走行する作業車のための制御方法であって、
     前記作業車の自車位置を算出する自車位置算出ステップと、
     所定時間後の前記目標走行経路における推定目標点を算出する目標点推定ステップと、
     前記推定目標点と前記自車位置との間の偏差を解消する補正方位を演算する補正方位演算ステップと、
     前記補正方位を入力パラメータとして、前記偏差が縮小されるように前記作業車を制御するための制御量を出力する制御演算ステップと、
    を備える制御方法。
  21.  目標走行経路に沿って自動走行する作業車のための制御プログラムであって、
     前記作業車の自車位置を算出する自車位置算出機能と、
     前記自車位置から前記目標走行経路への射影点から前記目標走行経路上で前記作業車の走行方向側に所定距離離れた位置を推定目標点として算出する目標点推定機能と、
     前記推定目標点と前記自車位置との間の偏差を解消する補正方位を演算する補正方位演算機能と、
     前記補正方位を入力パラメータとして、前記偏差が縮小されるように前記作業車を制御するための制御量を出力する制御演算機能と、
    をコンピュータに実現させる制御プログラム。
  22.  目標走行経路に沿って自動走行する作業車のための制御プログラムを記録した記録媒体であって、
     前記作業車の自車位置を算出する自車位置算出機能と、
     前記自車位置から前記目標走行経路への射影点から前記目標走行経路上で前記作業車の走行方向側に所定距離離れた位置を推定目標点として算出する目標点推定機能と、
     前記推定目標点と前記自車位置との間の偏差を解消する補正方位を演算する補正方位演算機能と、
     前記補正方位を入力パラメータとして、前記偏差が縮小されるように前記作業車を制御するための制御量を出力する制御演算機能と、
    をコンピュータに実現させる制御プログラムを記録した記録媒体。
  23.  目標走行経路に沿って自動走行する作業車のための制御方法であって、
     前記作業車の自車位置を算出する自車位置算出ステップと、
     前記自車位置から前記目標走行経路への射影点から前記目標走行経路上で前記作業車の走行方向側に所定距離離れた位置を推定目標点として算出する目標点推定ステップと、
     前記推定目標点と前記自車位置との間の偏差を解消する補正方位を演算する補正方位演算ステップと、
     前記補正方位を入力パラメータとして、前記偏差が縮小されるように前記作業車を制御するための制御量を出力する制御演算ステップと、
    を備える制御方法。
     
PCT/JP2019/046320 2018-11-29 2019-11-27 自動走行制御システム、自動走行制御プログラム、自動走行制御プログラムを記録した記録媒体、自動走行制御方法、制御装置、制御プログラム、制御プログラムを記録した記録媒体、制御方法 WO2020111102A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
KR1020217013339A KR20210093240A (ko) 2018-11-29 2019-11-27 자동 주행 제어 시스템, 자동 주행 제어 프로그램, 자동 주행 제어 프로그램을 기록한 기록 매체, 자동 주행 제어 방법, 제어 장치, 제어 프로그램, 제어 프로그램을 기록한 기록 매체, 제어 방법
CN201980074222.9A CN113039501A (zh) 2018-11-29 2019-11-27 自动行驶控制***、自动行驶控制程序、记录有自动行驶控制程序的记录介质、自动行驶控制方法、控制装置、控制程序、记录有控制程序的记录介质、控制方法

Applications Claiming Priority (4)

Application Number Priority Date Filing Date Title
JP2018223783A JP7213670B2 (ja) 2018-11-29 2018-11-29 自動走行制御システム
JP2018-223783 2018-11-29
JP2018225679A JP7206099B2 (ja) 2018-11-30 2018-11-30 自動走行作業車のための制御装置
JP2018-225679 2018-11-30

Publications (1)

Publication Number Publication Date
WO2020111102A1 true WO2020111102A1 (ja) 2020-06-04

Family

ID=70854000

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2019/046320 WO2020111102A1 (ja) 2018-11-29 2019-11-27 自動走行制御システム、自動走行制御プログラム、自動走行制御プログラムを記録した記録媒体、自動走行制御方法、制御装置、制御プログラム、制御プログラムを記録した記録媒体、制御方法

Country Status (3)

Country Link
KR (1) KR20210093240A (ja)
CN (1) CN113039501A (ja)
WO (1) WO2020111102A1 (ja)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113419525A (zh) * 2021-06-16 2021-09-21 上海联适导航技术股份有限公司 一种无人驾驶农机的控制方法、装置、设备及存储介质
CN113835425A (zh) * 2020-06-23 2021-12-24 中强光电股份有限公司 路径规划方法
EP3991534A1 (en) * 2020-10-23 2022-05-04 Deere & Company Methods, apparatus, and articles of manufacture to display acquisition paths

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113359766B (zh) * 2021-07-05 2023-06-23 杭州萤石软件有限公司 一种移动机器人的移动控制方法、以及移动机器人

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH02100705A (ja) * 1988-10-07 1990-04-12 Nissan Motor Co Ltd 車両操舵角算出装置
JPH07119178A (ja) * 1993-10-25 1995-05-09 Mitsubishi Heavy Ind Ltd 履帯式車両の走行制御装置
JP2004008053A (ja) * 2002-06-05 2004-01-15 Yanmar Agricult Equip Co Ltd 農業用作業車

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2706676B2 (ja) 1988-10-15 1998-01-28 株式会社フジクラ 傾斜監視システム
JP4295911B2 (ja) 2000-12-19 2009-07-15 ヤンマー農機株式会社 農業用作業車
JP4263534B2 (ja) * 2003-05-16 2009-05-13 トヨタ自動車株式会社 車両用走行支援装置
JP5478334B2 (ja) * 2010-04-02 2014-04-23 株式会社豊田中央研究所 ドライバ状態判定装置及びプログラム
CN104898687B (zh) * 2014-08-21 2018-01-16 宁波市鄞州麦谷农业科技有限公司 履带式联合收割机的自动驾驶***及其控制方法
JP6420173B2 (ja) 2015-02-25 2018-11-07 株式会社クボタ 自動走行圃場作業車両
JP6770839B2 (ja) * 2016-07-08 2020-10-21 株式会社クボタ 経路探索プログラムと、経路探索システムと、この経路探索システムを組み込んだ作業車
JP6837767B2 (ja) * 2016-07-19 2021-03-03 株式会社クボタ 作業車及び作業車のための傾斜走行管理システム
CN106681335A (zh) * 2017-01-22 2017-05-17 无锡卡尔曼导航技术有限公司 用于农机无人驾驶的避障路径规划及其控制方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH02100705A (ja) * 1988-10-07 1990-04-12 Nissan Motor Co Ltd 車両操舵角算出装置
JPH07119178A (ja) * 1993-10-25 1995-05-09 Mitsubishi Heavy Ind Ltd 履帯式車両の走行制御装置
JP2004008053A (ja) * 2002-06-05 2004-01-15 Yanmar Agricult Equip Co Ltd 農業用作業車

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113835425A (zh) * 2020-06-23 2021-12-24 中强光电股份有限公司 路径规划方法
EP3991534A1 (en) * 2020-10-23 2022-05-04 Deere & Company Methods, apparatus, and articles of manufacture to display acquisition paths
CN113419525A (zh) * 2021-06-16 2021-09-21 上海联适导航技术股份有限公司 一种无人驾驶农机的控制方法、装置、设备及存储介质

Also Published As

Publication number Publication date
CN113039501A (zh) 2021-06-25
KR20210093240A (ko) 2021-07-27

Similar Documents

Publication Publication Date Title
CN111343854B (zh) 作业车、用于作业车的行驶路径选择***以及行驶路径计算***
EP3729935B1 (en) Automatic steering system and automatic steering method
WO2020044726A1 (ja) 自動操舵システムおよび収穫機、自動操舵方法、自動操舵プログラム、記録媒体
WO2020111102A1 (ja) 自動走行制御システム、自動走行制御プログラム、自動走行制御プログラムを記録した記録媒体、自動走行制御方法、制御装置、制御プログラム、制御プログラムを記録した記録媒体、制御方法
WO2020031473A1 (ja) 外形形状算出システム、外形形状算出方法、外形形状算出プログラム、及び外形形状算出プログラムが記録されている記録媒体と、圃場マップ作成システム、圃場マップ作成プログラム、圃場マップ作成プログラムが記録されている記録媒体、及び圃場マップ作成方法
WO2020100810A1 (ja) 収穫機および経路設定システム
WO2020031494A1 (ja) 収穫機、収穫システム、収穫方法、収穫プログラムおよび記録媒体
JP7174484B2 (ja) 農作業車
JP7345534B2 (ja) 自動走行システム
JP6983734B2 (ja) 収穫機
JP2022016479A5 (ja)
JP6745784B2 (ja) 作業車
JP6884092B2 (ja) 作業車及び作業車のための走行経路選択システム
JP7117985B2 (ja) 自動走行制御システム
JP6994831B2 (ja) 自動操舵システム
JP7423666B2 (ja) 収穫機
JP7206099B2 (ja) 自動走行作業車のための制御装置
JP6991058B2 (ja) 自動操舵システム
JP7213670B2 (ja) 自動走行制御システム
CN113015427B (zh) 自动转向***、自动转向方法以及自动转向程序
JP2020028224A (ja) 圃場マップ作成システム
JP6976156B2 (ja) 作業車の自動操舵システム
JP7030662B2 (ja) 収穫機
JP2021006009A (ja) 作業車協調システム
JP7334281B2 (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: 19888455

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 19888455

Country of ref document: EP

Kind code of ref document: A1