JP6974155B2 - Slip judgment system - Google Patents

Description

The present invention relates to a slip determination system that calculates a slip amount of a traveling vehicle and uses it for controlling the traveling vehicle. This system is particularly suitable for aerial work platforms that automatically travel in a field along a travel path for agricultural work.

The combine disclosed in Patent Document 1 calculates a traveling route for automatic traveling based on an outer shape map obtained by manually traveling around the outer periphery of the field, and is detected by the own vehicle position detection module. Automatic work driving is performed so that the position of the own vehicle follows the traveling route.

The field work machine disclosed in Patent Document 2 calculates the slip ratio of wheels based on the mileage calculated from the rotational speed of the wheels and the mileage calculated from the position information by GPS, and the slip ratio is calculated. The operation timing of work equipment such as seedling planting equipment and fertilizer application equipment is adjusted based on the above.

Further, the tractor disclosed in Patent Document 3 sets the draft control amount at the slip ratio calculated by using GPS in the draft control in which the ground work device such as a plow is moved up and down based on the detection result of the traction load sensor. to correct.

Japanese Unexamined Patent Publication No. 2017-055673 Japanese Unexamined Patent Publication No. 2015-11207 Japanese Unexamined Patent Publication No. 2012-191857

In order to drive accurately and automatically along the set driving route without being affected by the conditions of the field that change significantly due to bad weather, etc., it is necessary not only to measure the position of the vehicle accurately but also to control the automatic driving control. High responsiveness of the traveling device (including the steering mechanism) is required. However, even if these requirements are met, it is the slip of wheels and crawlers that is a problem for autonomous driving in the field. For this reason, it is important to take measures when a traveling vehicle that is automatically traveling enters an area where slip is likely to occur.

In view of the above circumstances, there is a demand for a slip determination system capable of giving appropriate control information to a traveling vehicle when the traveling vehicle enters a region where slip is likely to occur during automatic traveling.

The slip determination system according to the present invention includes a traveling vehicle body, an own vehicle position detection module that detects the position of the own vehicle, and a driving mode management unit that sets a mode of an automatic driving mode for automatic driving and a manual driving mode for manual driving. , Calculated based on the number of revolutions of the drive axle of the vehicle body and the autonomous driving control unit that executes automatic driving based on the position of the own vehicle and the set driving route when the automatic driving mode is set. A slip amount calculation unit that calculates the slip amount of the traveling vehicle from the estimated travel distance of the traveling vehicle and the actual travel distance of the traveling vehicle calculated based on the position of the own vehicle, and traveling based on the slip amount. The driving mode management unit is instructed to stop the automatic driving by the automatic driving control unit based on the determination result of the suitability determination unit for determining whether the ground condition is suitable for automatic driving and the determination result of the suitability determination unit. The driving mode management unit sets the driving mode to the manual driving mode in response to a command from the automatic driving stop unit , and the suitability determination unit is temporal. The suitability is determined from the successive behavior of the slip amount determined based on the statistical calculation results of the plurality of slip amounts calculated in 1 .
Further, the slip determination system according to the present invention is an automatic driving control unit that executes automatic driving based on a traveling vehicle body, an own vehicle position detection module that detects the own vehicle position, and the own vehicle position and a set travel path. And the slip amount of the traveling vehicle body from the estimated traveling distance of the traveling vehicle body calculated based on the number of rotations of the drive axle of the traveling vehicle body and the actual moving distance of the traveling vehicle body calculated based on the own vehicle position. A slip amount calculation unit that calculates It is equipped with an automatic driving stop unit that stops automatic driving by the unit and a notification unit that notifies whether to continue automatic driving in response to the automatic traveling stop unit stopping automatic driving. traveling in the automatic traveling is resumed when receiving a command to continue, will switch to manual driving mode when receiving the instruction of switching to manual driving,
The suitability determination unit determines the suitability based on the behavior of the slip amount over time, which is determined based on the statistical calculation results of the plurality of slip amounts calculated over time .

