WO2020158295A1 - 作業車両用の目標経路生成システム - Google Patents

作業車両用の目標経路生成システム Download PDF

Info

Publication number
WO2020158295A1
WO2020158295A1 PCT/JP2019/051473 JP2019051473W WO2020158295A1 WO 2020158295 A1 WO2020158295 A1 WO 2020158295A1 JP 2019051473 W JP2019051473 W JP 2019051473W WO 2020158295 A1 WO2020158295 A1 WO 2020158295A1
Authority
WO
WIPO (PCT)
Prior art keywords
work
target route
information
vehicle
unit
Prior art date
Application number
PCT/JP2019/051473
Other languages
English (en)
French (fr)
Inventor
卓也 岩瀬
横山 和寿
士郎 ▲杉▼田
圭将 岩村
Original Assignee
ヤンマー株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by ヤンマー株式会社 filed Critical ヤンマー株式会社
Publication of WO2020158295A1 publication Critical patent/WO2020158295A1/ja

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0219Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
    • 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

Definitions

  • the present invention relates to a target route generation system for a work vehicle that generates a target route for automatically operating a passenger work vehicle such as a tractor or a rice transplanter, and an unmanned work vehicle such as an unmanned mower at a work site.
  • a passenger work vehicle such as a tractor or a rice transplanter
  • an unmanned work vehicle such as an unmanned mower at a work site.
  • the route generation unit reads work information including the work width of the work vehicle and the overlap amount of the work width read from the work information storage unit and the travel information read from the area information storage unit.
  • One configured to generate a series of target routes in which a plurality of straight roads (work routes) and a plurality of turning circuits (non-work routes) are alternately connected based on region information including the contours of regions (For example, see Patent Document 1).
  • position information of each point (hereinafter, referred to as a contour specified point) for specifying the contour of the traveling area and tilt angle information at each contour specified point.
  • area information are stored in the area information storage unit as area information.
  • the route generation unit when the route generation unit generates the target route, the traveling area is specified based on the inclination information at each contour identification point, and the area is measured, so that the measured area of the traveling area is actually measured. It is possible to generate a target route suitable for the area of the actual traveling area by preventing the area from becoming narrower than the area.
  • the main problem of the present invention is to construct a target route generation system for a work vehicle capable of generating an appropriate target route in consideration of the inclination of the work surface at the work site.
  • a first characteristic configuration of the present invention is a target route generation system for a work vehicle, A work site information acquisition unit that acquires work site information including topographic information for each predetermined section of the work site, A target route generation unit that generates a target route for automatic travel including a plurality of work routes arranged in parallel according to the work width of a work device equipped on the work vehicle; And a target route correction unit that corrects the arrangement interval of the work route based on the inclination information in the vehicle body roll direction of the topographical information.
  • the target route correction unit determines the arrangement interval of the work routes included in the target route generated by the target route generation unit in the vehicle body roll direction for each predetermined section (for example, 5 m square) in the work site. Based on the information, it is corrected to an appropriate arrangement interval in consideration of the inclination in the vehicle body roll direction at the work site.
  • the work vehicle is automatically driven according to the corrected target route, it is possible to avoid the possibility that an unworked area is formed between the adjacent work routes. That is, it was possible to construct a target route generation system for a work vehicle capable of generating an appropriate target route in consideration of the inclination in the vehicle body roll direction for each predetermined section in the work site.
  • the second characteristic configuration of the present invention is
  • the work site information acquisition unit acquires three-dimensional topographical information in which the altitude information for each of the predetermined sections is interpolated,
  • the target route correction unit assigns altitude information for each of the predetermined sections to the target route, and acquires inclination information in the vehicle body roll direction for each of the predetermined sections.
  • the work site information acquisition unit uses, for example, mesh altitude information (5 m square or 10 m square altitude information) provided by the Geographical Survey Institute, or three-dimensional topography measured using a drone or the like. If three-dimensional topographical information in which altitude information for each predetermined section of the work site such as information is interpolated via a recording medium such as a CD-ROM or a communication network such as the Internet, the target route correction unit , The altitude information for each predetermined section can be assigned to the target route generated by the target route generation unit, and the inclination information in the vehicle body roll direction for each predetermined section in the work site is acquired from the target route to which the altitude information is assigned. be able to.
  • the third characteristic configuration of the present invention is The target route correction unit, based on the target route and the tilt information in the vehicle body roll direction, three-dimensionally corrects the arrangement interval of the work route after causing the work vehicle to travel in a simulated manner according to the target route. It's a simulator.
  • the arrangement interval of the work routes on the target route and the inclination in the vehicle roll direction at the work site are considered. It can be corrected to an appropriate arrangement interval. As a result, when the work vehicle is automatically traveled along the corrected target route, it is possible to more reliably avoid the risk that an unworked region is formed between the adjacent work routes.
  • a fourth characteristic configuration of the present invention is
  • the target route correction unit obtains a plan-view work width for each of the predetermined sections of the work route based on the tilt information in the vehicle body roll direction, and based on the obtained plan-view work width, the adjacent work routes The point is to correct the arrangement interval of the work paths so that the overlap amount of the work width in plan view for each of the predetermined sections is equal to or more than a set value.
  • the target route correction unit sets the inclination in the vehicle body roll direction for each predetermined section. Based on the information, the work width in plan view for each predetermined section in the work route is obtained. Then, based on the obtained plan view work width for each predetermined section, the arrangement interval of each work route in the target route is narrowed so that the overlap amount of the plan view work width between the adjacent work routes becomes equal to or more than a set value. Perform correction.
  • the target route generated by the target route generation unit can be corrected to an appropriate target route that takes into consideration the inclination in the vehicle body roll direction for each predetermined section of the work site, and the work vehicle can be corrected according to the corrected target route.
  • the vehicle is automatically traveled, it is possible to secure the overlap amount of the work width in plan view between the adjacent work routes at a set value or more. As a result, it is possible to more surely avoid the possibility that an unworked area is generated between the adjacent work routes.
  • the figure which shows the schematic structure of the automatic driving system for work vehicles Diagram showing an example of a target route for automatic driving Block diagram showing a schematic configuration of a target route generation system for a work vehicle
  • the target route generation system for a work vehicle according to the present invention is a work vehicle other than a tractor, such as a riding mower, a combine, a riding rice transplanter, a riding seeder, a snowplow, a wheel loader, and an unmanned vehicle. It can be applied to unmanned work vehicles such as mowers.
  • an offset mower 3 which is an example of a working device, is connected to a rear part of the tractor 1 via a three-point link mechanism 2 so that the offset mower 3 can move up and down and roll. ..
  • the tractor 1 has a mowing specification.
  • the tractor 1 can automatically travel on the work site A shown in FIG. 2 or the like by using the automatic travel system for the work vehicle.
  • various work devices such as a rotary tiller, a plow, a disc harrow, a cultivator, a subsoiler, a seeding device, and a spraying device can be connected to the rear part of the tractor 1.
  • the automatic traveling system includes an automatic traveling unit 4 mounted on the tractor 1, and a mobile communication terminal 5 that is an example of a wireless communication device that is set to communicate with the automatic traveling unit 4 by wireless communication. It is included.
  • the mobile communication terminal 5 is provided with a multi-touch display device (for example, a liquid crystal panel) 50 that enables various kinds of information display and input operation regarding automatic driving.
  • the mobile communication terminal 5 may be a tablet-type personal computer, a smartphone, or the like.
  • wireless LAN Local Area Network
  • Wi-Fi registered trademark
  • Bluetooth registered trademark
  • the tractor 1 includes a drivable and steerable left and right front wheel 10, a drivable left and right rear wheel 11, a cabin 13 forming a riding-type driving unit 12, and a common rail system.
  • An electronically controlled diesel engine (hereinafter referred to as engine) 14 a bonnet 15 that covers the engine 14, a transmission unit 16 that shifts the power from the engine 14, and a fully hydraulic power steering unit that steers the left and right front wheels 10.
  • an electro-hydraulic control type work clutch unit 19 for intermittently transmitting power to the offset mower 3, and an electro-hydraulic control type elevation drive unit 20 for vertically driving the offset mower 3.
  • An electro-hydraulic control type rolling unit 21 that drives the offset mower 3 in the roll direction, a vehicle state detection device 22 including various sensors and switches that detect various setting states of the tractor 1 and operating states of various parts, and the like.
  • An in-vehicle control unit 23 having various control units is provided.
  • the engine 14 may be an electronically controlled gasoline engine having an electronic governor.
  • the power steering unit 17 may be an electric type having an electric motor for steering.
  • the driving unit 12 includes a steering wheel 25 for manual steering, a passenger seat 26, and a multi-touch liquid crystal monitor 27 that enables various information displays and input operations. Is provided. Although illustration is omitted, the operation unit 12 is provided with operation levers such as an accelerator lever and a shift lever, and operation pedals such as an accelerator pedal and a clutch pedal.
  • operation levers such as an accelerator lever and a shift lever
  • operation pedals such as an accelerator pedal and a clutch pedal.
  • the transmission unit 16 includes an electronically controlled continuously variable transmission that shifts the power from the engine 14, and an electronic device that switches the power after shifting by the continuously variable transmission between forward and reverse.
  • a hydraulic control type forward/reverse switching device, etc. are included.
  • As the continuously variable transmission an I-HMT (Integrated Hydro-static Mechanical Transmission) which is an example of a hydraulic mechanical continuously variable transmission having higher transmission efficiency than that of a hydrostatic continuously variable transmission (HST) is used.
  • HST hydrostatic continuously variable transmission
  • the forward/reverse switching device includes a hydraulic clutch for connecting/disconnecting the forward power, a hydraulic clutch for connecting/disconnecting the reverse power, and an electromagnetic valve for controlling the flow of oil to them.
  • the continuously variable transmission is, instead of the I-HMT, an HMT (Hydraulic Mechanical Transmission), a hydrostatic continuously variable transmission, or a belt type continuously variable transmission, which is an example of a hydraulic mechanical continuously variable transmission.
  • Etc. may be adopted.
  • the transmission unit 16 includes, instead of the continuously variable transmission, an electro-hydraulic control type stepped transmission having a plurality of hydraulic clutches for shifting and a plurality of electromagnetic valves for controlling the flow of oil to them. It may be.
  • the brake unit 18 operates the left and right brakes that individually brake the left and right rear wheels 11, and operates the left and right brakes in conjunction with the operation of depressing the left and right brake pedals provided in the driving unit 12.
  • the foot brake system, the parking brake system that operates the left and right brakes in conjunction with the operation of the parking lever provided in the driving unit 12, and the brakes inside the turn in conjunction with the steering of the left and right front wheels 10 over the set angle Includes a swing brake system to operate.
  • the vehicle state detection device 22 is a general term for various sensors and switches provided in each part of the tractor 1.
  • the vehicle state detection device 22 includes a vehicle speed sensor that detects the vehicle speed of the tractor 1, a rotation sensor that detects the output rotation speed of the engine 14, an accelerator sensor that detects the operation position of the accelerator lever, and a gear shift that detects the operation position of the speed change lever.
  • the in-vehicle control unit 23 includes an engine control unit 23A that controls the engine 14, a vehicle speed control unit 23B that controls the vehicle speed of the tractor 1 and switching between forward and backward movements, and a steering control that controls the steering. 23C, a work device control unit 23D that controls the work device such as the offset mower 3, a display control unit 23E that performs control related to display and notification on the liquid crystal monitor 27, an automatic travel control unit 23F that performs control related to automatic travel, and In addition, a nonvolatile vehicle-mounted storage unit 23G that stores a target route P (see FIG. 2) for automatic travel, which is generated according to the travel area divided into the work area, and the like are included.
  • a target route P see FIG. 2
  • Each of the control units 23A to 23F is constructed by an electronic control unit in which a microcontroller or the like is integrated and various control programs.
  • the control units 23A to 23F are connected to each other via a CAN (Controller Area Network) so that they can communicate with each other.
  • a communication standard other than CAN or a next-generation communication standard for example, vehicle-mounted Ethernet or CAN-FD (CAN with FLexible Data rate) may be adopted.
  • the engine control unit 23A executes engine rotation speed maintenance control for maintaining the engine rotation speed at the rotation speed corresponding to the operation position of the accelerator lever, based on the detection information from the accelerator sensor and the detection information from the rotation sensor. To do.
  • the vehicle speed control unit 23B is based on the detection information from the first position sensor, the detection information from the vehicle speed sensor, and the like so that the vehicle speed of the tractor 1 is changed to a speed corresponding to the operation position of the shift lever.
  • the vehicle speed control for controlling the operation of (1), the forward/reverse switching control for switching the transmission state of the forward/reverse switching device based on the detection information from the second position sensor, and the like are executed.
  • the vehicle speed control includes deceleration and stop processing for stopping the traveling of the tractor 1 by controlling the deceleration of the continuously variable transmission to the zero speed state when the shift lever is operated to the zero speed position.
  • the work device control unit 23D includes a work clutch control that controls the operation of the work clutch unit 19 based on the operation of the PTO switch, the operation of the elevating switch, the setting value of the height setting dial, and the like of the elevating drive unit 20.
  • the lifting control for controlling the operation, the rolling control for controlling the operation of the rolling unit 21 based on the set value of the roll angle setting dial, and the like are executed.
  • the PTO switch, the lift switch, the height setting dial, and the roll angle setting dial are included in the vehicle state detection device 22.
  • the tractor 1 is provided with a positioning unit 30 that measures the current position (latitude, longitude), current direction, etc. of the tractor 1.
  • the positioning unit 30 uses a GNSS (Global Navigation Satellite System), which is an example of a satellite positioning system (NSS: Navigation Satellite System), and a satellite navigation device 31 that measures the current position and the current azimuth of the tractor 1, and 3 It has an inertial measurement unit (IMU: Inertial Measurement Unit) 32, which has an axis gyroscope, a three-way acceleration sensor, and the like, and measures the posture, direction, and the like of the tractor 1.
  • IMU Inertial Measurement Unit
  • Positioning methods using GNSS include DGNSS (Differential GNSS: relative positioning method) and RTK-GNSS (Real Time Kinematic GNSS: interference positioning method).
  • DGNSS Downlink GNSS
  • RTK-GNSS Real Time Kinematic GNSS: interference positioning method
  • RTK-GNSS suitable for positioning a moving body is adopted. Therefore, as shown in FIG. 1, a reference station 6 that enables positioning by RTK-GNSS is installed at a known position around the work site.
  • each of the tractor 1 and the reference station 6 has GNSS antennas 33 and 60 that receive the radio waves transmitted from the positioning satellite 7 (see FIG. 1), and the tractor 1 and the reference station 6.
  • Communication modules 34, 61, and the like, which enable wireless communication of each information including positioning information, are provided.
  • the satellite navigation device 31 of the positioning unit 30 receives the positioning information obtained by the GNSS antenna 33 on the tractor side receiving the radio wave from the positioning satellite 7 and the GNSS antenna 60 on the base station side from the radio wave from the positioning satellite 7.
  • the current position and the current azimuth of the tractor 1 can be measured with high accuracy based on the positioning information obtained by receiving the.
  • the positioning unit 30 includes the satellite navigation device 31 and the inertial measurement device 32, so that the current position, the current azimuth, and the attitude angle (yaw angle, roll angle, pitch angle) of the tractor 1 can be measured with high accuracy.
  • the inertial measurement device 32 of the positioning unit 30, the GNSS antenna 33, and the communication module 34 are included in the antenna unit 35 shown in FIG.
  • the antenna unit 35 is arranged at the left and right center of the upper portion of the front side of the cabin 13.
  • the mounting position of the GNSS antenna 33 on the tractor 1 is the position to be measured when measuring the current position of the tractor 1 using the GNSS.
  • the terminal control unit 51 includes a display control unit 51A that controls display and notification on the display device 50, a vehicle body information acquisition unit 51B that acquires vehicle body information including information about the offset mower 3, and a predetermined section of the work site A.
  • a work site information acquisition unit 51C that acquires work site information including topographical information, a target route generation unit 51D that generates a target route P for automatic travel, and a target route P that the target route generation unit 51D generates are stored.
  • a non-volatile terminal storage unit 51E and the like are included.
  • the target route P includes a plurality of work routes P1 arranged in parallel and a plurality of direction changing routes P2 that connect each work route P1 in series in the order of travel.
  • the terminal storage unit 51E stores the target route P, the vehicle body information acquired by the vehicle body information acquisition unit 51B, the work site information acquired by the work site information acquisition unit 51C, and the like.
  • the vehicle body information includes the turning radius of the tractor 1, the offset amount D (see FIGS. 4 to 5) of the working width W of the offset mower 3 with respect to the lateral center of the tractor 1, the working width W of the offset mower 3, and the tractor.
  • the work site information the work site A obtained by using the GNSS when the tractor 1 is manually run along the outer peripheral edge of the work site A in identifying the shape and size of the work site A.
  • Four corner points Ap1 to Ap4 that are a plurality of shape specific points (shape specific coordinates), and a rectangular shape that connects the corner points Ap1 to Ap4 and specifies the shape and size of the work site A.
  • the specific line AL, etc. are included.
  • the target route generation unit 51D generates the target route P based on the vehicle body information acquired by the vehicle body information acquisition unit 51B and the work site information acquired by the work site information acquisition unit 51C. For example, as shown in FIG. 2, in a rectangular work site A, a start point p1 and an end point p2 of automatic travel are set, and the work travel direction of the tractor 1 is set along the long side of the work site A. In this case, the target route generation unit 51D first sets the work site A on the outer peripheral edge of the work site A based on the above-described four corner points Ap1 to Ap4 and the rectangular shape specifying line AL. It is divided into an adjacent margin area A1 and a traveling area A2 located inside the margin area A1.
  • the traveling area A2 is divided into a non-working area A2a set at both ends of the traveling area A2 on the long side and a work area A2b set between the non-working areas A2a.
  • the target route generation unit 51D operates the work center line L of the offset mower 3 in the work area A2b based on the above-described offset amount D, work width W, overlap amount Wo, etc. shown in FIGS.
  • a plurality of work paths P1 arranged in parallel with a predetermined arrangement interval S2, S3 are generated so that they are arranged in parallel in the direction along the short side of the ground A with a constant arrangement interval S1.
  • each non-work area A2a a plurality of direction change paths P2 that connect a plurality of work paths P1 in the order of travel are generated.
  • the target route generation unit 51D determines the target route P in consideration of the shape and size of the work site A, the working width W of the working device equipped on the tractor 1, the overlap amount Wo of the working width W, and the like. To generate.
  • FIG. 4 shows a state in which the offset amount D of the offset mower 3 with respect to the tractor 1 is set to the minimum
  • FIG. 5 shows a state in which the offset amount D of the offset mower 3 with respect to the tractor 1 is set to the maximum.
  • the margin area A1 is such that the offset mower 3 or the like comes into contact with another object such as a fence adjacent to the work area A when the tractor 1 automatically travels on the outer peripheral portion of the travel area A2.
  • This is an area secured between the outer peripheral edge of the work site A and the traveling area A2 in order to prevent the above.
  • Each non-work area A2a is a turning area for the tractor 1 to move from the current work path P1 to the next work path P1 at the end of the work site A.
  • each work route P1 is a work start point where the tractor 1 starts the mowing work
  • the ending point p4 of each work route P1 is the tractor 1 stopping the mowing work. It is a work stop point.
  • a connection point of the end point p4 of each work path P1 to the direction change path P2 is a direction change start point for the tractor 1 to move to the next work path P1, and is a start end point p3 of each work path P1.
  • the connection point with the direction change path P2 is a direction change end point where the tractor 1 has finished moving to the next work path P1.
  • the direction changing path P2 is a non-working path where the tractor 1 stops the mowing work.
  • the target route P shown in FIG. 2 is merely an example, and the target route generation unit 51D displays different vehicle body information depending on the type of the work device installed in the tractor 1, the work width W, and the work site A. Accordingly, based on work site information such as the shape and size of the work site A, etc., various target routes P can be generated in consideration of them.
  • the offset mower 3 having the offset amount D between the left and right center of the tractor 1 and the left and right center of the work width W is used as the work device mounted on the tractor 1, the offset mower 3 having the offset amount D between the left and right center of the tractor 1 and the left and right center of the work width W is used.
  • the left and right center of the tractor 1 and the left and right center of the work width W are different.
  • the tractor 1 is equipped with a working device (for example, a rotary cultivating device) that matches with, the offset amount D between the left-right center of the tractor 1 and the left-right center of the working width W becomes zero.
  • the arrangement interval S1 of the work center line L of the apparatus and the arrangement intervals S2 and S3 of the work route P1 on the target route P are the same.
  • the target route P is stored in the terminal storage unit 51E in a state of being associated with vehicle body information, work site information, etc., and can be displayed on the display device 50 of the mobile communication terminal 5.
  • the target route P includes a target vehicle speed of the tractor 1 on each parallel route P3, a target vehicle speed of the tractor 1 on each turning route P2b, a front wheel steering angle on each work route P1, a front wheel steering angle on each turning route P2b, and the like. include.
  • the terminal control unit 51 transmits the work site information, the target route P, and the like stored in the terminal storage unit 51E to the in-vehicle control unit 23 in response to the transmission request command from the in-vehicle control unit 23.
  • the vehicle-mounted control unit 23 stores the received work site information, the target route P, and the like in the vehicle-mounted storage unit 23G.
  • the terminal control unit 51 transmits all of the target route P from the terminal storage unit 51E to the vehicle-mounted control unit 23 at a stage before the tractor 1 starts the automatic traveling.
  • the terminal control unit 51 divides the target route P into a plurality of divided route information for each predetermined distance, and each time the traveling distance of the tractor 1 reaches the predetermined distance from the stage before the tractor 1 starts the automatic traveling.
  • a predetermined number of divided route information according to the traveling order of the tractor 1 may be sequentially transmitted from the terminal storage unit 51E to the vehicle-mounted control unit 23.
  • the automatic traveling control unit 23F In the on-vehicle control unit 23, detection information from various sensors and switches included in the vehicle state detection device 22 is input to the automatic traveling control unit 23F via the vehicle speed control unit 23B, the steering control unit 23C, and the like. ing. As a result, the automatic travel control unit 23F can monitor various setting states of the tractor 1 and operating states of each unit.
  • the automatic traveling control unit 23F is carried by a user such as an occupant or an administrator when the traveling mode of the tractor 1 is switched to the automatic traveling mode by performing a manual operation for satisfying various automatic traveling start conditions.
  • the positioning unit 30 automatically travels the tractor 1 according to the target route P while acquiring the current position and the current direction of the tractor 1. Start automatic cruise control.
  • the automatic travel control unit 23F is in the operation unit 12 when, for example, the user operates the display device 50 of the mobile communication terminal 5 to instruct the end of the automatic travel.
  • the automatic traveling control is ended and the traveling mode is switched from the automatic traveling mode to the manual traveling mode.
  • the traveling mode of the tractor 1 is switched from the manual traveling mode to the automatic traveling mode. Then, in this state, by operating the display device 50 of the mobile communication terminal 5 to command the start of the automatic traveling, the automatic traveling control can be restarted.
  • the automatic travel control by the automatic travel control unit 23F includes an automatic engine control process for transmitting a control command for automatic travel related to the engine 14 to the engine control unit 23A, and an automatic travel control for switching the vehicle speed of the tractor 1 and forward/backward movement.
  • the work automatic control process for transmitting the control command of (3) to the work device control unit 23D is included.
  • the automatic traveling control unit 23F instructs the engine control unit 23A to issue an engine rotational speed change command for instructing to change the engine rotational speed based on the set rotational speed included in the target route P. Send.
  • the engine control unit 23A executes engine rotation speed change control for automatically changing the engine rotation speed according to various control commands regarding the engine 14 transmitted from the automatic travel control unit 23F.
  • the automatic traveling control unit 23F includes a gear shift operation command for instructing a gear shift operation of the continuously variable transmission based on the target vehicle speed included in the target route P and the target route P included in the target route P.
  • a forward/reverse switching command for instructing a forward/backward switching operation of the forward/backward switching device based on the traveling direction of the tractor 1 or the like is transmitted to the vehicle speed control unit 23B.
  • the vehicle speed control unit 23B automatically controls the operation of the continuously variable transmission according to various control commands regarding the continuously variable transmission, the forward/reverse switching device, and the like transmitted from the automatic travel control unit 23F, and , Automatic forward/reverse switching control for automatically controlling the operation of the forward/reverse switching device, and the like.
  • automatic deceleration stop processing for controlling the continuously variable transmission to decelerate to zero speed and stop the traveling of the tractor 1 and the like. It is included.
  • the automatic traveling control unit 23F transmits to the steering control unit 23C a steering command for instructing the steering of the left and right front wheels 10 based on the front wheel steering angle included in the target route P and the like. ..
  • the steering control section 23C controls the operation of the power steering unit 17 to steer the left and right front wheels 10 according to the steering command transmitted from the automatic travel control section 23F, and the left and right front wheels 10 are set.
  • the brake unit 18 is operated to perform automatic brake turning control for actuating the brake inside the turning, and the like.
  • the automatic traveling control unit 23F based on the work start point p3 included in the target route P, a work start command for instructing switching of the offset mower 3 to the work state, and the target route P.
  • a work stop command for instructing switching of the offset mower 3 to the non-working state based on the work stop point p4 included in the above, and the like are transmitted to the work device control unit 23D.
  • the work device control unit 23D controls the operation of the work clutch unit 19 and the elevation drive unit 20 in accordance with various control commands regarding the offset mower 3 transmitted from the automatic travel control unit 23F, and the work height of the offset mower 3 is controlled.
  • Automatic work start control for lowering and operating the work, and automatic work stop control for stopping the offset mower 3 and raising it to the non-work height are executed.
  • the tractor 1 can be accurately and automatically traveled along the target route P.
  • the target route P generated by the target route generation unit 51D is the shape and size of the work site A, and the work width W of the work device mounted on the tractor 1 and the overlap of the work width W.
  • the quantity Wo and the like are taken into consideration. Therefore, at the stage where the target path P is formed, as shown in FIGS. 4 to 5, the work center line of the offset mower 3 is set so that a constant overlap amount Wo is secured between the adjacent work paths P1.
  • the arrangement interval S1 of L and the arrangement intervals S2 and S3 (see FIG. 2) of the work route P1 on the target route P are set.
  • the target route P generated by the target route generation unit 51D is two-dimensionally generated based on the current position (latitude, longitude) of the tractor 1 measured using the satellite positioning system, and the work site A The inclination of the work surface (ground) at is not considered. Therefore, when the tractor 1 is actually automatically traveled along the target route P, the offset mower 3 swings in the roll direction in accordance with the inclination of the work surface at the work site A, as shown in FIGS. In addition, as the roll angle ⁇ of the offset mower 3 at that time becomes larger, the work width Wp of the offset mower 3 in plan view becomes narrower than the work width W of the offset mower 3 which is constant when the target path P is generated. .. As a result, the overlap amount Wo set at the time of generation of the target route P shown in FIGS. 4 to 5 can hardly be ensured during actual traveling as shown in FIG.
  • the work site information acquisition unit 51C performs work such as mesh altitude information (5 m square or 10 m square altitude information) provided by the Geographical Survey Institute, or three-dimensional topographical information measured using a drone or the like. It is configured to obtain three-dimensional topographical information in which altitude information for each predetermined section (for example, 5 m square) of the ground A is interpolated via a recording medium such as a CD-ROM or a communication network such as the Internet. .. Then, as shown in FIG. 3, the terminal control unit 51 includes a target route correction unit that executes target route correction control for correcting the target route P based on the three-dimensional topographical information acquired by the work site information acquisition unit 51C. 51F is provided.
  • work site information acquisition unit 51C performs work such as mesh altitude information (5 m square or 10 m square altitude information) provided by the Geographical Survey Institute, or three-dimensional topographical information measured using a drone or the like. It is configured to obtain three-dimensional topographical information in which altitude information
  • the target route correction unit 51F first performs a target route acquisition process for acquiring the target route P generated by the target route generation unit 51D (step #1), and acquires the three-dimensional topographical information acquired by the work site information acquisition unit 51C.
  • the three-dimensional topographic information acquisition process to be acquired is performed (step #2).
  • altitude information allocation processing is performed to allocate altitude information for each predetermined section of the work site A interpolated in the acquired three-dimensional topographical information to the two-dimensional target route P (step #3), and for each predetermined section.
  • a gradient calculation process for obtaining a gradient (inclination information) in the vehicle body roll direction on the work surface for each predetermined section from the target route P to which the altitude information is assigned (step #4) Then, based on the obtained gradient in the vehicle body roll direction on the work surface for each predetermined section, a work width calculation process for obtaining the plan view work width Wp of the offset mower 3 for each predetermined section is performed (step #5), and the determined predetermined value is obtained.
  • the arrangement interval S1 of the work center line L of the offset mower 3 (FIGS. 2 and 4 to 4) so that the above-described overlap amount Wo becomes equal to or more than a set value (for example, 10 cm). 5 and FIGS. 7 to 9)
  • a route interval correction process is performed to narrow the placement intervals S2 and S3 (see FIGS. 2 and 7 to 9) of the work routes P1 on the target route P (step #6).
  • the target route P generated by the target route generation unit 51D exceeds the set value during actual traveling as shown in FIGS. 8 to 9 in consideration of the inclination of the work surface in each predetermined section of the work site A. It is possible to correct the target route P so that the lap amount Wo can be secured. As a result, as shown in FIG. 9, it is possible to avoid a possibility that an uncut area is formed between the adjacent work paths P1.
  • the configuration of the work vehicle 1 can be variously changed.
  • the work vehicle 1 may be configured as a semi-crawler specification including left and right crawlers instead of the left and right rear wheels 11.
  • the work vehicle 1 may be configured as a full crawler specification including left and right crawlers instead of the left and right front wheels 10 and the left and right rear wheels 11.
  • the work vehicle 1 may have a rear wheel steering specification in which the left and right rear wheels 11 function as steered wheels.
  • the work vehicle 1 may be configured to have an electric specification including an electric motor for traveling instead of the engine 14.
  • the work vehicle 1 may be configured to have a hybrid specification including the engine 14 and an electric motor for traveling.
  • the vehicle body information acquisition unit 51B, the work site information acquisition unit 51C, the target route generation unit 51D, and the target route correction unit 51F may be included in the in-vehicle control unit 23.
  • the target route correction unit 51F is provided in, for example, a management computer of a management center that is communicably connected to the automatic traveling unit 4 of the tractor 1 and the mobile communication terminal 5 via a communication network such as the Internet. Good.
  • a management computer of a management center that is communicably connected to the automatic traveling unit 4 of the tractor 1 and the mobile communication terminal 5 via a communication network such as the Internet. Good.
  • the processing capability is In a high management computer or the like, the target route P generated by the target route generation unit 51D can be corrected by the target route correction unit 51F.
  • the vehicle body information acquisition unit 51B, the work site information acquisition unit 51C, the target route generation unit 51D, and the target route correction unit 51F connect the automatic traveling unit 4 of the tractor 1 and the mobile communication terminal 5 to a communication network such as the Internet. It may be provided in a management computer or the like of a management center that is communicatively connected via. In this case, it is possible to perform a series of processes from the generation of the target route P to the correction of the target route P in a management computer having a high processing capacity.
  • the target route correction unit 51F for example, based on the vehicle body information, the target route P, and the inclination information in the vehicle body roll direction described above, causes the work vehicle 1 to travel in a simulated manner according to the target route P, and then, A three-dimensional simulator that corrects the arrangement intervals S2 and S3 of the work route P1 on the target route P so that the overlap amount Wo that is equal to or greater than the set value can be ensured during traveling may be used.
  • the three-dimensional simulator is adopted as the target route correction unit 51F, when the work vehicle is automatically driven according to the corrected target route, there is more concern that an unworked area is formed between the adjacent work routes. It can be avoided without fail.
  • this three-dimensional simulator is provided with a vehicle body information acquisition unit 51B, a work site information acquisition unit 51C, and a target route generation unit 51D, and the three-dimensional simulator performs the process from generation of the target route P to correction of the target route P. May be configured to be performed in series.
  • the target route correction unit 51F acquires the detection information from the roll angle detector that detects the roll angle of the working device 3 during actual traveling, and corrects it based on the acquired roll angle of the working device 3, for example. It may be configured to further correct the subsequent target path P. As an example, the target route correction unit 51F first acquires the roll angle of the work device 3 for each predetermined section during actual traveling on the work route P1. Next, the obtained roll angle of the work device 3 for each predetermined section and the gradient (inclination) in the vehicle body roll direction on the work surface for each predetermined section on the same work path P1 obtained in the correction stage of the target path P before actual traveling. Information).
  • the difference between the difference and the gradient (inclination information) in the vehicle body roll direction on the work plane for each predetermined section on the next work route P1 obtained in the correction stage of the target route P before the actual traveling makes the vehicle actually traveling. It is determined whether or not the overlap amount Wo of the set value or more can be ensured between the work path P1 and the next work path P1. In this determination, when it is determined that it is impossible to secure the overlap amount Wo that is equal to or larger than the set value, the interval between the actual work route P1 and the next work route P1 is set to the overlap amount that is equal to or larger than the set value. Correct to a narrow interval that can secure Wo.
  • the target route P corrected before the actual traveling can be corrected to a more appropriate target route P in consideration of the inclination of the work surface for each predetermined section of the actual work site A.
  • the target route P corrected before the actual traveling can be corrected to a more appropriate target route P in consideration of the inclination of the work surface for each predetermined section of the actual work site A.
  • the terrain information (inclination information in the vehicle body roll direction) for each predetermined section of the work site A acquired by the work site information acquisition unit 51C is, for example, according to the same target route P on the same work site A previously used by the work vehicle 1. It may be based on the roll angle of the work device 3 detected by the roll angle detector provided in the work device 3 when the vehicle travels.
  • a target route generation system for a work vehicle according to the present invention is, for example, a riding work vehicle such as a tractor, a riding mower, a combine, a riding rice transplanter, a riding seeder, a snowplow, a wheel loader, and an unmanned mower. It can be applied to unmanned work vehicles.
  • a riding work vehicle such as a tractor, a riding mower, a combine, a riding rice transplanter, a riding seeder, a snowplow, a wheel loader, and an unmanned mower. It can be applied to unmanned work vehicles.

Landscapes

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

Abstract

作業地での地面の傾斜がより適正に考慮された好適な目標経路を生成する。作業車両用の目標経路生成システムは、作業地の所定区間ごとの地形情報を含む作業地情報を取得する作業地情報取得部(51C)と、作業車両(1)に装備された作業装置の作業幅に応じて並列に並ぶ複数の作業経路を含む自動走行用の目標経路を生成する目標経路生成部(51D)と、地形情報のうちの車体ロール方向の傾斜情報に基づいて作業経路の配置間隔を補正する目標経路補正部(51F)と、を有している。

Description

作業車両用の目標経路生成システム
 本発明は、トラクタや乗用田植機などの乗用作業車両、及び、無人草刈機などの無人作業車両を作業地にて自動走行させるための目標経路を生成する作業車両用の目標経路生成システムに関する。
 作業車両用の目標経路生成システムとしては、経路生成部が、作業情報記憶部から読み出した作業車両の作業幅や作業幅のオーバーラップ量などを含む作業情報と、領域情報記憶部から読み出した走行領域の輪郭などを含む領域情報とに基づいて、複数の直線路(作業経路)と複数の旋回路(非作業経路)とを交互に繋いだ一連の目標経路を生成するように構成されたものがある(例えば特許文献1参照)。
特開2017-182373号公報
 特許文献1に記載の作業車両用の目標経路生成システムにおいては、走行領域の輪郭を特定するための各地点(以下、輪郭特定地点と称する)の位置情報や各輪郭特定地点での傾斜角情報などが領域情報として領域情報記憶部に記憶されている。そして、経路生成部が、目標経路を生成する場合に、各輪郭特定地点での傾斜情報を踏まえた上で走行領域を特定し、その面積を計測することにより、計測した走行領域の面積が実際の面積よりも狭くなることを防止し、これにより、実際の走行領域の面積に適した目標経路の生成を可能にしている。
 しかしながら、特許文献1に記載の作業車両用の目標経路生成システムにおいては、目標経路を生成するにあたって、計測した走行領域の面積が実際の面積よりも狭くなることを防止するだけで、作業地での作業面(地面)の傾斜は考慮されていない。そのため、実際に作業車両を目標経路に従って自動走行させた場合には、作業装置が、作業地での作業面の傾斜に応じてロール方向に揺動し、このときの作業装置のロール角が大きいほど、目標経路の生成時に設定された作業装置の作業幅に対して実際の作業装置の平面視での作業幅が狭くなり、これに伴って、目標経路の生成時に設定された作業幅のオーバーラップ量が減少するだけでなく、隣接する作業経路間に未作業領域が形成されることがある。
 つまり、隣接する作業経路間に未作業領域が形成されないようにするためには、作業地での作業面の傾斜が考慮された適正な目標経路を生成する必要がある。
 この実情に鑑み、本発明の主たる課題は、作業地での作業面の傾斜が考慮された適正な目標経路を生成することができる作業車両用の目標経路生成システムを構築する点にある。
 本発明の第1特徴構成は、作業車両用の目標経路生成システムにおいて、
 作業地の所定区間ごとの地形情報を含む作業地情報を取得する作業地情報取得部と、
 作業車両に装備された作業装置の作業幅に応じて並列に並ぶ複数の作業経路を含む自動走行用の目標経路を生成する目標経路生成部と、
 前記地形情報のうちの車体ロール方向の傾斜情報に基づいて前記作業経路の配置間隔を補正する目標経路補正部と、を有している点にある。
 本構成によれば、目標経路生成部が生成した目標経路に含まれている作業経路の配置間隔を、目標経路補正部が、作業地における所定区間(例えば5m四方)ごとの車体ロール方向の傾斜情報に基づいて、作業地における車体ロール方向の傾斜が考慮された適正な配置間隔に補正する。
 これにより、補正後の目標経路に従って作業車両を自動走行させた場合には、隣接する作業経路間に未作業領域が形成される虞を回避することができる。
 つまり、作業地における所定区間ごとの車体ロール方向の傾斜が考慮された適正な目標経路を生成することができる作業車両用の目標経路生成システムを構築することができた。
 本発明の第2特徴構成は、
 前記作業地情報取得部は、前記所定区間ごとの高度情報が内挿された三次元の地形情報を取得し、
 前記目標経路補正部は、前記目標経路に前記所定区間ごとの高度情報を割り当てて、前記所定区間ごとの前記車体ロール方向の傾斜情報を取得する点にある。
 本構成によれば、作業地情報取得部が、例えば、国土地理院から提供されているメッシュ標高情報(5m四方又は10m四方の標高情報)、又は、ドローンなどを利用して計測した三次元地形情報、などの作業地の所定区間ごとの高度情報が内挿された三次元の地形情報を、CD-ROMなどの記録媒体やインターネットなどの通信網を介して取得すれば、目標経路補正部が、その所定区間ごとの高度情報を、目標経路生成部が生成した目標経路に割り当てることができ、高度情報が割り当てられた目標経路から作業地における所定区間ごとの車体ロール方向の傾斜情報を取得することができる。
 つまり、例えば、ロール角検出器が備えられた作業車両を、目標経路生成部が生成した目標経路に従って実際に走行させる手間を要することなく、作業地における所定区間ごとの傾斜情報を取得することができ、作業地における所定区間ごとの車体ロール方向の傾斜が考慮された適正な目標経路を生成することができる。
 本発明の第3特徴構成は、
 前記目標経路補正部は、前記目標経路と前記車体ロール方向の傾斜情報とに基づいて、前記作業車両を前記目標経路に従って模擬的に走行させた上で前記作業経路の配置間隔を補正する3次元シミュレータである点にある。
 本構成によれば、目標経路生成部が生成した目標経路に従って作業車両を走行させた状態を視認しながら、目標経路における作業経路の配置間隔を、作業地における車体ロール方向の傾斜が考慮された適正な配置間隔に補正することができる。
 その結果、補正後の目標経路に従って作業車両を自動走行させた場合に、隣接する作業経路間に未作業領域が形成される虞をより確実に回避することができる。
 本発明の第4特徴構成は、
 前記目標経路補正部は、前記車体ロール方向の傾斜情報に基づいて前記作業経路における前記所定区間ごとの平面視作業幅を求め、求めた前記平面視作業幅に基づいて、隣接する前記作業経路における前記所定区間ごとの前記平面視作業幅のオーバーラップ量が設定値以上になるように前記作業経路の配置間隔を補正する点にある。
 本構成によれば、作業地における所定区間ごとの車体ロール方向の傾斜が大きくなるほど、作業装置の平面視作業幅が狭くなることから、目標経路補正部は、所定区間ごとの車体ロール方向の傾斜情報に基づいて作業経路における所定区間ごとの平面視作業幅を求める。そして、求めた所定区間ごとの平面視作業幅に基づいて、隣接する作業経路間における平面視作業幅のオーバーラップ量が設定値以上になるように、目標経路における各作業経路の配置間隔を狭くする補正を行う。
 これにより、目標経路生成部が生成した目標経路を、作業地における所定区間ごとの車体ロール方向の傾斜が考慮された適正な目標経路に補正することができ、この補正後の目標経路に従って作業車両を自動走行させた場合に、隣接する作業経路間における平面視作業幅のオーバーラップ量を設定値以上に確保することができる。
 その結果、隣接する作業経路間において未作業領域が生じる虞をより確実に回避することができる。
作業車両用の自動走行システムの概略構成を示す図 自動走行用の目標経路の一例を示す図 作業車両用の目標経路生成システムの概略構成を示すブロック図 作業車両に対する作業装置のオフセット量を最小に設定した状態での作業経路と作業幅などとの位置関係を示す平面図 作業車両に対する作業装置のオフセット量を最大に設定した状態での作業経路と作業幅などとの位置関係を示す平面図 作業装置の作業幅とロール角との関係を示す背面図 補正前の作業経路の配置間隔と作業装置の作業幅との関係を示す概略平面図 補正後の作業経路の配置間隔と作業装置の作業幅との関係を示す概略平面図 補正後の作業経路の配置間隔と作業装置の作業幅との関係を示す概略背面図 目標経路補正制御のフローチャート
 以下、本発明を実施するための形態の一例として、本発明に係る作業車両用の目標経路生成システムを、作業車両の一例であるトラクタに適用した実施形態を図面に基づいて説明する。
 なお、本発明に係る作業車両用の目標経路生成システムは、トラクタ以外の、例えば乗用草刈機、コンバイン、乗用田植機、乗用播種機、除雪車、ホイールローダ、などの乗用作業車両、及び、無人草刈機などの無人作業車両に適用することができる。
 図1に示すように、本実施形態に例示されたトラクタ1は、その後部に3点リンク機構2を介して、作業装置の一例であるオフセットモア3が昇降可能かつローリング可能に連結されている。これにより、このトラクタ1は草刈り仕様に構成されている。トラクタ1は、作業車両用の自動走行システムを使用することにより、図2に示す作業地Aなどにおいて自動走行することができる。
 なお、トラクタ1の後部には、オフセットモア3に代えて、ロータリ耕耘装置、プラウ、ディスクハロー、カルチベータ、サブソイラ、播種装置、散布装置、などの各種の作業装置を連結することができる。
 図3に示すように、自動走行システムには、トラクタ1に搭載された自動走行ユニット4と、自動走行ユニット4と無線通信可能に通信設定された無線通信機器の一例である携帯通信端末5とが含まれている。携帯通信端末5には、自動走行に関する各種の情報表示や入力操作などを可能にするマルチタッチ式の表示デバイス(例えば液晶パネル)50などが備えられている。
 なお、携帯通信端末5には、タブレット型のパーソナルコンピュータやスマートフォンなどを採用することができる。又、無線通信には、Wi-Fi(登録商標)などの無線LAN(Local Area Network)やBluetooth(登録商標)などの近距離無線通信などを採用することができる。
 図1、図3に示すように、トラクタ1には、駆動可能で操舵可能な左右の前輪10、駆動可能な左右の後輪11、搭乗式の運転部12を形成するキャビン13、コモンレールシステムを有する電子制御式のディーゼルエンジン(以下、エンジンと称する)14、エンジン14などを覆うボンネット15、エンジン14からの動力を変速する変速ユニット16、左右の前輪10を操舵する全油圧式のパワーステアリングユニット17、左右の後輪11を制動するブレーキユニット18、オフセットモア3への伝動を断続する電子油圧制御式の作業クラッチユニット19、オフセットモア3を昇降駆動する電子油圧制御式の昇降駆動ユニット20、オフセットモア3をロール方向に駆動する電子油圧制御式のローリングユニット21、トラクタ1における各種の設定状態や各部の動作状態などを検出する各種のセンサやスイッチなどを含む車両状態検出機器22、及び、各種の制御部を有する車載制御ユニット23、などが備えられている。
 なお、エンジン14には、電子ガバナを有する電子制御式のガソリンエンジンなどを採用してもよい。又、パワーステアリングユニット17には、操舵用の電動モータを有する電動式を採用してもよい。
 図1に示すように、運転部12には、手動操舵用のステアリングホイール25と、搭乗者用の座席26と、各種の情報表示や入力操作などを可能にするマルチタッチ式の液晶モニタ27とが備えられている。図示は省略するが、運転部12には、アクセルレバーや変速レバーなどの操作レバー類、及び、アクセルペダルやクラッチペダルなどの操作ペダル類、などが備えられている。
 図示は省略するが、変速ユニット16には、エンジン14からの動力を変速する電子制御式の無段変速装置、及び、無段変速装置による変速後の動力を前進用と後進用とに切り換える電子油圧制御式の前後進切換装置、などが含まれている。無段変速装置には、静油圧式無段変速装置(HST:Hydro Static Transmission)よりも伝動効率が高い油圧機械式無段変速装置の一例であるI-HMT(Integrated Hydro-static Mechanical Transmission)が採用されている。前後進切換装置には、前進動力断続用の油圧クラッチと、後進動力断続用の油圧クラッチと、それらに対するオイルの流れを制御する電磁バルブとが含まれている。
 なお、無段変速装置には、I-HMTの代わりに、油圧機械式無段変速装置の一例であるHMT(Hydraulic Mechanical Transmission)、静油圧式無段変速装置、又は、ベルト式無段変速装置、などを採用してもよい。又、変速ユニット16には、無段変速装置の代わりに、複数の変速用の油圧クラッチとそれらに対するオイルの流れを制御する複数の電磁バルブとを有する電子油圧制御式の有段変速装置が含まれていてもよい。
 図示は省略するが、ブレーキユニット18には、左右の後輪11を個別に制動する左右のブレーキ、運転部12に備えられた左右のブレーキペダルの踏み込み操作に連動して左右のブレーキを作動させるフットブレーキ系、運転部12に備えられたパーキングレバーの操作に連動して左右のブレーキを作動させるパーキングブレーキ系、及び、左右の前輪10の設定角度以上の操舵に連動して旋回内側のブレーキを作動させる旋回ブレーキ系、などが含まれている。
 車両状態検出機器22は、トラクタ1の各部に備えられた各種のセンサやスイッチなどの総称である。車両状態検出機器22には、トラクタ1の車速を検出する車速センサ、エンジン14の出力回転数を検出する回転センサ、アクセルレバーの操作位置を検出するアクセルセンサ、変速レバーの操作位置を検出する変速用の第1位置センサ、前後進切り換え用のリバーサレバーの操作位置を検出する前後進切り換え用の第2位置センサ、及び、前輪10の操舵角を検出する舵角センサ、などが含まれている。
 図3に示すように、車載制御ユニット23には、エンジン14に関する制御を行うエンジン制御部23A、トラクタ1の車速や前後進の切り換えに関する制御を行う車速制御部23B、ステアリングに関する制御を行うステアリング制御部23C、オフセットモア3などの作業装置に関する制御を行う作業装置制御部23D、液晶モニタ27などに対する表示や報知に関する制御を行う表示制御部23E、自動走行に関する制御を行う自動走行制御部23F、及び、作業地内に区分けされた走行領域に応じて生成された自動走行用の目標経路P(図2参照)などを記憶する不揮発性の車載記憶部23G、などが含まれている。各制御部23A~23Fは、マイクロコントローラなどが集積された電子制御ユニットや各種の制御プログラムなどによって構築されている。各制御部23A~23Fは、CAN(Controller Area Network)を介して相互通信可能に接続されている。
 なお、各制御部23A~23Fの相互通信には、CAN以外の通信規格や次世代通信規格である、例えば、車載EthernetやCAN-FD(CAN with FLexible Data rate)などを採用してもよい。
 エンジン制御部23Aは、アクセルセンサからの検出情報と回転センサからの検出情報とに基づいて、エンジン回転数をアクセルレバーの操作位置に応じた回転数に維持するエンジン回転数維持制御、などを実行する。
 車速制御部23Bは、第1位置センサからの検出情報と車速センサからの検出情報などに基づいて、トラクタ1の車速が変速レバーの操作位置に応じた速度に変更されるように無段変速装置の作動を制御する車速制御、及び、第2位置センサからの検出情報に基づいて前後進切換装置の伝動状態を切り換える前後進切り換え制御、などを実行する。車速制御には、変速レバーが零速位置に操作された場合に、無段変速装置を零速状態まで減速制御してトラクタ1の走行を停止させる減速停止処理が含まれている。
 作業装置制御部23Dには、PTOスイッチの操作などに基づいて作業クラッチユニット19の作動を制御する作業クラッチ制御、昇降スイッチの操作や高さ設定ダイヤルの設定値などに基づいて昇降駆動ユニット20の作動を制御する昇降制御、及び、ロール角設定ダイヤルの設定値などに基づいてローリングユニット21の作動を制御するローリング制御、などを実行する。PTOスイッチ、昇降スイッチ、高さ設定ダイヤル、及び、ロール角設定ダイヤルは、車両状態検出機器22に含まれている。
 図3に示すように、トラクタ1には、トラクタ1の現在位置(緯度、経度)や現在方位などを測定する測位ユニット30が備えられている。測位ユニット30は、衛星測位システム(NSS:Navigation Satellite System)の一例であるGNSS(Global Navigation Satellite System)を利用してトラクタ1の現在位置と現在方位とを測定する衛星航法装置31、及び、3軸のジャイロスコープ及び3方向の加速度センサなどを有してトラクタ1の姿勢や方位などを測定する慣性計測装置(IMU:Inertial Measurement Unit)32、などを有している。GNSSを利用した測位方法には、DGNSS(Differential GNSS:相対測位方式)やRTK-GNSS(Real Time Kinematic GNSS:干渉測位方式)などがある。本実施形態においては、移動体の測位に適したRTK-GNSSが採用されている。そのため、図1に示すように、作業地周辺の既知位置には、RTK-GNSSによる測位を可能にする基準局6が設置されている。
 図1、図3に示すように、トラクタ1と基準局6とのそれぞれには、測位衛星7(図1参照)から送信された電波を受信するGNSSアンテナ33,60、及び、トラクタ1と基準局6との間における測位情報を含む各情報の無線通信を可能にする通信モジュール34,61、などが備えられている。これにより、測位ユニット30の衛星航法装置31は、トラクタ側のGNSSアンテナ33が測位衛星7からの電波を受信して得た測位情報と、基地局側のGNSSアンテナ60が測位衛星7からの電波を受信して得た測位情報とに基づいて、トラクタ1の現在位置及び現在方位を高い精度で測定することができる。又、測位ユニット30は、衛星航法装置31と慣性計測装置32とを有することにより、トラクタ1の現在位置、現在方位、姿勢角(ヨー角、ロール角、ピッチ角)を高精度に測定することができる。
 このトラクタ1において、測位ユニット30の慣性計測装置32、GNSSアンテナ33、及び、通信モジュール34は、図1に示すアンテナユニット35に含まれている。アンテナユニット35は、キャビン13の前面側における上部の左右中央箇所に配置されている。そして、トラクタ1におけるGNSSアンテナ33の取り付け位置が、GNSSを利用してトラクタ1の現在位置などを測定するときの測位対象位置となっている。
 図3に示すように、携帯通信端末5には、マイクロコントローラなどが集積された電子制御ユニットや各種の制御プログラムなどを有する端末制御ユニット51、及び、トラクタ側の通信モジュール34との間における測位情報を含む各情報の無線通信を可能にする通信モジュール52、などが備えられている。端末制御ユニット51には、表示デバイス50などに対する表示や報知に関する制御を行う表示制御部51A、オフセットモア3に関する情報を含む車体情報を取得する車体情報取得部51B、作業地Aの所定区間ごとの地形情報を含む作業地情報を取得する作業地情報取得部51C、自動走行用の目標経路Pを生成する目標経路生成部51D、及び、目標経路生成部51Dが生成した目標経路Pなどを記憶する不揮発性の端末記憶部51E、などが含まれている。
 図2に示すように、目標経路Pには、並列に並ぶ複数の作業経路P1と各作業経路P1を走行順に一連に接続する複数の方向転換経路P2とが含まれている。端末記憶部51Eには、目標経路Pとともに、車体情報取得部51Bが取得した車体情報、及び、作業地情報取得部51Cが取得した作業地情報、などが記憶されている。車体情報には、トラクタ1の旋回半径、トラクタ1の左右中心に対するオフセットモア3における作業幅Wの左右中心のオフセット量D(図4~5参照)、オフセットモア3の作業幅W、及び、トラクタ1が隣接する作業経路P1を走行するときの作業幅Wのオーバーラップ量Wo(図4~5参照)、などの目標経路Pの生成に使用する各種の情報が含まれている。作業地情報には、作業地Aの形状や大きさなどを特定する上において、トラクタ1を作業地Aの外周縁に沿って手動走行させたときにGNSSを利用して取得した作業地Aにおける複数の形状特定地点(形状特定座標)となる4つの角部地点Ap1~Ap4、及び、それらの角部地点Ap1~Ap4を繋いで作業地Aの形状や大きさなどを特定する矩形状の形状特定線AL、などが含まれている。
 目標経路生成部51Dは、車体情報取得部51Bが取得した車体情報、及び、作業地情報取得部51Cが取得した作業地情報、などに基づいて目標経路Pを生成する。
 例えば、図2に示すように、矩形状の作業地Aにおいて、自動走行の開始地点p1と終了地点p2とが設定され、トラクタ1の作業走行方向が作業地Aの長辺に沿う方向に設定されている場合は、目標経路生成部51Dは、先ず、作業地Aを、前述した4つの角部地点Ap1~Ap4と矩形状の形状特定線ALとに基づいて、作業地Aの外周縁に隣接するマージン領域A1と、マージン領域A1の内側に位置する走行領域A2とに区分けする。又、走行領域A2を、走行領域A2における長辺側の両端部に設定される非作業領域A2aと、それらの非作業領域A2aの間に設定される作業領域A2bとに区分けする。
 次に、目標経路生成部51Dは、図4~5に示す前述したオフセット量D、作業幅W、オーバーラップ量Woなどに基づいて、作業領域A2bに、オフセットモア3の作業中心線Lが作業地Aの短辺に沿う方向に一定の配置間隔S1をあけて並列に配置されるように、所定の配置間隔S2,S3をあけて並列に配置される複数の作業経路P1を生成する。又、各非作業領域A2aに、複数の作業経路P1を走行順に接続する複数の方向転換経路P2を生成する。
 これにより、目標経路生成部51Dは、作業地Aの形状や大きさ、及び、トラクタ1に装備される作業装置の作業幅Wや作業幅Wのオーバーラップ量Woなどを考慮した目標経路Pを生成する。
 ちなみに、図4は、トラクタ1に対するオフセットモア3のオフセット量Dを最小に設定した状態を示し、図5は、トラクタ1に対するオフセットモア3のオフセット量Dを最大に設定した状態を示している。
 図2に示す作業地Aにおいて、マージン領域A1は、トラクタ1が走行領域A2の外周部を自動走行するときに、オフセットモア3などが作業地Aに隣接する柵などの他物に接触することを防止するために、作業地Aの外周縁と走行領域A2との間に確保された領域である。各非作業領域A2aは、トラクタ1が作業地Aの端部において現在の作業経路P1から次の作業経路P1に移動するための方向転換領域である。
 図2に示す目標経路Pにおいて、各作業経路P1の始端地点p3は、トラクタ1が草刈り作業を開始する作業開始地点であり、各作業経路P1の終端地点p4は、トラクタ1が草刈り作業を停止する作業停止地点である。各作業経路P1の終端地点p4のうちの方向転換経路P2との接続地点は、トラクタ1が次の作業経路P1に移動するための方向転換開始地点であり、各作業経路P1の始端地点p3のうちの方向転換経路P2との接続地点は、トラクタ1が次の作業経路P1への移動を終えた方向転換終了地点である。そして、方向転換経路P2は、トラクタ1が草刈り作業を停止する非作業経路である。
 なお、図2に示す目標経路Pはあくまでも一例であり、目標経路生成部51Dは、トラクタ1に装備される作業装置の種類や作業幅Wなどに応じて異なる車体情報、及び、作業地Aに応じて異なる作業地Aの形状や大きさなどの作業地情報、などに基づいて、それらを考慮した種々の目標経路Pを生成することができる。
 特に、本実施形態に例示した目標経路Pおいては、トラクタ1に装備される作業装置として、トラクタ1の左右中心と作業幅Wの左右中心との間にオフセット量Dを有するオフセットモア3を例示したことにより、オフセットモア3の作業中心線Lの配置間隔S1と目標経路Pにおける作業経路P1の配置間隔S2,S3とが異なっているが、トラクタ1の左右中心と作業幅Wの左右中心とが一致する作業装置(例えばロータリ耕耘装置など)がトラクタ1に装備された場合は、トラクタ1の左右中心と作業幅Wの左右中心との間のオフセット量Dが零になることから、作業装置の作業中心線Lの配置間隔S1と目標経路Pにおける作業経路P1の配置間隔S2,S3とが同じになる。
 目標経路Pは、車体情報や作業地情報などに関連付けされた状態で端末記憶部51Eに記憶されており、携帯通信端末5の表示デバイス50にて表示することができる。目標経路Pには、各並列経路P3におけるトラクタ1の目標車速、各旋回経路P2bにおけるトラクタ1の目標車速、各作業経路P1における前輪操舵角、及び、各旋回経路P2bにおける前輪操舵角、などが含まれている。
 端末制御ユニット51は、車載制御ユニット23からの送信要求指令に応じて、端末記憶部51Eに記憶されている作業地情報や目標経路Pなどを車載制御ユニット23に送信する。車載制御ユニット23は、受信した作業地情報や目標経路Pなどを車載記憶部23Gに記憶する。目標経路Pの送信に関しては、例えば、端末制御ユニット51が、トラクタ1が自動走行を開始する前の段階において、目標経路Pの全てを端末記憶部51Eから車載制御ユニット23に一挙に送信するようにしてもよい。又、端末制御ユニット51が、目標経路Pを所定距離ごとの複数の分割経路情報に分割して、トラクタ1が自動走行を開始する前の段階からトラクタ1の走行距離が所定距離に達するごとに、トラクタ1の走行順位に応じた所定数の分割経路情報を端末記憶部51Eから車載制御ユニット23に逐次送信するようにしてもよい。
 車載制御ユニット23において、自動走行制御部23Fには、車両状態検出機器22に含まれた各種のセンサやスイッチなどからの検出情報が、車速制御部23Bやステアリング制御部23Cなどを介して入力されている。これにより、自動走行制御部23Fは、トラクタ1における各種の設定状態や各部の動作状態などを監視することができる。
 自動走行制御部23Fは、搭乗者や管理者などのユーザにより、各種の自動走行開始条件を満たすための手動操作が行われてトラクタ1の走行モードが自動走行モードに切り換えられた状態において、携帯通信端末5の表示デバイス50が操作されて自動走行の開始が指令された場合に、測位ユニット30にてトラクタ1の現在位置や現在方位などを取得しながら目標経路Pに従ってトラクタ1を自動走行させる自動走行制御を開始する。
 自動走行制御部23Fは、自動走行制御の実行中に、例えば、ユーザにより携帯通信端末5の表示デバイス50が操作されて自動走行の終了が指令された場合や、運転部12に搭乗しているユーザによってステアリングホイール25やアクセルペダルなどの手動操作具が操作された場合は、自動走行制御を終了するとともに走行モードを自動走行モードから手動走行モードに切り換える。このように自動走行制御が終了された後に自動走行制御を再開させる場合は、先ず、ユーザが運転部12に乗り込んで、トラクタ1の走行モードを自動走行モードから手動走行モードに切り換える。次に、各種の自動走行開始条件を満たすための手動操作を行ってから、トラクタ1の走行モードを手動走行モードから自動走行モードに切り換える。そして、この状態において、携帯通信端末5の表示デバイス50を操作して自動走行の開始を指令することで、自動走行制御を再開させることができる。
 自動走行制御部23Fによる自動走行制御には、エンジン14に関する自動走行用の制御指令をエンジン制御部23Aに送信するエンジン用自動制御処理、トラクタ1の車速や前後進の切り換えに関する自動走行用の制御指令を車速制御部23Bに送信する車速用自動制御処理、ステアリングに関する自動走行用の制御指令をステアリング制御部23Cに送信するステアリング用自動制御処理、及び、オフセットモア3などの作業装置に関する自動走行用の制御指令を作業装置制御部23Dに送信する作業用自動制御処理、などが含まれている。
 自動走行制御部23Fは、エンジン用自動制御処理においては、目標経路Pに含まれた設定回転数などに基づいてエンジン回転数の変更を指示するエンジン回転数変更指令、などをエンジン制御部23Aに送信する。エンジン制御部23Aは、自動走行制御部23Fから送信されたエンジン14に関する各種の制御指令に応じてエンジン回転数を自動で変更するエンジン回転数変更制御、などを実行する。
 自動走行制御部23Fは、車速用自動制御処理においては、目標経路Pに含まれた目標車速に基づいて無段変速装置の変速操作を指示する変速操作指令、及び、目標経路Pに含まれたトラクタ1の進行方向などに基づいて前後進切換装置の前後進切り換え操作を指示する前後進切り換え指令、などを車速制御部23Bに送信する。車速制御部23Bは、自動走行制御部23Fから送信された無段変速装置や前後進切換装置などに関する各種の制御指令に応じて、無段変速装置の作動を自動で制御する自動車速制御、及び、前後進切換装置の作動を自動で制御する自動前後進切り換え制御、などを実行する。自動車速制御には、例えば、目標経路Pに含まれた目標車速が零速である場合に、無段変速装置を零速状態まで減速制御してトラクタ1の走行を停止させる自動減速停止処理などが含まれている。
 自動走行制御部23Fは、ステアリング用自動制御処理においては、目標経路Pに含まれた前輪操舵角などに基づいて左右の前輪10の操舵を指示する操舵指令、などをステアリング制御部23Cに送信する。ステアリング制御部23Cは、自動走行制御部23Fから送信された操舵指令に応じて、パワーステアリングユニット17の作動を制御して左右の前輪10を操舵する自動操舵制御、及び、左右の前輪10が設定角度以上に操舵された場合に、ブレーキユニット18を作動させて旋回内側のブレーキを作動させる自動ブレーキ旋回制御、などを実行する。
 自動走行制御部23Fは、作業用自動制御処理においては、目標経路Pに含まれた作業開始地点p3に基づいてオフセットモア3の作業状態への切り換えを指示する作業開始指令、及び、目標経路Pに含まれた作業停止地点p4に基づいてオフセットモア3の非作業状態への切り換えを指示する作業停止指令、などを作業装置制御部23Dに送信する。作業装置制御部23Dは、自動走行制御部23Fから送信されたオフセットモア3に関する各種の制御指令に応じて、作業クラッチユニット19と昇降駆動ユニット20の作動を制御して、オフセットモア3を作業高さまで下降させて作動させる自動作業開始制御、及び、オフセットモア3を停止させて非作業高さまで上昇させる自動作業停止制御、などを実行する。
 つまり、前述した自動走行ユニット4には、パワーステアリングユニット17、ブレーキユニット18、作業クラッチユニット19、昇降駆動ユニット20、ローリングユニット21、車両状態検出機器22、車載制御ユニット23、測位ユニット30、及び、通信モジュール34、などが含まれている。そして、これらが適正に作動することにより、トラクタ1を目標経路Pに従って精度よく自動走行させることができる。
 ところで、目標経路生成部51Dが生成する目標経路Pは、前述したように、作業地Aの形状や大きさ、及び、トラクタ1に装備される作業装置の作業幅Wや作業幅Wのオーバーラップ量Woなどが考慮されている。そのため、目標経路Pが形成された段階においては、図4~5に示すように、隣接する作業経路P1の間に一定のオーバーラップ量Woが確保されるように、オフセットモア3の作業中心線Lの配置間隔S1と目標経路Pにおける作業経路P1の配置間隔S2,S3(図2参照)とが設定されている。
 しかしながら、目標経路生成部51Dが生成する目標経路Pは、衛星測位システムを利用して測定したトラクタ1の現在位置(緯度、経度)に基づいて二次元で生成されたものであり、作業地Aにおける作業面(地面)の傾斜は考慮されていない。そのため、実際にトラクタ1を目標経路Pに従って自動走行させた場合には、オフセットモア3が作業地Aにおける作業面の傾斜に応じてロール方向に揺動することにより、図6~7に示すように、そのときのオフセットモア3のロール角θが大きいほど、目標経路Pの生成時には一定とされていたオフセットモア3の作業幅Wに対して、オフセットモア3の平面視作業幅Wpが狭くなる。その結果、図4~5に示す目標経路Pの生成時に設定されていたオーバーラップ量Woを、実走行時には図7に示すように殆ど確保することができない不具合が生じることになる。
 そこで、作業地情報取得部51Cは、国土地理院から提供されているメッシュ標高情報(5m四方又は10m四方の標高情報)、又は、ドローンなどを利用して計測した三次元地形情報、などの作業地Aの所定区間(例えば5m四方)ごとの高度情報が内挿された三次元の地形情報を、CD-ROMなどの記録媒体やインターネットなどの通信網を介して取得するように構成されている。そして、図3に示すように、端末制御ユニット51には、作業地情報取得部51Cが取得した三次元の地形情報に基づいて目標経路Pを補正する目標経路補正制御を実行する目標経路補正部51Fが備えられている。
 以下、図10に示すフローチャートに基づいて、目標経路補正制御における目標経路補正部51Fの制御作動について説明する。
 目標経路補正部51Fは、先ず、目標経路生成部51Dが生成した目標経路Pを取得する目標経路取得処理を行い(ステップ#1)、作業地情報取得部51Cが取得した三次元の地形情報を取得する三次元地形情報取得処理を行う(ステップ#2)。
 次に、取得した三次元の地形情報に内挿されている作業地Aの所定区間ごとの高度情報を二次元の目標経路Pに割り当てる高度情報割り当て処理を行い(ステップ#3)、所定区間ごとの高度情報が割り当てられた目標経路Pから所定区間ごとの作業面における車体ロール方向の勾配(傾斜情報)を求める勾配算出処理を行う(ステップ#4)。
 そして、求めた所定区間ごとの作業面における車体ロール方向の勾配に基づいて、所定区間ごとのオフセットモア3の平面視作業幅Wpを求める作業幅算出処理を行い(ステップ#5)、求めた所定区間ごとの平面視作業幅Wpに基づいて、前述したオーバーラップ量Woが設定値(例えば10cm)以上になるように、オフセットモア3の作業中心線Lの配置間隔S1(図2、図4~5、図7~9参照)とともに目標経路Pにおける各作業経路P1の配置間隔S2,S3(図2、図7~9参照)を狭くする経路間隔補正処理を行う(ステップ#6)。
 これにより、目標経路生成部51Dが生成した目標経路Pを、作業地Aにおける所定区間ごとの作業面の傾斜が考慮されて、図8~9に示すように、実走行時に設定値以上のオーバーラップ量Woを確保することができる適正な目標経路Pに補正することができる。その結果、図9に示すように、隣接する作業経路P1の間において未刈り領域が生じる虞を回避することができる。
〔別実施形態〕
 本発明の別実施形態について説明する。
 なお、以下に説明する各別実施形態の構成は、それぞれ単独で適用することに限らず、他の別実施形態の構成と組み合わせて適用することも可能である。
(1)作業車両1の構成は種々の変更が可能である。
 例えば、作業車両1は、左右の後輪11に代えて左右のクローラを備えるセミクローラ仕様に構成されていてもよい。
 例えば、作業車両1は、左右の前輪10及び左右の後輪11に代えて左右のクローラを備えるフルクローラ仕様に構成されていてもよい。
 例えば、作業車両1は、左右の後輪11が操舵輪として機能する後輪ステアリング仕様に構成されていてもよい。
 例えば、作業車両1は、エンジン14の代わりに走行用の電動モータを備える電動仕様に構成されていてもよい。
 例えば、作業車両1は、エンジン14と走行用の電動モータとを備えるハイブリッド仕様に構成されていてもよい。
(2)車体情報取得部51B、作業地情報取得部51C、目標経路生成部51D、及び、目標経路補正部51Fは、車載制御ユニット23に備えられていてもよい。
(3)目標経路補正部51Fは、トラクタ1の自動走行ユニット4及び携帯通信端末5とインターネットなどの通信網を介して通信可能に接続された例えば管理センタの管理用コンピュータなどに備えられていてもよい。
 この場合、携帯通信端末5の目標経路生成部51Dが生成した目標経路P、及び、目標経路Pの生成に使用した車体情報や作業地情報などを管理用コンピュータなどにバックアップしたときに、処理能力の高い管理用コンピュータなどにおいて、目標経路生成部51Dが生成した目標経路Pを目標経路補正部51Fによって補正することができる。
(4)車体情報取得部51B、作業地情報取得部51C、目標経路生成部51D、及び、目標経路補正部51Fは、トラクタ1の自動走行ユニット4及び携帯通信端末5とインターネットなどの通信網を介して通信可能に接続された管理センタの管理用コンピュータなどに備えられていてもよい。
 この場合、処理能力の高い管理用コンピュータなどにおいて、目標経路Pの生成から目標経路Pの補正までを一連で行うことができる。
(5)目標経路補正部51Fは、例えば、前述した車体情報と目標経路Pと車体ロール方向の傾斜情報とに基づいて、作業車両1を目標経路Pに従って模擬的に走行させた上で、実走行時に設定値以上のオーバーラップ量Woを確保することができるように、目標経路Pにおける作業経路P1の配置間隔S2,S3を補正する3次元シミュレータであってもよい。
 このように、目標経路補正部51Fとして3次元シミュレータを採用すれば、補正後の目標経路に従って作業車両を自動走行させた場合に、隣接する作業経路間に未作業領域が形成される虞をより確実に回避することができる。
 又、この3次元シミュレータに、車体情報取得部51B、作業地情報取得部51C、及び、目標経路生成部51Dが備えられて、3次元シミュレータが、目標経路Pの生成から目標経路Pの補正までを一連で行うように構成されてもよい。
(6)目標経路補正部51Fは、例えば、実走行時に、作業装置3のロール角を検出するロール角検出器からの検出情報を取得し、取得した作業装置3のロール角に基づいて、補正後の目標経路Pを更に補正するように構成されていてもよい。
 その一例として、目標経路補正部51Fは、先ず、作業経路P1での実走行中に所定区間ごとの作業装置3のロール角を取得する。次に、取得した所定区間ごとの作業装置3のロール角と、実走行前の目標経路Pの補正段階で求めた同じ作業経路P1での所定区間ごとの作業面における車体ロール方向の勾配(傾斜情報)とを比較する。そして、その差が、実走行前の目標経路Pの補正段階で求めた次の作業経路P1での所定区間ごとの作業面における車体ロール方向の勾配(傾斜情報)との関係から、実走行中の作業経路P1と次の作業経路P1との間に設定値以上のオーバーラップ量Woを確保することが可能な値か否かを判定する。この判定において、設定値以上のオーバーラップ量Woを確保することが不可能と判定した場合に、実走行中の作業経路P1と次の作業経路P1との間隔を、設定値以上のオーバーラップ量Woを確保することが可能な狭い間隔に補正する。
 このような補正を行うことにより、実走行前に補正した目標経路Pを、実際の作業地Aにおける所定区間ごとの作業面の傾斜が考慮されたより適正な目標経路Pに補正することができる。その結果、隣接する作業経路P1の間において未作業領域が生じる虞を回避することができる。
(7)作業地情報取得部51Cが取得する作業地Aの所定区間ごとの地形情報(車体ロール方向の傾斜情報)は、例えば、作業車両1が以前に同じ作業地Aにおいて同じ目標経路Pに従って走行したときに、作業装置3に備えられたロール角検出器が検出した作業装置3のロール角に基づくものであってもよい。
 本発明に係る作業車両用の目標経路生成システムは、例えば、トラクタ、乗用草刈機、コンバイン、乗用田植機、乗用播種機、除雪車、ホイールローダ、などの乗用作業車両、及び、無人草刈機などの無人作業車両に適用することができる。
1   作業車両
3   作業装置
51C 作業地情報取得部
51D 目標経路生成部
51F 目標経路補正部
A   作業地
P   目標経路
P1  作業経路
S2  作業経路の配置間隔
S3  作業経路の配置間隔
W   作業幅
Wo  オーバーラップ量
Wp  平面視作業幅

 

Claims (4)

  1.  作業地の所定区間ごとの地形情報を含む作業地情報を取得する作業地情報取得部と、
     作業車両に装備された作業装置の作業幅に応じて並列に並ぶ複数の作業経路を含む自動走行用の目標経路を生成する目標経路生成部と、
     前記地形情報のうちの車体ロール方向の傾斜情報に基づいて前記作業経路の配置間隔を補正する目標経路補正部と、を有している作業車両用の目標経路生成システム。
  2.  前記作業地情報取得部は、前記所定区間ごとの高度情報が内挿された三次元の地形情報を取得し、
     前記目標経路補正部は、前記目標経路に前記所定区間ごとの高度情報を割り当てて、前記所定区間ごとの前記車体ロール方向の傾斜情報を取得する請求項1に記載の作業車両用の目標経路生成システム。
  3.  前記目標経路補正部は、前記目標経路と前記車体ロール方向の傾斜情報とに基づいて、前記作業車両を前記目標経路に従って模擬的に走行させた上で前記作業経路の配置間隔を補正する3次元シミュレータである請求項1又は2に記載の作業車両用の目標経路生成システム。
  4.  前記目標経路補正部は、前記車体ロール方向の傾斜情報に基づいて前記作業経路における前記所定区間ごとの平面視作業幅を求め、求めた前記平面視作業幅に基づいて、隣接する前記作業経路における前記所定区間ごとの前記平面視作業幅のオーバーラップ量が設定値以上になるように前記作業経路の配置間隔を補正する請求項1~3のいずれか一項に記載の作業車両用の目標経路生成システム。

     
PCT/JP2019/051473 2019-02-01 2019-12-27 作業車両用の目標経路生成システム WO2020158295A1 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2019016874A JP2020126307A (ja) 2019-02-01 2019-02-01 作業車両用の目標経路生成システム
JP2019-016874 2019-02-01

Publications (1)

Publication Number Publication Date
WO2020158295A1 true WO2020158295A1 (ja) 2020-08-06

Family

ID=71840305

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2019/051473 WO2020158295A1 (ja) 2019-02-01 2019-12-27 作業車両用の目標経路生成システム

Country Status (2)

Country Link
JP (1) JP2020126307A (ja)
WO (1) WO2020158295A1 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114600622A (zh) * 2022-03-14 2022-06-10 未岚大陆(北京)科技有限公司 行进路径规划方法、控制装置、割草机、自移动系统
CN115511916A (zh) * 2022-10-10 2022-12-23 未岚大陆(北京)科技有限公司 智能作业设备控制方法、装置、设备、介质及程序产品

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09128045A (ja) * 1995-11-02 1997-05-16 Hitachi Ltd 自動走行機械の経路生成方式
JPH10243708A (ja) * 1997-03-03 1998-09-14 Kubota Corp 作業車の走行経路作成装置及び走行制御装置
JP2017182373A (ja) * 2016-03-30 2017-10-05 ヤンマー株式会社 経路生成装置

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003308121A (ja) * 2002-04-18 2003-10-31 Mitsubishi Agricult Mach Co Ltd 作業用走行車
WO2016009688A1 (ja) * 2014-07-16 2016-01-21 株式会社リコー システム、機械、制御方法、プログラム
JP6663366B2 (ja) * 2017-01-27 2020-03-11 ヤンマー株式会社 経路生成システム、及びそれによって生成された経路に沿って作業車両を走行させる自律走行システム
JP2018169826A (ja) * 2017-03-30 2018-11-01 ヤンマー株式会社 農用作業車両

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09128045A (ja) * 1995-11-02 1997-05-16 Hitachi Ltd 自動走行機械の経路生成方式
JPH10243708A (ja) * 1997-03-03 1998-09-14 Kubota Corp 作業車の走行経路作成装置及び走行制御装置
JP2017182373A (ja) * 2016-03-30 2017-10-05 ヤンマー株式会社 経路生成装置

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114600622A (zh) * 2022-03-14 2022-06-10 未岚大陆(北京)科技有限公司 行进路径规划方法、控制装置、割草机、自移动系统
CN115511916A (zh) * 2022-10-10 2022-12-23 未岚大陆(北京)科技有限公司 智能作业设备控制方法、装置、设备、介质及程序产品
WO2024078499A1 (en) * 2022-10-10 2024-04-18 Willand (Beijing) Technology Co., Ltd. Control method and apparatus for intelligent operation device, device, medium and program product

Also Published As

Publication number Publication date
JP2020126307A (ja) 2020-08-20

Similar Documents

Publication Publication Date Title
CN111580529B (zh) 作业系统
US20220110239A1 (en) Traveling Route Setting Device
WO2020039782A1 (ja) 作業車両用の自動走行システム
JP7384950B2 (ja) 自動走行システム
WO2018163615A1 (ja) 経路生成システム
WO2021100373A1 (ja) 作業車両用の自動走行システム
CN113544613A (zh) 路径生成系统
WO2020235470A1 (ja) 自動走行システム
JP6986430B2 (ja) 走行経路設定装置
WO2020158295A1 (ja) 作業車両用の目標経路生成システム
JP2024053067A (ja) 自動走行システム及び自動走行方法
TW202045384A (zh) 自動行駛系統
JP2022188155A (ja) 作業車両用の自動走行システム
JP7223552B2 (ja) 表示装置、及び、自動走行システム
JP7246918B2 (ja) 走行状態表示装置、及び、自動走行システム
JP7247240B2 (ja) 作業車両用の自動走行システム
JP7329645B2 (ja) 作業支援システム
JP7094833B2 (ja) 走行経路表示装置
JP7229119B2 (ja) 自動走行システム
JP7316198B2 (ja) 作業車両用の自動走行システム
JP7438718B2 (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: 19913215

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: 19913215

Country of ref document: EP

Kind code of ref document: A1