This slip determination system determines the slip state of the automatically traveling vehicle, and controls the vehicle based on the determination result. The slip amount (including the slip ratio) is calculated from the actual travel distance obtained based on the position of the own vehicle detected by satellite navigation or the like and the estimated travel distance obtained based on the rotation speed of the axle. From the obtained slip amount, it is possible to determine how slippery the traveling running surface (working ground) is. If it is in a slippery state, misalignment (including directional misalignment) of the traveling vehicle body will occur due to slipping, and if the misalignment is large and frequent, the misalignment should be appropriately eliminated by automatic driving control. Becomes difficult. In this configuration, if the driving surface is not suitable for automatic driving, the automatic driving is stopped, so that it is possible to prevent the vehicle from deviating from the target traveling path during automatic driving.

The actual distance traveled based on the vehicle position using satellite navigation or inertial navigation may suddenly cause an error due to poor signal conditions. For this reason, even if a configuration is adopted in which the suitability is determined from a plurality of slip amounts calculated over time, that is, from the behavior of the slip amount over time when the suitability is determined from the slip amount. good. For example, the final slip amount is determined based on statistical calculation results (average calculation in a predetermined period, intermediate value calculation, etc.) from a plurality of slip amounts calculated over time, and the suitability is judged. be able to.

In a work vehicle, especially a field work vehicle that works in a field, slip occurs more during turning than when traveling straight, and occurs in a large amount. Therefore, slip during turning is a large position from the target travel route. Leads to misalignment (including misdirection). Therefore, in a situation where slip is likely to occur, it is necessary to adjust the turning performance such as the turning radius and the turning vehicle speed. The slip determination system according to the present invention includes a traveling vehicle body, an own vehicle position detection module that detects the own vehicle position, an automatic traveling control unit that executes automatic traveling based on the own vehicle position and a set traveling route. The slip amount of the traveling vehicle is calculated from the estimated travel distance of the traveling vehicle calculated based on the number of rotations of the drive axle of the traveling vehicle and the actual traveling distance of the traveling vehicle calculated based on the position of the own vehicle. Based on the slip amount, the slip amount calculation unit determines whether or not the state of the traveling ground is suitable for automatic driving, and if the slip amount exceeds the slip allowable amount, it is not suitable for automatic driving. A suitability determination unit for determination, an automatic travel stop unit for stopping automatic travel by the automatic travel control unit based on the determination result of the suitability determination unit, and an automatic travel stop unit.
A turning performance adjusting unit for adjusting the turning performance of the traveling vehicle body is provided, and when the slip amount exceeds a predetermined value, the turning performance adjusting unit adjusts the turning performance without stopping automatic driving. .. By adjusting the turning performance, the slip amount is suppressed, or even if slip is unavoidable, the positional deviation from the target traveling path is suppressed.

In one of the specific embodiments of the slip determination system provided with the turning performance adjusting unit, the speed of the traveling vehicle body is accelerated at the transition from the straight running to the turning running as the adjustment of the turning performance. By accelerating during a turn, grip on the ground may be restored and slipping may be suppressed. Further, by accelerating during turning, the turning running time is shortened, and there is a possibility that deviation from the target traveling path due to slipping can be suppressed. There are two types of turning of the work platform: slow turning, new ground turning, and aerial ground turning, and all of them are effective.

Field work platforms such as combines are equipped with a tilting mechanism that tilts the traveling vehicle body.
By inclining the traveling vehicle body, it is possible to reduce the turning radius and suppress slipping. Therefore, in one of the embodiments of the present invention, a tilting mechanism for tilting the traveling vehicle body is provided, and as an adjustment of the turning performance, the traveling vehicle body is tilted so that the outside of the turning surface becomes higher during turning. If the tilting posture during turning is such that the outside of the turn is high and the center side of the turn is low, the turning performance is improved.

Further, when the driving force is transmitted to the left and right traveling devices (crawlers, wheels) by a hydraulic transmission using a hydraulic pack, the engine load increases during turning and the engine rotation may decrease. .. In that case, the hydraulic pressure of the hydraulic pack becomes insufficient, and the turning performance deteriorates. In order to solve this problem, it is also preferable to increase the engine speed during turning.

It is a side view of the combine as an example of the harvester which adopted the slip determination system. It is a figure which shows the outline of the automatic traveling of a combine. It is a figure which shows the traveling route in automatic driving. It is a functional block diagram which shows the structure of the control system of a combine. It is a flowchart which shows the traveling control of a combine based on a slip determination.

Next, as an example of a field work machine adopting the slip determination system of the present invention, a normal type combine will be described. In the present specification, unless otherwise specified, "front" (direction of arrow F shown in FIG. 2) means front in the front-rear direction (traveling direction) of the aircraft, and "rear" (arrow B shown in FIG. 2). Direction) means the rear in the front-rear direction (traveling direction) of the aircraft. Further, the left-right direction or the lateral direction means the aircraft crossing direction (airframe width direction) orthogonal to the aircraft front-rear direction. "Up" (direction of arrow U shown in FIG. 1) and "down" (direction of arrow D shown in FIG. 1) are positional relationships in the vertical direction (vertical direction) of the vehicle body, and are relationships in height above the ground. show.

As shown in FIG. 1, this combine is called a normal type combine, and has a traveling vehicle body 10, a crawler type traveling device 11, a driving unit 12, a threshing device 13, a grain tank 14, a harvesting unit H, and a transport device 16. It is equipped with a grain ejection device 18 and a vehicle position detection module 80.

The traveling device 11 is provided in the lower part of the traveling vehicle body 10 (hereinafter, simply referred to as the vehicle body 10). The combine is configured to be self-propelled by the traveling device 11. The driving unit 12, the threshing device 13, and the grain tank 14 are provided on the upper side of the traveling device 11 and form the upper part of the vehicle body 10. The driver unit 12 can be boarded by a driver who drives the combine harvester and a monitor who monitors the work of the combine harvester. Usually, the driver and the observer are also used. When the driver and the observer are different persons, the observer may monitor the work of the combine from outside the combine.

The grain discharge device 18 is connected to the rear lower portion of the grain tank 14. Further, the satellite positioning module 80 is attached to the front upper part of the driving unit 12.

The harvesting section H is provided at the front portion of the combine. The transport device 16 is provided on the rear side of the harvesting section H. Further, the harvesting unit H has a cutting mechanism 15 and a reel 17. The cutting mechanism 15 cuts the planted culm in the field. Further, the reel 17 is driven to rotate and scrapes the planted culm to be harvested. With this configuration, the harvesting unit H harvests the grain (a kind of agricultural product) in the field. Then, the combine can be run by the traveling device 11 while harvesting the grains in the field by the harvesting unit H.

The cut grain culm cut by the cutting mechanism 15 is conveyed to the threshing device 13 by the conveying device 16. In the threshing device 13, the harvested grain culm is threshed. The grains obtained by the threshing treatment are stored in the grain tank 14. The grains stored in the grain tank 14 are discharged to the outside of the machine by the grain discharging device 18 as needed. In this combine, a hydraulic tilting mechanism 110 is provided between the vehicle body 10 and the traveling device 11, and the vehicle body 10 is tilted in the left-right direction and the front-rear direction with respect to the traveling surface (field scene). Can be done.

A communication terminal 2 is arranged in the driving unit 12. In the present embodiment, the communication terminal 2 is fixed to the driving unit 12. However, the present invention is not limited to this, and the communication terminal 2 may be configured to be detachable from the driving unit 12 or may be located outside the combine harvester.

As shown in FIG. 2, this combine automatically travels along a travel route set in the field. For this purpose, the position of the own vehicle is required. The own vehicle position detection module 80 includes a satellite navigation module 81 and an inertial navigation module 82. The satellite navigation module 81 receives a GNSS (global navigation satellite system) signal (including a GPS signal) from the artificial satellite GS and outputs positioning data for calculating the position of the own vehicle. The inertial navigation module 82 incorporates a gyro acceleration sensor and a magnetic orientation sensor, and outputs a position vector indicating an instantaneous traveling direction. The inertial navigation module 82 is used to complement the vehicle position calculation by the satellite navigation module 81. The inertial navigation module 82 may be arranged at a different location from the satellite navigation module 81.

The procedure for harvesting in the field with this combine is as described below.

First, the driver / observer manually operates the combine harvester and, as shown in FIG. 2, performs a harvesting run so as to orbit along the boundary line of the field in the outer peripheral portion of the field. As a result, the area that has become the already cut land (already worked area) is set as the outer peripheral area SA. Then, the area left as the uncut land (unworked land) inside the outer peripheral area SA is set as the work target area CA.

Further, at this time, in order to secure a certain width of the outer peripheral region SA, the driver causes the combine to travel 3 to 4 laps. In this traveling, the width of the outer peripheral region SA is expanded by the working width of the combine every time the combine makes one round. After the first 3 to 4 laps, the width of the outer peripheral region SA becomes about 3 to 4 times the working width of the combine.

The outer peripheral region SA is used as a space for the combine to change direction when performing a harvesting run in the work target region CA. Further, the outer peripheral region SA is also used as a space for movement such as when moving to a grain discharge place or when moving to a refueling place after the harvesting run is finished.

The carrier CV shown in FIG. 2 can collect and transport the grains discharged from the combine. At the time of grain discharge, the combine moves to the vicinity of the carrier CV and then discharges the grains to the carrier CV by the grain discharge device 18.

When the outer peripheral area SA and the work target area CA are set, the traveling route in the work target area CA is calculated as shown in FIG. The calculated travel route is sequentially set based on the work travel pattern, and the combine is automatically controlled to travel along the set travel route.

FIG. 4 shows a combine control system using the slip determination system according to the present invention. The control system of the combine is from a control unit 5 consisting of a large number of electronic control units called ECUs and various input / output devices that perform signal communication (data communication) with the control unit 5 through a wiring network such as an in-vehicle LAN. It is configured.

The notification device 62 is a device for notifying a driver or the like of a work traveling state or various warnings, and is a buzzer, a lamp, a speaker, a display, or the like. The communication unit 66 is used for the control system of this combine to exchange data with the communication terminal 2 or with a management computer installed at a remote location. The communication terminal 2 includes a tablet computer operated by a monitor standing in a field, a driver / monitor who is on board a combine harvester, a computer installed at home or a management office, and the like. The control unit 5 is a core element of this control system and is shown as an aggregate of a plurality of ECUs. The signal from the vehicle position detection module 80 is input to the control unit 5 through the vehicle-mounted LAN.

The control unit 5 includes an output processing unit 58 and an input processing unit 57 as input / output interfaces. The output processing unit 58 is connected to various operating devices 70 via the device driver 65. The operating equipment 70 includes a traveling equipment group 71, which is a traveling-related device, and a working equipment group 72, which is a work-related device. The traveling device group 71 includes, for example, an engine control device, a shift control device, a braking control device, a steering control device, and the like. The working equipment group 72 includes a harvesting unit H, a threshing device 13, a transport device 16, a grain discharging device 18, a power control device in the tilting mechanism 110, and the like.

A traveling state sensor group 63, a working state sensor group 64, a traveling operation unit 90, and the like are connected to the input processing unit 57. The traveling state sensor group 63 includes an axle rotation speed sensor 631 that detects the rotation speed of the axle directly related to the ground speed of the traveling device 11. Based on the detection signal from the axle rotation speed sensor 631, the estimated vehicle speed, which is the estimated travel distance per unit time, can be calculated. The estimated travel distance (estimated vehicle speed) is the actual travel distance (actual vehicle speed) when there is no slip. The traveling state sensor group 63 includes, as other sensors, an engine rotation speed sensor, an overheat detection sensor, a brake pedal position detection sensor, a shift position detection sensor, a steering position detection sensor, and the like. The work state sensor group 64 includes a sensor for detecting the driving state of the harvesting work device (harvesting unit H, threshing device 13, transport device 16, grain discharging device 18), and a sensor for detecting the state of the grain and the grain. For example, a cutting and threshing sensor, a grain volume sensor, and the like are included.

The traveling operation unit 90 is a general term for operating tools that are manually operated by the driver and whose operation signals are input to the control unit 5. The traveling operation unit 90 includes a main speed change operation tool 91, a steering operation tool 92, a mode operation tool 93, an automatic start operation tool 94, and the like. The mode operation tool 93 has a function of giving a command to the control unit 5 for switching between automatic operation and manual operation. The automatic start operation tool 94 has a function of giving a final automatic start command to the control unit 5 for starting automatic traveling. In this embodiment, the automatic start operating tool 94 is a two-button type, and an automatic start command is sent unless the first button (first operating device) and the second button (second operating device) are operated at the same time. Not done. Regardless of the operation by the mode operation tool 93, the control unit 5 can shift from the automatic driving mode in which the automatic driving is performed to the manual driving mode in which the manual driving is performed by the software. For example, when a situation occurs in which automatic driving is impossible, the control unit 5 forcibly executes a transition from the automatic driving mode to the manual driving mode. At the time of such a mode transition, the combine temporarily stops.

The control unit 5 includes a vehicle position calculation unit 50, a travel control unit 51, a work control unit 52, a travel mode management unit 53, a route calculation unit 54, a turning performance adjustment unit 55, and a slip determination module 4. The own vehicle position calculation unit 50 determines the own vehicle position, which is the map coordinates (or field coordinates) of a specific location of the vehicle body 10 preset, based on the positioning data sequentially sent from the own vehicle position detection module 80. calculate. The notification unit 56 generates notification data based on a command or the like from each functional unit of the control unit 5, and supplies the notification data to the notification device 62.

The travel control unit 51 has an engine control function, a steering control function, a vehicle speed control function, and the like, and gives a control signal to the travel equipment group 71. The work control unit 52 gives a control signal to the work equipment group 72 in order to control the movement of the harvesting work equipment (harvesting unit H, threshing device 13, transport device 16, grain discharging device 18, etc.).

This combine can be driven by both automatic driving in which harvesting work is performed by automatic driving and manual driving in which harvesting work is performed by manual driving. Therefore, the travel control unit 51 includes a manual travel control unit 511, an automatic travel control unit 512, and a travel route setting unit 513. When performing automatic driving, an automatic driving mode is set, and for manual driving, a manual driving mode is set. Such a traveling mode is managed by the traveling mode management unit 53.

When the automatic driving mode is set, the automatic driving control unit 512 generates a control signal for changing the vehicle speed including automatic steering and stopping to control the traveling equipment group 71. The control signal related to automatic steering eliminates the positional deviation (including the directional deviation) between the target traveling route set by the traveling route setting unit 513 and the own vehicle position calculated by the own vehicle position calculation unit 50. Is generated to do. The control signal for changing the vehicle speed is generated based on the vehicle speed value set in advance. The travel route set by the travel route setting unit 513 is calculated by the route calculation algorithm registered in the route calculation unit 54.

When the manual driving mode is selected, the manual driving control unit 511 generates a control signal based on the operation by the driver and controls the traveling equipment group 71 to realize the manual driving. The travel route calculated by the route calculation unit 54 can be used for the purpose of guidance for the combine to travel along the travel route even in manual operation.

The transition between the automatic driving mode in which the automatic driving is performed and the manual driving mode in which the manual driving is performed is performed not directly but with the intervention of the transition mode. An automatic standby mode is prepared as a transition mode when shifting from the manual driving mode to the automatic driving mode. In addition, as a transition mode when shifting from the automatic driving mode to the manual driving mode, there is a pause mode in which the vehicle body 10 is temporarily stopped during automatic driving, and a final stage of the transition from this pause mode to the manual driving mode. A check mode is available. Transition conditions are set for the transition between the automatic driving mode, the manual driving mode, and the transition mode connecting them. The travel mode management unit 53 determines that such a transition condition is satisfied, and manages the transition to each mode.

The turning performance adjusting unit 55 adjusts the turning performance of the vehicle body 10 according to the information from the traveling state sensor group 63, the working state sensor group 64, and the slip determination module 4. The adjustment items of the turning performance are changing the speed difference between the left and right traveling devices 11, accelerating the turning vehicle speed (increasing the speed at the transition from straight running to turning running), and driving the tilting mechanism 110 at the time of turning. The vehicle body 10 is tilted so that the outside of the turn is high.

In this embodiment, shifting is performed by interposing a pair of left and right hydrostatic transmissions in the power transmission path from the engine to the traveling device 11. The vehicle body 10 turns due to the difference in shifting between the left and right hydrostatic transmissions. The supply of hydraulic pressure to the hydrostatic transmission is performed by a hydraulic circuit including a hydraulic pump called a hydraulic pack. In order for the hydrostatic transmission to operate normally, it is necessary that the hydraulic pressure of the hydraulic pack driven by the engine is sufficiently secured. However, when the running load increases in turning, the engine speed temporarily decreases and the hydrostatic transmission device slips, and the hydraulic pump does not rotate sufficiently, resulting in insufficient hydraulic pressure in the hydraulic pack. The turning performance deteriorates. Therefore, the turning performance adjusting unit 55 also has a function of increasing the engine speed during such turning.

The slip determination module 4 includes a slip amount calculation unit 41, a suitability determination unit 42, and an automatic traveling stop unit 43. The slip amount calculation unit 41 has an estimated travel distance per unit time of the vehicle body 10 calculated based on the rotation speed of the drive axle obtained from the axle rotation speed sensor 631, and the own vehicle position obtained from the own vehicle position calculation unit 50. The slip amount (or slip ratio) of the vehicle body 10 (traveling device 11) is calculated from the actual travel distance of the vehicle body 10 per unit time calculated based on the above. It is also possible to obtain the slip amount from the estimated time and the actual time required to move only the unit mileage.

The suitability determination unit 42 determines whether or not the condition of the traveling ground is suitable for automatic driving (automatic driving) in the automatic traveling mode based on the slip amount. When the suitability determination unit 42 detects a slip amount exceeding the slip allowance amount, the suitability determination unit 42 determines that the vehicle is not suitable for automatic driving. The slip amount (slip allowance) allowed in automatic driving is set in advance. The slip allowance may be adjusted according to the specifications of the combine or may be adjusted for each field. Furthermore, the slip allowance can be adjusted at the discretion of the observer. In this embodiment, the suitability determination unit 42 takes into consideration sudden signal errors, calculation errors, and the like, and averages the time-lapse behavior, for example, excluding the maximum and minimum of a plurality of slip amounts calculated over time. Is the slip amount for determining suitability.

When the suitability determination unit 42 determines that a slip amount unsuitable for automatic driving has occurred during automatic driving, the automatic driving stop unit 43 causes the traveling mode management unit 53 to shift from the automatic driving mode to the manual driving mode. Then, it is instructed to stop the automatic driving. When the traveling mode management unit 53 receives an automatic traveling stop command from the automatic traveling stop unit 43, the traveling mode management unit 53 sets the traveling mode to the manual traveling mode and stops the vehicle body 10.

Next, the flow of control regarding the slip determination process will be described with reference to the flowchart of FIG.
As soon as the combine travels, the process of detecting slip starts (# 01). First, the own vehicle position is calculated by the own vehicle position calculation unit 50 (# 11). The actual travel distance, which is the actual travel distance per unit time, is calculated from the difference between the positions of the two own vehicles calculated at predetermined time intervals (# 12). Further, the axle rotation speed sensor 631 detects the rotation speed of the drive axle per unit time (# 13). Based on the detected number of revolutions, the estimated travel distance per unit time is calculated (# 14). The slip amount calculation unit 41 calculates the slip amount from the difference between the actual movement distance and the estimated movement distance (# 15). The calculated slip amount is notified through the notification unit 56 and the notification device 62 in the form of a meter display or a numerical display (# 16).

From the tendency of the slip amount calculated continuously, it is checked whether or not the road surface condition is prone to slip (# 20). A preset attention threshold is used for this check. When it is determined that it is necessary to pay attention to slip (# 20 required branch), a slip warning is issued to notify that fact (# 21). If it is determined that it is not necessary to pay attention to slip (# 20 unnecessary branch), it will be canceled if the slip warning has been issued at that time (# 22), and if the slip warning has not been issued, what is it as it is? Is not performed, and the process returns to step # 11.

When it is determined that it is necessary to pay attention to slip (# 20 required branch), whether the current driving mode is the automatic driving mode (automatic driving) or the manual driving mode (manual driving). Is checked (# 30). If the vehicle is being driven manually (# 30 manual branch), the process returns to step # 11. If the vehicle is in automatic driving (# 30 automatic branching), the suitability determination unit 42 determines whether or not the automatic driving may be continued in the current slip condition based on the calculated slip amount (# 30 automatic branching). # 31). Also in this suitability determination, a predetermined value of slip amount, which is a determination criterion in advance, is used, or the succession behavior of the slip amount is used as a determination criterion. If it is determined that the automatic driving may still be continued even in the current slip condition (# 31 suitable branch), the process returns to step # 11. When it is determined that the continuation of automatic driving should be avoided in the current slip situation (# 31 no branch), the automatic driving by the automatic driving control unit 512 is stopped (# 32). Along with this, the combine will temporarily stop (# 33).

Next, the notification unit 56 asks the observer / driver whether to continue the automatic driving (# 40). When the observer / driver wishes to continue the automatic driving and orders the continuation of the automatic driving (# 40 continuation branch), the suitability judgment condition by the suitability judgment unit 42 is slightly relaxed (# 41), and the step # 01 is performed. It returns and the automatic driving is resumed. If the observer / driver gives up on continuing automatic driving and orders to switch to manual driving (# 40 stop branch), the mode is switched to manual driving mode, the vehicle returns to step # 01, and driving in manual driving is performed. It will be started.

[Another embodiment]
(1) In the above-described embodiment, the own vehicle position detection module 80 is a combination of the satellite navigation module 81 and the inertial navigation module 82, but only the satellite navigation module 81 may be used. Further, for the calculation of the actual moving distance, a method of calculating the moving distance per unit time based on the image taken by the camera may be adopted.

(2) Each functional unit shown in FIG. 4 is divided mainly for the purpose of explanation. In practice, each functional unit may be integrated with other functional units or may be divided into a plurality of functional units. Further, among the functional units built in the control unit 5, all or part of the travel mode management unit 53, the route calculation unit 54, the turning performance adjustment unit 55, and the slip determination module 4 can be brought into the combine. A configuration may be adopted in which data is exchanged with the control unit 5 via a wireless or in-vehicle LAN, which is built on a portable communication terminal 2 (tablet computer or the like).

(3) In the above-described embodiment, the observer manually operates the combine harvester, and as shown in FIG. 2, performs a harvesting run so as to orbit along the boundary line of the field in the outer peripheral portion of the field. After that, the traveling route is calculated and switched to automatic driving. However, the present invention is not limited to this, and an operation method in which the combine is automatically operated from the beginning and can be switched to manual operation when a special situation occurs may be used.

(4) In the above-described embodiment, if the suitability determination unit 42 determines that the automatic driving cannot be continued, the automatic driving in the automatic driving mode is stopped, and the vehicle body 10 is temporarily stopped. Instead of this, if the suitability determination unit 42 determines that the automatic driving cannot be continued, the automatic driving mode is forcibly switched to the manual driving mode, only a notification to that effect is given, and the vehicle body 10 continues to drive. You may do it.

It should be noted that the configuration disclosed in the above embodiment (including another embodiment, the same shall apply hereinafter) can be applied in combination with the configuration disclosed in other embodiments as long as there is no contradiction. , The embodiments disclosed in the present specification are examples, and the embodiments of the present invention are not limited thereto, and can be appropriately modified without departing from the object of the present invention.

The present invention is applicable not only to a normal type combine but also to a self-removing type combine.
It can also be applied to various harvesters such as corn harvesters, potato harvesters, carrot harvesters and sugar cane harvesters, and field work vehicles such as rice transplanters and tractors. Furthermore, it can be applied to lawn mowers and construction machines.

10: Body (running body)
11: Traveling device 110: Tilt mechanism 4: Slip determination module 41: Slip amount calculation unit 42: Appropriateness determination unit 43: Automatic travel stop unit 5: Control unit 50: Own vehicle position calculation unit 51: Travel control unit 511: Manual travel Control unit 512: Automatic driving control unit 513: Driving route setting unit 52: Work control unit 53: Driving mode management unit 54: Route calculation unit 55: Turning performance adjustment unit 56: Notification unit 57: Input processing unit 58: Output processing unit 631: Axle rotation sensor 80: Own vehicle position detection module 81: Satellite navigation module 82: Inertial navigation module

Claims (5)

With the running body
The vehicle position detection module that detects the vehicle position and the vehicle position detection module
The driving mode management unit that sets the automatic driving mode for automatic driving and the manual driving mode for manual driving, and the driving mode management unit.
When the automatic driving mode is set, the automatic driving control unit that executes automatic driving based on the own vehicle position and the set driving route, and
The slip amount of the traveling vehicle body is calculated from the estimated traveling distance of the traveling vehicle body calculated based on the rotation speed of the drive axle of the traveling vehicle body and the actual moving distance of the traveling vehicle body calculated based on the own vehicle position. Slip amount calculation unit and
A suitability determination unit that determines whether or not the condition of the traveling ground is suitable for automatic driving based on the slip amount, and a suitability determination unit.
It is provided with an automatic running stop unit for instructing the running mode management unit to stop automatic running by the automatic running control unit based on the determination result of the suitability determination unit.
The driving mode management unit sets the driving mode to the manual driving mode in response to receiving a command from the automatic driving stop unit .
The suitability determination unit is a slip determination system that determines suitability based on the behavior of the slip amount over time, which is determined based on the calculation results of a plurality of slip amounts calculated over time. With the running body
The vehicle position detection module that detects the vehicle position and the vehicle position detection module
An automatic driving control unit that executes automatic driving based on the vehicle position and the set driving route,
The slip amount of the traveling vehicle body is calculated from the estimated traveling distance of the traveling vehicle body calculated based on the rotation speed of the drive axle of the traveling vehicle body and the actual moving distance of the traveling vehicle body calculated based on the own vehicle position. Slip amount calculation unit and
A suitability determination unit that determines whether or not the condition of the traveling ground is suitable for automatic driving based on the slip amount, and a suitability determination unit.
An automatic driving stop unit that stops automatic driving by the automatic driving control unit based on the determination result of the suitability determination unit, and an automatic driving stop unit.
It is provided with a notification unit for notifying whether or not to continue the automatic driving in response to the automatic traveling stop unit stopping the automatic driving.
Traveling in the automatic traveling is resumed when receiving the instruction of the continuation of the automatic running, will switch to manual driving mode when receiving the instruction of switching to manual driving,
The suitability determination unit is a slip determination system that determines suitability based on the behavior of the slip amount over time, which is determined based on the calculation results of a plurality of slip amounts calculated over time. With the running body
The vehicle position detection module that detects the vehicle position and the vehicle position detection module
An automatic driving control unit that executes automatic driving based on the vehicle position and the set driving route,
The slip amount of the traveling vehicle body is calculated from the estimated traveling distance of the traveling vehicle body calculated based on the rotation speed of the drive axle of the traveling vehicle body and the actual moving distance of the traveling vehicle body calculated based on the own vehicle position. Slip amount calculation unit and
A suitability determination unit that determines whether or not the condition of the traveling ground is suitable for automatic driving based on the slip amount, and determines that the condition is not suitable for automatic traveling when the slip amount exceeds the slip allowance.
An automatic driving stop unit that stops automatic driving by the automatic driving control unit based on the determination result of the suitability determination unit, and an automatic driving stop unit.
A turning performance adjusting unit for adjusting the turning performance of the traveling vehicle body is provided.
A slip determination system in which the turning performance adjusting unit adjusts the turning performance without stopping automatic traveling when the slip amount exceeds a predetermined value. The slip determination system according to claim 3 , wherein as an adjustment of the turning performance, the speed of the traveling vehicle body is accelerated at the time of transition from straight running to turning running. The slip determination system according to claim 3 or 4 , wherein a tilting mechanism for tilting the traveling vehicle body is provided, and the traveling vehicle body is tilted so that the outside of the turning surface becomes higher when turning as an adjustment of the turning performance.

Images