[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

WO2024004486A1 - 作業車両、制御方法および制御システム - Google Patents

作業車両、制御方法および制御システム Download PDF

Info

Publication number
WO2024004486A1
WO2024004486A1 PCT/JP2023/019973 JP2023019973W WO2024004486A1 WO 2024004486 A1 WO2024004486 A1 WO 2024004486A1 JP 2023019973 W JP2023019973 W JP 2023019973W WO 2024004486 A1 WO2024004486 A1 WO 2024004486A1
Authority
WO
WIPO (PCT)
Prior art keywords
work vehicle
influence
degree
control device
implement
Prior art date
Application number
PCT/JP2023/019973
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 WO2024004486A1 publication Critical patent/WO2024004486A1/ja

Links

Images

Classifications

    • A—HUMAN NECESSITIES
    • A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01B—SOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B69/00—Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track

Definitions

  • the present disclosure relates to a work vehicle that operates automatically, a method for controlling a work vehicle that operates automatically, and a control system for a work vehicle that operates automatically.
  • Patent Document 1 discloses a system for automatically driving an unmanned work vehicle between two fields separated from each other across a road.
  • Patent Document 2 discloses a work vehicle in which automatic driving is controlled based on the state of the road on which the work vehicle travels and the state of an implement connected to the work vehicle.
  • JP2021-029218A International Publication No. 2022/038860
  • the present disclosure provides a work vehicle that can efficiently run an autonomously driven work vehicle, a method for controlling an autonomously driven work vehicle to run efficiently, and an efficient way to run an autonomously driven work vehicle.
  • a control system that can control the operations performed.
  • a work vehicle is a work vehicle that performs automatic driving, and includes one or more sensors that sense the environment around the work vehicle and output sensor data, and a
  • the control device includes a control device that controls the automatic operation of the work vehicle, and a connection device that connects the implement, and the control device controls the automatic operation in a state where the implement is connected to the work vehicle.
  • a second degree of influence indicating the magnitude of the influence when the object is brought into contact with the object is determined according to the classification result of the object, and contact with the object is determined according to at least one of the first degree of influence and the second degree of influence. Either an action to avoid or an action to continue the automatic driving without performing the action to avoid is performed.
  • a control method is a control method for a work vehicle that performs automatic driving, in which object detection and classification are performed based on sensor data output from one or more sensors included in the work vehicle.
  • a first degree of influence indicating the magnitude of influence when the object comes into contact with the work vehicle; and a first degree of influence indicating the magnitude of influence when the object comes into contact with an implement connected to the work vehicle.
  • a control method including performing one of the operations of continuing automatic operation without performing any operation.
  • a control system is a control system for a work vehicle that performs automatic driving, and includes one or more sensors that sense the environment around the work vehicle and output sensor data, and the sensor a control device that controls the automatic operation of the work vehicle based on data, and when the work vehicle performs the automatic operation with an implement connected to the work vehicle, Detection and classification of an object is performed based on the sensor data, and a first influence degree indicating the magnitude of influence when the object contacts the work vehicle, and a first influence degree indicating the magnitude of influence when the object contacts the implement.
  • Computer-readable storage media may include volatile storage media or non-volatile storage media.
  • the device may be composed of multiple devices. When a device is composed of two or more devices, the two or more devices may be arranged within one device, or may be arranged separately within two or more separate devices. .
  • a work vehicle that can efficiently drive an autonomous vehicle, a method for controlling an autonomous vehicle to efficiently travel, and a method for controlling an autonomous vehicle to efficiently travel.
  • a control system is provided that can control driving to be performed efficiently.
  • FIG. 1 is a diagram for explaining an overview of an agricultural management system according to an exemplary embodiment of the present disclosure.
  • FIG. 1 is a side view schematically showing an example of a work vehicle and an implement connected to the work vehicle.
  • FIG. 2 is a block diagram showing an example of the configuration of a work vehicle and an implement.
  • FIG. 2 is a conceptual diagram showing an example of a work vehicle that performs positioning using RTK-GNSS.
  • FIG. 3 is a diagram showing an example of an operation terminal and a group of operation switches provided inside the cabin.
  • FIG. 2 is a block diagram illustrating the hardware configuration of a management device and a terminal device.
  • FIG. 2 is a diagram schematically showing an example of a work vehicle that automatically travels along a target route in a field.
  • FIG. 3 is a diagram showing an example of a work vehicle traveling along a target route P.
  • FIG. 3 is a diagram showing an example of a work vehicle in a position shifted to the right from a target route P.
  • FIG. 2 is a diagram showing an example of a work vehicle in a position shifted to the left from a target route P.
  • FIG. 3 is a diagram showing an example of a work vehicle facing in a direction inclined with respect to a target route P.
  • FIG. FIG. 2 is a diagram schematically showing an example of a situation in which a plurality of work vehicles are automatically traveling on roads inside and outside a field.
  • FIG. 3 is a diagram illustrating an example of a global route and a local route generated in an environment where obstacles exist.
  • 3 is a flowchart showing a route planning and travel control method.
  • 2 is a flowchart illustrating an example of a procedure for a work vehicle to perform an obstacle avoidance operation.
  • FIG. 2 is a diagram schematically showing an example of a region that can be sensed by a LiDAR sensor included in a work vehicle.
  • FIG. 3 is a diagram schematically showing an example of an area that can be sensed by a camera included in a work vehicle. It is a figure which shows the example of the table which is memorize
  • FIG. 2 is a flowchart illustrating an example of a procedure for a work vehicle to perform an obstacle avoidance operation.
  • FIG. 3 is a schematic diagram illustrating a method for determining whether a detected object comes into contact with a work vehicle and an implement.
  • FIG. 3 is a schematic diagram illustrating a method for determining whether a detected object comes into contact with a work vehicle and an implement.
  • agricultural machinery refers to machinery used in agricultural applications.
  • Examples of agricultural machinery include tractors, harvesters, rice transplanters, riding management machines, vegetable transplanters, mowers, seeders, fertilizer spreaders, and agricultural mobile robots.
  • a work vehicle such as a tractor function as an "agricultural machine” alone, but also the implement attached to or towed by the work vehicle and the work vehicle as a whole function as a single "agricultural machine.”
  • Agricultural machines perform agricultural work such as plowing, sowing, pest control, fertilization, planting crops, or harvesting on the ground within a field. These agricultural works are sometimes referred to as “ground work” or simply “work.”
  • the movement of a vehicle-type agricultural machine while performing agricultural work is sometimes referred to as "work driving.”
  • Automatic operation means that the movement of agricultural machinery is controlled by the function of a control device, without manual operation by a driver.
  • Agricultural machinery that operates automatically is sometimes called “self-driving agricultural machinery” or “robotic agricultural machinery.”
  • self-driving agricultural machinery or “robotic agricultural machinery.”
  • the control device can control at least one of steering necessary for movement of the agricultural machine, adjustment of movement speed, start and stop of movement.
  • the control device may control operations such as raising and lowering the work implement, starting and stopping the operation of the work implement, and the like.
  • Movement by automatic driving may include not only movement of the agricultural machine toward a destination along a predetermined route, but also movement of the agricultural machine to follow a tracking target.
  • a self-driving agricultural machine may move partially based on user instructions.
  • agricultural machinery that performs automatic driving may operate in a manual driving mode in which the agricultural machine moves by manual operation by a driver.
  • the act of steering agricultural machinery by means of a control device, rather than manually, is called "automatic steering.”
  • Part or all of the control device may be external to the agricultural machine. Communication such as control signals, commands, or data may occur between a control device external to the agricultural machine and the agricultural machine.
  • Agricultural machines that operate automatically may move autonomously while sensing the surrounding environment, without humans being involved in controlling the movement of the agricultural machines.
  • Agricultural machinery capable of autonomous movement can run unmanned within a field or outside the field (for example, on a road). Obstacle detection and obstacle avoidance operations may be performed during autonomous movement.
  • Work plan is data that defines a schedule for one or more agricultural tasks to be performed by agricultural machinery.
  • the work plan may include, for example, information indicating the order of agricultural operations to be performed by agricultural machinery and the fields in which each agricultural operation is performed.
  • the work plan may include information on the days and times each agricultural work is scheduled to be performed.
  • a work plan that includes information on the scheduled days and times for each agricultural work is particularly referred to as a "work schedule" or simply a "schedule.”
  • the work schedule may include information on the scheduled start time and/or scheduled end time of each agricultural task to be performed on each working day.
  • the work plan or work schedule may include information such as the content of the work, the implements to be used, and/or the type and amount of agricultural materials to be used for each agricultural work.
  • the management device may create a work plan that includes information regarding each agricultural work performed by each of the plurality of agricultural machines.
  • the work plan may be downloaded by each farm machine and stored in storage.
  • Each agricultural machine can automatically head to the field and perform the scheduled agricultural work according to the work plan.
  • Environmental map is data that expresses the positions or areas of objects in the environment in which agricultural machinery moves using a predetermined coordinate system.
  • Environmental maps are sometimes simply referred to as "maps" or “map data.”
  • the coordinate system defining the environmental map may be, for example, a world coordinate system, such as a geographic coordinate system fixed relative to the earth.
  • the environmental map may include information other than location (for example, attribute information and other information) about objects existing in the environment.
  • Environmental maps include maps in various formats, such as point cloud maps or grid maps. Local map or partial map data generated or processed in the process of constructing an environmental map is also referred to as a "map" or "map data.”
  • “Rural road” means a road primarily used for agricultural purposes.
  • a farm road is not limited to a road paved with asphalt, but also includes an unpaved road covered with dirt or gravel.
  • Farm roads include roads (including private roads) that are exclusively traversable by vehicle-type agricultural machinery (for example, work vehicles such as tractors), and roads that are also traversable by general vehicles (passenger cars, trucks, buses, etc.). The work vehicle may automatically travel on general roads in addition to farm roads.
  • a general road is a road maintained for general vehicle traffic.
  • “Local feature” means something that exists on the ground. Examples of features include waterways, grass, trees, roads, fields, ditches, rivers, bridges, forests, mountains, rocks, buildings, railroad tracks, and the like. Things that do not exist in the real world, such as boundary lines, place names, building names, field names, and route names, are not included in the "features" in this disclosure.
  • GNSS satellite means an artificial satellite in the Global Navigation Satellite System (GNSS).
  • GNSS Global Navigation Satellite System
  • GNSS is a general term for satellite positioning systems such as GPS (Global Positioning System), QZSS (Quasi-Zenith Satellite System), GLONASS, Galileo, and BeiDou.
  • GNSS satellites are satellites in these positioning systems. Signals transmitted from GNSS satellites are referred to as "satellite signals.”
  • a “GNSS receiver” is a device that receives radio waves transmitted from a plurality of GNSS satellites and performs positioning based on signals superimposed on the radio waves.
  • GNSS data is data output from a GNSS receiver.
  • GNSS data may be generated in a predetermined format, such as NMEA-0183 format.
  • the GNSS data may include, for example, information indicating the reception status of satellite signals received from individual satellites.
  • the GNSS data may include values indicating the identification number, elevation, azimuth, and reception strength of each satellite from which the satellite signal was received.
  • the reception strength is a numerical value indicating the strength of the received satellite signal.
  • the reception strength can be expressed, for example, as a value such as carrier to noise power density ratio (C/N0).
  • the GNSS data may include position information of a GNSS receiver or agricultural machine calculated based on multiple received satellite signals. Location information can be expressed, for example, by latitude, longitude, height from mean sea level, and the like.
  • the GNSS data may further include information indicating the reliability of the location information.
  • “Can receive satellite signals normally” means that satellite signals can be received stably to the extent that the reliability of positioning does not decrease significantly.
  • the inability to receive satellite signals normally is sometimes expressed as a "satellite signal reception failure.”
  • “Satellite signal reception failure” is a state in which the reliability of positioning has decreased compared to normal times due to deterioration in the reception status of satellite signals.
  • Reception interference may occur, for example, when the number of detected satellites is small (for example, 3 or less), when the reception strength of each satellite signal is low, or when multipath occurs. Whether or not reception interference is occurring can be determined based on, for example, information regarding satellites included in GNSS data. For example, the presence or absence of reception interference can be determined based on the value of reception strength for each satellite included in the GNSS data, or the value of DOP (Dilution of Precision) indicating the placement status of satellites.
  • DOP Deution of Precision
  • Global path means data on a route that is generated by a processing device that performs route planning and connects a starting point to a destination point when agricultural machinery moves automatically. Generating a global route is called global path planning or global route design. In the following description, the global route is also referred to as a "target route” or simply a "route.”
  • a global route can be defined, for example, by coordinate values of a plurality of points through which the agricultural machine should pass. A point through which agricultural machinery should pass is called a "waypoint,” and a line segment connecting adjacent waypoints is called a "link.”
  • Local path means a local path that can avoid obstacles and is sequentially generated when agricultural machinery automatically moves along a global path. Generating a local route is called local path planning or local route design. The local routes are sequentially generated based on data acquired by one or more sensing devices included in the agricultural machine while the agricultural machine is moving. A local route may be defined by multiple waypoints along a portion of the global route. However, if an obstacle exists near the global route, a waypoint may be set to detour around the obstacle. The length of links between waypoints in a local path is shorter than the length of links between waypoints in a global path. The device that generates the local route may be the same as the device that generates the global route, or may be different.
  • a management device that manages agricultural work by agricultural machines may generate a global route, and a control device mounted on the agricultural machine may generate a local route.
  • the combination of the management device and the control device functions as a "processing device" that performs route planning.
  • a control device of an agricultural machine may function as a processing device that performs both global route design and local route design.
  • Storage place is a place established to store agricultural machinery.
  • the storage location may be, for example, a location managed by a user of agricultural machinery or a location jointly operated by multiple users.
  • the storage location may be, for example, a location set aside for the storage of agricultural machinery, such as a warehouse, a barn, or a parking lot at the home or business of a user (such as a farmer).
  • the location of the storage location may be registered in advance and recorded in the storage device.
  • a "standby place” is a place provided for agricultural machinery to wait while it is not performing agricultural work.
  • One or more waiting areas may be provided in the environment in which the agricultural machine operates automatically.
  • the above storage location is an example of a waiting location.
  • the waiting location may be a location jointly managed or used by multiple users.
  • the waiting area may be, for example, a warehouse, garage, barn, parking lot, or other facility.
  • the waiting location may be a warehouse, barn, garage, or parking lot at the home or business of a farmer different from the user of the agricultural machine.
  • a plurality of waiting locations may be scattered throughout the environment in which agricultural machinery moves. Work such as replacing or maintaining parts or implements of agricultural machinery or replenishing materials may be performed at the waiting area. In that case, parts, tools, or materials necessary for those operations may be placed in the waiting area.
  • Computer-readable storage media may include volatile storage media or non-volatile storage media.
  • the device may be composed of multiple devices. When a device is composed of two or more devices, the two or more devices may be arranged within one device, or may be arranged separately within two or more separate devices. .
  • FIG. 1 is a diagram for explaining an overview of an agricultural management system according to an exemplary embodiment of the present disclosure.
  • the agricultural management system shown in FIG. 1 includes a work vehicle 100, a terminal device 400, and a management device 600.
  • Terminal device 400 is a computer used by a user who remotely monitors work vehicle 100.
  • the management device 600 is a computer managed by a business operator that operates an agricultural management system. Work vehicle 100, terminal device 400, and management device 600 can communicate with each other via network 80.
  • the agricultural management system may include a plurality of work vehicles or other agricultural machines.
  • the work vehicle 100 in this embodiment is a tractor.
  • Work vehicle 100 can be equipped with an implement on one or both of the rear and front parts.
  • the work vehicle 100 can travel within a field while performing agricultural work depending on the type of implement.
  • the work vehicle 100 may run inside or outside the field without any implements attached thereto.
  • the work vehicle 100 is equipped with an automatic driving function. In other words, the work vehicle 100 can be driven not manually but by the action of the control device.
  • the control device in this embodiment is provided inside the work vehicle 100 and can control both the speed and steering of the work vehicle 100.
  • the work vehicle 100 can automatically travel not only inside the field but also outside the field (for example, on a road).
  • the work vehicle 100 is equipped with devices used for positioning or self-position estimation, such as a GNSS receiver and a LiDAR sensor.
  • the control device of the work vehicle 100 automatically causes the work vehicle 100 to travel based on the position of the work vehicle 100 and the target route information generated by the management device 600.
  • the control device also controls the operation of the implement.
  • the work vehicle 100 can perform agricultural work using the implement while automatically traveling within the field. Further, the work vehicle 100 can automatically travel along a target route on a road outside the field (for example, a farm road or a general road).
  • the management device 600 generates a route in the field so as to cover, for example, the entire work area where work is performed.
  • the management device 600 generates a target route outside the field according to the work plan or the user's instructions.
  • the management device 600 includes the order of farm work indicated by the work plan, the position of the field where each farm work is performed, the position of the entrance and exit of the field, the scheduled start time and end time of each farm work, and the attributes of each road recorded on the map.
  • a target route outside the field can be generated based on various types of information such as field information, road surface conditions, weather conditions, or traffic conditions.
  • the management device 600 may generate the target route based on information indicating a route or a waypoint specified by the user by operating the terminal device 400, regardless of the work plan.
  • the global route design and the generation (or editing) of the environmental map are not limited to the management device 600, and may be performed by other devices.
  • the control device of work vehicle 100 may perform global route design or generate or edit an environmental map.
  • the terminal device 400 is a computer used by a user located away from the work vehicle 100. Although the terminal device 400 shown in FIG. 1 is a laptop computer, it is not limited to this.
  • the terminal device 400 may be a stationary computer such as a desktop PC (personal computer), or may be a mobile terminal such as a smartphone or a tablet computer.
  • Terminal device 400 may be used to remotely monitor work vehicle 100 or remotely control work vehicle 100.
  • the terminal device 400 can display images captured by one or more cameras (imaging devices) included in the work vehicle 100 on a display. The user can view the video, check the situation around the work vehicle 100, and send an instruction to the work vehicle 100 to stop or start.
  • the terminal device 400 can also display on the display a setting screen for the user to input information necessary for creating a work plan (for example, a schedule for each agricultural work) for the work vehicle 100.
  • a work plan for example, a schedule for each agricultural work
  • the terminal device 400 transmits the input information to the management device 600.
  • Management device 600 creates a work plan based on the information.
  • Terminal device 400 may also be used to register one or more fields where work vehicle 100 performs agricultural work, a storage location for work vehicle 100, and one or more waiting locations where work vehicle 100 temporarily waits.
  • the terminal device 400 may further have a function of displaying a setting screen on the display for the user to input information necessary for setting the target route.
  • FIG. 2 is a side view schematically showing an example of the work vehicle 100 and the work machine 300 connected to the work vehicle 100.
  • Work vehicle 100 in this embodiment can operate in both manual driving mode and automatic driving mode. In the automatic driving mode, the work vehicle 100 can run unmanned.
  • the work vehicle 100 is capable of automatic operation both inside and outside the field.
  • the work vehicle 100 includes a vehicle body 101, a prime mover (engine) 102, and a transmission 103.
  • the vehicle body 101 is provided with wheels 104 with tires and a cabin 105.
  • the wheels 104 include a pair of front wheels 104F and a pair of rear wheels 104R.
  • a driver's seat 107, a steering device 106, an operation terminal 200, and a group of switches for operation are provided inside the cabin 105.
  • one or both of the front wheels 104F and the rear wheels 104R may be replaced with a plurality of wheels (crawlers) equipped with tracks instead of wheels with tires. .
  • the work vehicle 100 includes at least one sensing device that senses the environment around the work vehicle 100.
  • work vehicle 100 includes a plurality of sensing devices.
  • the sensing device includes multiple cameras 120, LiDAR sensors 140, and multiple obstacle sensors 130.
  • the cameras 120 may be provided, for example, on the front, rear, left and right sides of the work vehicle 100. Camera 120 photographs the environment around work vehicle 100 and generates image data. Images acquired by camera 120 may be transmitted to terminal device 400 for remote monitoring. The image may be used to monitor work vehicle 100 during unmanned operation. The camera 120 is also used to generate images for recognizing surrounding features, obstacles, white lines, signs, signs, etc. when the work vehicle 100 travels on a road outside the field (farm road or general road). can be used.
  • the LiDAR sensor 140 in the example of FIG. 2 is arranged at the lower front of the vehicle body 101.
  • LiDAR sensor 140 may be provided at other locations.
  • LiDAR sensor 140 may be provided in the upper part of cabin 105.
  • LiDAR sensor 140 may be a 3D-LiDAR sensor, but may also be a 2D-LiDAR sensor.
  • LiDAR sensor 140 senses the environment around work vehicle 100 and outputs sensing data. While the work vehicle 100 is traveling, the LiDAR sensor 140 collects sensor data indicating the distance and direction to each measurement point of an object in the surrounding environment, or the two-dimensional or three-dimensional coordinate value of each measurement point. Output repeatedly. Sensor data output from LiDAR sensor 140 is processed by the control device of work vehicle 100.
  • the control device can estimate the self-position of the work vehicle 100 by matching the sensor data with the environmental map.
  • the control device can further detect objects such as obstacles that exist around the work vehicle 100 based on the sensor data.
  • the control device can also generate or edit an environmental map using an algorithm such as SLAM (Simultaneous Localization and Mapping).
  • Work vehicle 100 may include a plurality of LiDAR sensors arranged at different positions and in different orientations.
  • a plurality of obstacle sensors 130 shown in FIG. 2 are provided at the front and rear of the cabin 105. Obstacle sensor 130 may also be placed at other locations. For example, one or more obstacle sensors 130 may be provided at arbitrary positions on the side, front, and rear of the vehicle body 101. Obstacle sensor 130 may include, for example, a laser scanner or an ultrasonic sonar. Obstacle sensor 130 is used to detect surrounding obstacles during automatic driving and to stop work vehicle 100 or take a detour. LiDAR sensor 140 may be utilized as one of the obstacle sensors 130.
  • the work vehicle 100 further includes a GNSS unit 110.
  • GNSS unit 110 includes a GNSS receiver.
  • the GNSS receiver may include an antenna that receives signals from GNSS satellites and a processor that calculates the position of work vehicle 100 based on the signals received by the antenna.
  • the GNSS unit 110 receives satellite signals transmitted from a plurality of GNSS satellites, and performs positioning based on the satellite signals.
  • GNSS is a general term for satellite positioning systems such as GPS (Global Positioning System), QZSS (Quasi-Zenith Satellite System, such as Michibiki), GLONASS, Galileo, and BeiDou.
  • GPS Global Positioning System
  • QZSS Quadasi-Zenith Satellite System
  • Galileo Galileo
  • BeiDou BeiDou.
  • the GNSS unit 110 may include an inertial measurement unit (IMU). Signals from the IMU can be used to supplement the position data.
  • the IMU can measure the tilt and minute movements of the work vehicle 100. By using data acquired by the IMU to supplement position data based on satellite signals, positioning performance can be improved.
  • the control device of the work vehicle 100 may use sensing data acquired by a sensing device such as the camera 120 or the LiDAR sensor 140 for positioning.
  • a sensing device such as the camera 120 or the LiDAR sensor 140
  • the data acquired by the camera 120 or the LiDAR sensor 140 and the previously stored can be estimated with high accuracy based on the environmental map stored in the device.
  • the position of work vehicle 100 can be specified with higher accuracy.
  • the prime mover 102 may be, for example, a diesel engine.
  • An electric motor may be used instead of a diesel engine.
  • Transmission device 103 can change the propulsive force and moving speed of work vehicle 100 by shifting. The transmission 103 can also switch the work vehicle 100 between forward movement and reverse movement.
  • the steering device 106 includes a steering wheel, a steering shaft connected to the steering wheel, and a power steering device that assists steering with the steering wheel.
  • the front wheel 104F is a steered wheel, and by changing its turning angle (also referred to as a "steering angle"), the traveling direction of the work vehicle 100 can be changed.
  • the steering angle of the front wheels 104F can be changed by operating the steering wheel.
  • the power steering device includes a hydraulic device or an electric motor that supplies an auxiliary force for changing the steering angle of the front wheels 104F. When automatic steering is performed, the steering angle is automatically adjusted by the power of a hydraulic system or an electric motor under control from a control device disposed within work vehicle 100.
  • a coupling device 108 is provided at the rear of the vehicle body 101.
  • the coupling device 108 includes, for example, a three-point support device (also referred to as a "three-point link” or “three-point hitch"), a PTO (Power Take Off) shaft, a universal joint, and a communication cable.
  • the work implement 300 can be attached to and detached from the work vehicle 100 by the coupling device 108.
  • the coupling device 108 can change the position or posture of the working machine 300 by raising and lowering the three-point link using, for example, a hydraulic device.
  • power can be sent from the work vehicle 100 to the work implement 300 via the universal joint.
  • the work vehicle 100 can cause the work machine 300 to perform a predetermined work while pulling the work machine 300.
  • the coupling device may be provided at the front of the vehicle body 101. In that case, an implement can be connected to the front of the work vehicle 100.
  • the working machine 300 shown in FIG. 2 is a rotary tiller
  • the working machine 300 is not limited to a rotary tiller.
  • any implement such as a seeder, spreader, transplanter, mower, rake, baler, harvester, sprayer, or harrow. It can be used by connecting to the work vehicle 100.
  • the work vehicle 100 shown in FIG. 2 is capable of manned operation, it may also support only unmanned operation. In that case, components necessary only for manned operation, such as the cabin 105, the steering device 106, and the driver's seat 107, may not be provided in the work vehicle 100.
  • the unmanned work vehicle 100 can run autonomously or by remote control by a user.
  • FIG. 3 is a block diagram showing a configuration example of the work vehicle 100 and the work machine 300.
  • Work vehicle 100 and work implement 300 can communicate with each other via a communication cable included in coupling device 108 .
  • Work vehicle 100 can communicate with terminal device 400 and management device 600 via network 80 .
  • the work vehicle 100 in the example of FIG. 3 includes, in addition to a GNSS unit 110, a camera 120, an obstacle sensor 130, a LiDAR sensor 140, and an operation terminal 200, a sensor group 150 that detects the operating state of the work vehicle 100, a control system 160, and a communication It includes a device 190, a group of operation switches 210, a buzzer 220, and a drive device 240. These components are communicatively connected to each other via a bus.
  • the GNSS unit 110 includes a GNSS receiver 111 , an RTK receiver 112 , an inertial measurement unit (IMU) 115 , and a processing circuit 116 .
  • IMU inertial measurement unit
  • Sensor group 150 includes a steering wheel sensor 152, a turning angle sensor 154, and an axle sensor 156.
  • Control system 160 includes a storage device 170 and a control device 180.
  • Control device 180 includes a plurality of electronic control units (ECU) 181 to 186.
  • Work machine 300 includes a drive device 340, a control device 380, and a communication device 390. Note that FIG. 3 shows components that are relatively highly relevant to the automatic driving operation of the work vehicle 100, and illustration of other components is omitted.
  • the GNSS receiver 111 in the GNSS unit 110 receives satellite signals transmitted from multiple GNSS satellites, and generates GNSS data based on the satellite signals.
  • GNSS data is generated in a predetermined format, such as NMEA-0183 format.
  • GNSS data may include, for example, values indicating the identification number, elevation, azimuth, and reception strength of each satellite from which the satellite signal was received. The reception strength can be expressed, for example, as a value such as carrier noise power density ratio (C/N0).
  • the GNSS data may also include position information of work vehicle 100 calculated based on a plurality of received satellite signals, and information indicating the reliability of the position information. Location information can be expressed, for example, by latitude, longitude, height from mean sea level, and the like. The reliability of position information can be expressed, for example, by a DOP value indicating the placement status of satellites.
  • the GNSS unit 110 shown in FIG. 3 performs positioning of the work vehicle 100 using RTK (Real Time Kinematic)-GNSS.
  • FIG. 4 is a conceptual diagram showing an example of a work vehicle 100 that performs positioning using RTK-GNSS.
  • a correction signal transmitted from the reference station 60 is used in positioning using RTK-GNSS.
  • the reference station 60 may be installed near a field where the work vehicle 100 travels for work (for example, within 10 km from the work vehicle 100).
  • the reference station 60 generates, for example, a correction signal in RTCM format based on the satellite signals received from the plurality of GNSS satellites 50, and transmits it to the GNSS unit 110.
  • RTK receiver 112 includes an antenna and a modem, and receives the correction signal transmitted from reference station 60.
  • the processing circuit 116 of the GNSS unit 110 corrects the positioning result by the GNSS receiver 111 based on the correction signal.
  • RTK-GNSS it is possible to perform positioning with an accuracy of a few centimeters, for example.
  • Location information including latitude, longitude, and altitude information is obtained through highly accurate positioning using RTK-GNSS.
  • GNSS unit 110 calculates the position of work vehicle 100 at a frequency of about 1 to 10 times per second, for example.
  • the positioning method is not limited to RTK-GNSS, and any positioning method (interferometric positioning method, relative positioning method, etc.) that can obtain position information with the necessary accuracy can be used.
  • positioning may be performed using VRS (Virtual Reference Station) or DGPS (Differential Global Positioning System). If positional information with the necessary accuracy can be obtained without using the correction signal transmitted from the reference station 60, the positional information may be generated without using the correction signal.
  • GNSS unit 110 may not include RTK receiver 112.
  • the position of work vehicle 100 is estimated.
  • the position of work vehicle 100 can be estimated by matching data output from LiDAR sensor 140 and/or camera 120 with a high-precision environmental map.
  • the GNSS unit 110 in this embodiment further includes an IMU 115.
  • IMU 115 may include a 3-axis acceleration sensor and a 3-axis gyroscope.
  • the IMU 115 may include an orientation sensor such as a 3-axis geomagnetic sensor.
  • IMU 115 functions as a motion sensor and can output signals indicating various quantities such as acceleration, speed, displacement, and posture of work vehicle 100.
  • Processing circuit 116 can estimate the position and orientation of work vehicle 100 with higher accuracy based on the signal output from IMU 115 in addition to the satellite signal and correction signal.
  • the signal output from IMU 115 may be used to correct or supplement the position calculated based on the satellite signal and the correction signal.
  • IMU 115 outputs signals more frequently than GNSS receiver 111.
  • the processing circuit 116 can measure the position and orientation of the work vehicle 100 at a higher frequency (eg, 10 Hz or more).
  • a 3-axis acceleration sensor and a 3-axis gyroscope may be provided separately.
  • IMU 115 may be provided as a separate device from GNSS unit 110.
  • the camera 120 is an imaging device that photographs the environment around the work vehicle 100.
  • the camera 120 includes an image sensor such as a CCD (Charge Coupled Device) or a CMOS (Complementary Metal Oxide Semiconductor).
  • Camera 120 may also include an optical system including one or more lenses, and signal processing circuitry.
  • Camera 120 photographs the environment around work vehicle 100 while work vehicle 100 is traveling, and generates image (for example, video) data.
  • the camera 120 can shoot moving images at a frame rate of 3 frames per second (fps) or more, for example.
  • the image generated by camera 120 can be used, for example, when a remote monitor uses terminal device 400 to check the environment around work vehicle 100. Images generated by camera 120 may be used for positioning or obstacle detection. As shown in FIG.
  • a plurality of cameras 120 may be provided at different positions on the work vehicle 100, or a single camera may be provided.
  • a visible camera that generates visible light images and an infrared camera that generates infrared images may be provided separately. Both a visible camera and an infrared camera may be provided as cameras that generate images for surveillance. Infrared cameras can also be used to detect obstacles at night.
  • the obstacle sensor 130 detects objects existing around the work vehicle 100.
  • Obstacle sensor 130 may include, for example, a laser scanner or an ultrasonic sonar. Obstacle sensor 130 outputs a signal indicating that an obstacle exists when an object exists closer than a predetermined distance from obstacle sensor 130 .
  • a plurality of obstacle sensors 130 may be provided at different positions of work vehicle 100. For example, multiple laser scanners and multiple ultrasonic sonars may be placed at different positions on work vehicle 100. By providing such a large number of obstacle sensors 130, blind spots in monitoring obstacles around the work vehicle 100 can be reduced.
  • the steering wheel sensor 152 measures the rotation angle of the steering wheel of the work vehicle 100.
  • the turning angle sensor 154 measures the turning angle of the front wheel 104F, which is a steered wheel. Measured values by the steering wheel sensor 152 and the turning angle sensor 154 are used for steering control by the control device 180.
  • the axle sensor 156 measures the rotational speed of the axle connected to the wheel 104, that is, the number of rotations per unit time.
  • the axle sensor 156 may be a sensor using a magnetoresistive element (MR), a Hall element, or an electromagnetic pickup, for example.
  • the axle sensor 156 outputs, for example, a numerical value indicating the number of revolutions per minute (unit: rpm) of the axle.
  • Axle sensor 156 is used to measure the speed of work vehicle 100.
  • the buzzer 220 is an audio output device that emits a warning sound to notify of an abnormality. For example, the buzzer 220 emits a warning sound when an obstacle is detected during automatic driving. Buzzer 220 is controlled by control device 180.
  • Storage device 170 includes one or more storage media such as flash memory or magnetic disks.
  • the storage device 170 stores various data generated by the GNSS unit 110, camera 120, obstacle sensor 130, LiDAR sensor 140, sensor group 150, and control device 180.
  • the data stored in the storage device 170 may include map data in the environment in which the work vehicle 100 travels (environmental map) and data on a global route (target route) for automatic driving.
  • the environmental map includes information on a plurality of fields where the work vehicle 100 performs agricultural work and roads around the fields.
  • the environmental map and the target route may be generated by a processor in the management device 600.
  • the control device 180 may have a function of generating or editing an environmental map and a target route. Control device 180 can edit the environmental map and target route acquired from management device 600 according to the driving environment of work vehicle 100.
  • the storage device 170 also stores work plan data that the communication device 190 receives from the management device 600.
  • the work plan includes information regarding a plurality of agricultural tasks to be performed by the work vehicle 100 over a plurality of work days.
  • the work plan may be, for example, work schedule data that includes information on scheduled times for each agricultural work to be performed by the work vehicle 100 on each work day.
  • the storage device 170 also stores computer programs that cause each ECU in the control device 180 to execute various operations described below.
  • a computer program may be provided to work vehicle 100 via a storage medium (eg, semiconductor memory or optical disk, etc.) or a telecommunications line (eg, the Internet).
  • Such computer programs may be sold as commercial software.
  • the control device 180 includes multiple ECUs.
  • the plurality of ECUs include, for example, an ECU 181 for speed control, an ECU 182 for steering control, an ECU 183 for instrument control, an ECU 184 for automatic driving control, an ECU 185 for route generation, and an ECU 186 for map creation.
  • ECU 181 controls the speed of work vehicle 100 by controlling prime mover 102, transmission 103, and brakes included in drive device 240.
  • the ECU 182 controls the steering of the work vehicle 100 by controlling the hydraulic system or electric motor included in the steering device 106 based on the measured value of the steering wheel sensor 152.
  • the ECU 183 controls the operations of the three-point link, PTO axis, etc. included in the coupling device 108 in order to cause the work machine 300 to perform a desired operation. ECU 183 also generates a signal to control the operation of work machine 300 and transmits the signal from communication device 190 to work machine 300.
  • the ECU 184 performs calculations and controls to realize automatic driving based on data output from the GNSS unit 110, camera 120, obstacle sensor 130, LiDAR sensor 140, and sensor group 150. For example, ECU 184 identifies the position of work vehicle 100 based on data output from at least one of GNSS unit 110, camera 120, and LiDAR sensor 140. In the field, ECU 184 may determine the position of work vehicle 100 based only on data output from GNSS unit 110. ECU 184 may estimate or correct the position of work vehicle 100 based on data acquired by camera 120 or LiDAR sensor 140. By using the data acquired by the camera 120 or the LiDAR sensor 140, the accuracy of positioning can be further improved.
  • ECU 184 estimates the position of work vehicle 100 using data output from LiDAR sensor 140 or camera 120. For example, the ECU 184 may estimate the position of the work vehicle 100 by matching data output from the LiDAR sensor 140 or the camera 120 with an environmental map. During automatic driving, the ECU 184 performs calculations necessary for the work vehicle 100 to travel along the target route or the local route based on the estimated position of the work vehicle 100.
  • the ECU 184 sends a speed change command to the ECU 181 and a steering angle change command to the ECU 182.
  • ECU 181 changes the speed of work vehicle 100 by controlling prime mover 102, transmission 103, or brake in response to a speed change command.
  • the ECU 182 changes the steering angle by controlling the steering device 106 in response to a command to change the steering angle.
  • the ECU 185 While the work vehicle 100 is traveling along the target route, the ECU 185 sequentially generates local routes that can avoid obstacles. ECU 185 recognizes obstacles existing around work vehicle 100 based on data output from camera 120, obstacle sensor 130, and LiDAR sensor 140 while work vehicle 100 is traveling. The ECU 185 generates a local route to avoid the recognized obstacle.
  • the ECU 185 may have a function of performing global route design instead of the management device 600. In that case, ECU 185 determines the destination of work vehicle 100 based on the work plan stored in storage device 170, and determines the target route from the start point of movement of work vehicle 100 to the destination point.
  • the ECU 185 can create, for example, a route that can reach the travel destination in the shortest time as a target route, based on the environmental map that includes road information stored in the storage device 170.
  • the ECU 185 may detect a specific type of road (for example, a farm road, a road along a specific feature such as a waterway, or a satellite signal from a GNSS satellite) based on the attribute information of each road included in the environmental map.
  • a route that gives priority to a route that can be received by the user) may be generated as a target route.
  • the ECU 186 generates or edits a map of the environment in which the work vehicle 100 travels.
  • an environmental map generated by an external device such as the management device 600 is transmitted to the work vehicle 100 and recorded in the storage device 170, but the ECU 186 can also generate or edit the environmental map instead. .
  • the operation when the ECU 186 generates an environmental map will be described below.
  • the environmental map may be generated based on sensor data output from the LiDAR sensor 140.
  • the ECU 186 sequentially generates three-dimensional point cloud data based on sensor data output from the LiDAR sensor 140 while the work vehicle 100 is traveling.
  • the ECU 186 can generate an environmental map by connecting sequentially generated point cloud data using, for example, an algorithm such as SLAM.
  • the environmental map generated in this way is a highly accurate three-dimensional map, and can be used for self-position estimation by the ECU 184. Based on this three-dimensional map, a two-dimensional map can be generated for use in global route planning. In this specification, both the three-dimensional map used for self-position estimation and the two-dimensional map used for global route planning are referred to as "environmental maps.”
  • the ECU 186 further determines the recognized features (for example, waterways, rivers, grass, trees, etc.), the type of road (for example, whether it is a farm road or not), and the road surface based on the data output from the camera 120 or the LiDAR sensor 140. Maps can also be edited by adding various attribute information to the map, such as the status or passability of roads.
  • control device 180 realizes automatic operation.
  • control device 180 controls drive device 240 based on the measured or estimated position of work vehicle 100 and the target route. Thereby, the control device 180 can cause the work vehicle 100 to travel along the target route.
  • a plurality of ECUs included in the control device 180 can communicate with each other, for example, according to a vehicle bus standard such as CAN (Controller Area Network). Instead of CAN, a faster communication method such as in-vehicle Ethernet (registered trademark) may be used.
  • CAN Controller Area Network
  • a faster communication method such as in-vehicle Ethernet (registered trademark) may be used.
  • An on-vehicle computer that integrates at least some of the functions of the ECUs 181 to 186 may be provided.
  • the control device 180 may include ECUs other than the ECUs 181 to 186, and any number of ECUs may be provided depending on the function.
  • Each ECU includes processing circuitry including one or more processors.
  • the communication device 190 is a device that includes a circuit that communicates with the work machine 300, the terminal device 400, and the management device 600.
  • Communication device 190 includes a circuit that transmits and receives signals compliant with the ISOBUS standard, such as ISOBUS-TIM, to and from communication device 390 of working machine 300. Thereby, it is possible to cause the work machine 300 to perform a desired operation or to acquire information from the work machine 300.
  • Communication device 190 may further include an antenna and a communication circuit for transmitting and receiving signals via network 80 with respective communication devices of terminal device 400 and management device 600.
  • Network 80 may include, for example, a cellular mobile communications network such as 3G, 4G or 5G and the Internet.
  • the communication device 190 may have a function of communicating with a mobile terminal used by a supervisor near the work vehicle 100. Communication with such mobile terminals may be conducted in accordance with any wireless communication standard, such as Wi-Fi (registered trademark), cellular mobile communications such as 3G, 4G or 5G, or Bluetooth (registered trademark). I can.
  • Wi-Fi registered trademark
  • cellular mobile communications such as 3G, 4G or 5G
  • Bluetooth registered trademark
  • the operation terminal 200 is a terminal for a user to perform operations related to traveling of the work vehicle 100 and operation of the work machine 300, and is also referred to as a virtual terminal (VT).
  • Operating terminal 200 may include a display device such as a touch screen and/or one or more buttons.
  • the display device may be a display such as a liquid crystal or an organic light emitting diode (OLED), for example.
  • OLED organic light emitting diode
  • the operating terminal 200 may be configured to be detachable from the work vehicle 100. A user located away from work vehicle 100 may operate detached operation terminal 200 to control the operation of work vehicle 100. Instead of the operation terminal 200, the user may control the operation of the work vehicle 100 by operating a computer, such as the terminal device 400, in which necessary application software is installed.
  • FIG. 5 is a diagram showing an example of the operation terminal 200 and the operation switch group 210 provided inside the cabin 105.
  • an operation switch group 210 including a plurality of switches that can be operated by a user is arranged inside the cabin 105.
  • the operation switch group 210 includes, for example, a switch for selecting the main gear or the auxiliary gear, a switch for switching between automatic operation mode and manual operation mode, a switch for switching between forward and reverse, and a switch for switching the work machine. It may include a switch for raising and lowering 300, etc. Note that if the work vehicle 100 performs only unmanned operation and does not have the function of manned operation, the work vehicle 100 does not need to include the operation switch group 210.
  • the drive device 340 in the work machine 300 shown in FIG. 3 performs operations necessary for the work machine 300 to perform a predetermined work.
  • the drive device 340 includes a device depending on the use of the working machine 300, such as a hydraulic device, an electric motor, or a pump, for example.
  • Control device 380 controls the operation of drive device 340.
  • Control device 380 causes drive device 340 to perform various operations in response to signals transmitted from work vehicle 100 via communication device 390. Further, a signal depending on the state of the work machine 300 can also be transmitted from the communication device 390 to the work vehicle 100.
  • FIG. 6 is a block diagram illustrating a schematic hardware configuration of the management device 600 and the terminal device 400.
  • the management device 600 includes a storage device 650, a processor 660, a ROM (Read Only Memory) 670, a RAM (Random Access Memory) 680, and a communication device 690. These components are communicatively connected to each other via a bus.
  • the management device 600 can function as a cloud server that manages the schedule of agricultural work in the field performed by the work vehicle 100 and supports agriculture by utilizing the managed data.
  • a user can input information necessary for creating a work plan using the terminal device 400 and upload the information to the management device 600 via the network 80.
  • the management device 600 can create an agricultural work schedule, that is, a work plan, based on the information.
  • the management device 600 can further generate or edit an environmental map. The environmental map may be distributed from a computer external to the management device 600.
  • the communication device 690 is a communication module for communicating with the work vehicle 100 and the terminal device 400 via the network 80.
  • the communication device 690 can perform wired communication based on a communication standard such as IEEE1394 (registered trademark) or Ethernet (registered trademark), for example.
  • the communication device 690 may perform wireless communication based on the Bluetooth (registered trademark) standard or the Wi-Fi standard, or cellular mobile communication such as 3G, 4G, or 5G.
  • the processor 660 may be, for example, a semiconductor integrated circuit including a central processing unit (CPU).
  • Processor 660 may be implemented by a microprocessor or microcontroller.
  • the processor 660 is selected from an FPGA (Field Programmable Gate Array) equipped with a CPU, a GPU (Graphics Processing Unit), an ASIC (Application Specific Integrated Circuit), an ASSP (Application Specific Standard Product), or one of these circuits. It can also be realized by a combination of two or more circuits.
  • the processor 660 sequentially executes a computer program stored in the ROM 670 that describes a group of instructions for executing at least one process, thereby realizing a desired process.
  • the ROM 670 is, for example, a writable memory (eg, PROM), a rewritable memory (eg, flash memory), or a read-only memory.
  • ROM 670 stores a program that controls the operation of processor 660.
  • the ROM 670 does not need to be a single storage medium, and may be a collection of multiple storage media. A portion of the collection of storage media may be removable memory.
  • the RAM 680 provides a work area for temporarily expanding the control program stored in the ROM 670 at boot time.
  • RAM 680 does not need to be a single storage medium, and may be a collection of multiple storage media.
  • the storage device 650 mainly functions as database storage.
  • Storage device 650 may be, for example, a magnetic storage device or a semiconductor storage device.
  • An example of a magnetic storage device is a hard disk drive (HDD).
  • An example of a semiconductor storage device is a solid state drive (SSD).
  • Storage device 650 may be a device independent of management device 600.
  • the storage device 650 may be a storage device connected to the management device 600 via the network 80, such as a cloud storage.
  • the terminal device 400 includes an input device 420, a display device 430, a storage device 450, a processor 460, a ROM 470, a RAM 480, and a communication device 490. These components are communicatively connected to each other via a bus.
  • the input device 420 is a device for converting instructions from a user into data and inputting the data into the computer.
  • Input device 420 may be, for example, a keyboard, mouse, or touch panel.
  • Display device 430 may be, for example, a liquid crystal display or an organic EL display. Descriptions regarding each of the processor 460, ROM 470, RAM 480, storage device 450, and communication device 490 are as described in the hardware configuration example of the management device 600, and their descriptions will be omitted.
  • the work vehicle 100 in this embodiment can automatically travel both inside and outside the field.
  • the work vehicle 100 drives the work machine 300 and performs predetermined agricultural work while traveling along a preset target route.
  • the work vehicle 100 detects an obstacle by the obstacle sensor 130 while traveling in the field, for example, the work vehicle 100 stops traveling, emits a warning sound from the buzzer 220, and transmits a warning signal to the terminal device 400.
  • the work vehicle 100 automatically travels along a target route set on a farm road or a general road outside the field.
  • the work vehicle 100 uses data acquired by the camera 120 or the LiDAR sensor 140 while traveling outside the field.
  • the work vehicle 100 avoids the obstacle or stops on the spot, for example.
  • the position of work vehicle 100 can be estimated based on data output from LiDAR sensor 140 or camera 120 in addition to positioning data output from GNSS unit 110.
  • FIG. 7 is a diagram schematically showing an example of a work vehicle 100 that automatically travels along a target route in a field.
  • the farm field includes a work area 72 where the work vehicle 100 works using the work machine 300, and a headland 74 located near the outer periphery of the farm field. Which area of the field on the map corresponds to the work area 72 or the headland 74 can be set in advance by the user.
  • the target route in this example includes a plurality of parallel main routes P1 and a plurality of turning routes P2 connecting the plurality of main routes P1.
  • the main route P1 is located within the work area 72, and the turning route P2 is located within the headland 74.
  • each main route P1 may include a curved portion.
  • the main route P1 is, for example, an operation in which the user specifies two points near the edge of the field (points A and B in FIG. 7) while looking at a map of the field displayed on the operating terminal 200 or the terminal device 400. can be automatically generated by In that case, a plurality of main routes P1 are set parallel to the line segment connecting points A and B specified by the user, and by connecting these main routes P1 with a turning route P2, the target route in the field is determined. generated.
  • the broken line in FIG. 7 represents the working width of the working machine 300. The working width is set in advance and recorded in the storage device 170.
  • the working width can be set and recorded by the user operating the operating terminal 200 or the terminal device 400. Alternatively, the working width may be automatically recognized and recorded when the working machine 300 is connected to the working vehicle 100.
  • the intervals between the plurality of main routes P1 may be set according to the working width.
  • the target route may be created based on a user's operation before automatic driving is started.
  • the target route may be created to cover the entire working area 72 in the field, for example.
  • the work vehicle 100 automatically travels along a target route as shown in FIG. 7 from a work start point to a work end point while repeating back and forth movements. Note that the target route shown in FIG. 7 is only an example, and the method of determining the target route is arbitrary.
  • control device 180 Next, an example of control during automatic operation in a field by the control device 180 will be explained.
  • FIG. 8 is a flowchart showing an example of the operation of steering control during automatic driving executed by the control device 180.
  • the control device 180 performs automatic steering by executing the operations from steps S121 to S125 shown in FIG. 8 while the work vehicle 100 is traveling. Regarding the speed, for example, it is maintained at a preset speed.
  • the control device 180 acquires data indicating the position of the work vehicle 100 generated by the GNSS unit 110 (step S121).
  • control device 180 calculates the deviation between the position of work vehicle 100 and the target route (step S122). The deviation represents the distance between the position of work vehicle 100 at that point and the target route.
  • the control device 180 determines whether the calculated positional deviation exceeds a preset threshold (step S123).
  • control device 180 changes the steering angle by changing the control parameters of the steering device included in the drive device 240 so that the deviation becomes smaller. If the deviation does not exceed the threshold in step S123, the operation in step S124 is omitted. In subsequent step S125, control device 180 determines whether or not it has received an instruction to end the operation.
  • the instruction to end the operation may be issued, for example, when a user remotely instructs to stop automatic driving or when work vehicle 100 reaches a destination. If the instruction to end the operation has not been issued, the process returns to step S121, and a similar operation is executed based on the newly measured position of the work vehicle 100.
  • the control device 180 repeats the operations from steps S121 to S125 until an instruction to end the operation is issued. The above operations are executed by the ECUs 182 and 184 in the control device 180.
  • the control device 180 controls the drive device 240 based only on the deviation between the position of the work vehicle 100 specified by the GNSS unit 110 and the target route, but also takes into account the deviation in the direction. May be controlled. For example, when the azimuth deviation, which is the angular difference between the direction of the work vehicle 100 specified by the GNSS unit 110 and the direction of the target route, exceeds a preset threshold, the control device 180 drives the vehicle according to the deviation. Control parameters (eg, steering angle) of the steering device of device 240 may be changed.
  • FIG. 9A is a diagram showing an example of the work vehicle 100 traveling along the target route P.
  • FIG. 9B is a diagram showing an example of work vehicle 100 in a position shifted to the right from target route P.
  • FIG. 9C is a diagram showing an example of work vehicle 100 in a position shifted to the left from target route P.
  • FIG. 9D is a diagram illustrating an example of work vehicle 100 facing in a direction inclined with respect to target route P.
  • the pose indicating the position and orientation of the work vehicle 100 measured by the GNSS unit 110 is expressed as r(x, y, ⁇ ).
  • (x, y) are coordinates representing the position of the reference point of work vehicle 100 in the XY coordinate system, which is a two-dimensional coordinate system fixed to the earth.
  • the reference point of the work vehicle 100 is located at the location where the GNSS antenna is installed on the cabin, but the location of the reference point is arbitrary.
  • ⁇ is an angle representing the measured direction of work vehicle 100.
  • the target route P is parallel to the Y-axis, but generally the target route P is not necessarily parallel to the Y-axis.
  • control device 180 maintains the steering angle and speed of work vehicle 100 unchanged.
  • the control device 180 steers the work vehicle 100 so that the traveling direction of the work vehicle 100 leans to the left and approaches the route P. Change the corner.
  • the speed may be changed in addition to the steering angle.
  • the magnitude of the steering angle can be adjusted, for example, depending on the magnitude of the positional deviation ⁇ x.
  • the control device 180 steers the work vehicle 100 so that the traveling direction of the work vehicle 100 leans to the right and approaches the route P. Change the corner. In this case as well, the speed may be changed in addition to the steering angle. The amount of change in the steering angle can be adjusted, for example, depending on the magnitude of the positional deviation ⁇ x.
  • the absolute value of the positional deviation ⁇ x is large, the steering angle will be changed significantly in order to return to the route P, so the absolute value of the azimuth deviation ⁇ will inevitably become large. Conversely, when the absolute value of the positional deviation ⁇ x is small, it is necessary to bring the azimuth deviation ⁇ close to zero. Therefore, it is appropriate to relatively increase the weight (ie, control gain) of the azimuth deviation ⁇ for determining the steering angle.
  • a control technique such as PID control or MPC control (model predictive control) may be applied to the steering control and speed control of the work vehicle 100. By applying these control techniques, it is possible to smoothly control the work vehicle 100 to approach the target route P.
  • the control device 180 stops the work vehicle 100, for example. At this time, the buzzer 220 may be made to emit a warning sound, or a warning signal may be transmitted to the terminal device 400. If the obstacle can be avoided, the control device 180 may generate a local route that allows the obstacle to be avoided, and control the drive device 240 so that the work vehicle 100 travels along the route. .
  • the work vehicle 100 in this embodiment can automatically travel not only inside the field but also outside the field.
  • the control device 180 detects objects located relatively far from the work vehicle 100 (for example, other vehicles or pedestrians) based on data output from the camera 120 or the LiDAR sensor 140. can do.
  • the control device 180 generates a local route to avoid the detected object, and performs speed control and steering control along the local route, thereby realizing automatic driving on roads outside the field.
  • FIG. 10 is a diagram schematically showing an example of a situation in which a plurality of work vehicles 100 are automatically traveling on a road 76 inside the farm field 70 and outside the farm field 70.
  • the storage device 170 records an environmental map of an area including a plurality of farm fields and roads around them, and a target route.
  • the environmental map and the target route may be generated by management device 600 or ECU 185.
  • the work vehicle 100 travels on a road, the work vehicle 100 moves along the target route while sensing the surroundings using sensing devices such as the camera 120 and the LiDAR sensor 140 with the work implement 300 raised.
  • control device 180 sequentially generates local routes and causes work vehicle 100 to travel along the local routes. This allows the vehicle to travel automatically while avoiding obstacles.
  • the target route may be changed depending on the situation.
  • the ECU 185 in the control device 180 sequentially generates local routes that can avoid obstacles while the work vehicle 100 is traveling.
  • the ECU 185 generates a local route based on sensing data acquired by sensing devices (obstacle sensor 130, LiDAR sensor 140, camera 120, etc.) included in the work vehicle 100. do.
  • the local route is defined by a plurality of waypoints along a portion of the second route 30B.
  • ECU 185 determines whether an obstacle exists on or near the path of work vehicle 100 based on the sensing data.
  • the ECU 185 If such an obstacle exists, the ECU 185 generates a local route by setting a plurality of waypoints to avoid the obstacle. If there is no obstacle, ECU 185 generates a local route substantially parallel to second route 30B. Information indicating the generated local route is sent to the ECU 184 for automatic driving control. ECU 184 controls ECU 181 and ECU 182 so that work vehicle 100 travels along a local route. Thereby, the work vehicle 100 can travel while avoiding obstacles. Note that when a traffic light exists on the road on which the work vehicle 100 is traveling, the work vehicle 100 recognizes the traffic light based on the image taken by the camera 120, and performs operations such as stopping at a red light and starting at a green light. You may go.
  • FIG. 11 is a diagram showing an example of a global route and a local route generated in an environment where obstacles exist.
  • a global route 30 is illustrated by a dotted line arrow, and a local route 32 that is sequentially generated during travel is illustrated by a solid line arrow.
  • the global path 30 is defined by a plurality of waypoints 30p.
  • the local route 32 is defined by a plurality of waypoints 32p set at shorter intervals than the waypoint 30p.
  • Each waypoint has, for example, position and orientation information.
  • the management device 600 generates the global route 30 by setting a plurality of waypoints 30p at a plurality of locations including intersections of the road 76.
  • the distance between the waypoints 30p may be relatively long, for example, from several meters to several tens of meters.
  • the ECU 185 While the work vehicle 100 is traveling, the ECU 185 generates a local route 32 by setting a plurality of waypoints 32p based on sensing data output from the sensing device.
  • the spacing between waypoints 32p on local route 32 is shorter than the spacing between waypoints 30p on global route 30.
  • the distance between the waypoints 32p may be, for example, approximately several tens of centimeters (cm) to several meters (m).
  • the local route 32 is generated within a relatively narrow range (for example, a range of several meters) starting from the position of the work vehicle 100.
  • FIG 11 illustrates a series of local paths 32 that are generated while work vehicle 100 travels along road 76 between fields 70 and turns left at an intersection. While the work vehicle 100 is moving, the ECU 185 repeats the operation of generating a local route from the position of the work vehicle 100 estimated by the ECU 184 to a point several meters away, for example. Work vehicle 100 travels along local routes that are sequentially generated.
  • an obstacle 40 exists in front of the work vehicle 100.
  • a sensing device such as a camera 120, an obstacle sensor 130, or a LiDAR sensor 140 mounted on the work vehicle 100 is illustrated in a fan shape.
  • ECU 185 generates local route 32 to avoid obstacle 40 detected based on sensing data.
  • the ECU 185 determines that there is a possibility that the work vehicle 100 will collide with the obstacle 40 based on the sensing data and the width of the work vehicle 100 (including the width of the implement if an implement is installed). to judge.
  • the ECU 185 sets a plurality of waypoints 32p to generate a local route 32 so as to avoid the obstacle 40.
  • the ECU 185 recognizes not only the presence or absence of the obstacle 40 but also the condition of the road surface (for example, mud, depressions, etc.) based on the sensing data, and if a place where it is difficult to drive is detected, the ECU 185 recognizes the road surface condition (for example, mud, depression, etc.).
  • a local route 32 may be generated to avoid this.
  • Work vehicle 100 travels along local route 32 .
  • the control device 180 may stop the work vehicle 100. At this time, the control device 180 may send a warning signal to the terminal device 400 to alert the monitor. After stopping, if it is recognized that the obstacle 40 has moved and there is no longer a risk of collision, the control device 180 may restart the traveling of the work vehicle 100.
  • FIG. 12 is a flowchart showing the operation of route planning and travel control in this embodiment. By executing the operations from steps S141 to S146 shown in FIG. 12, it is possible to plan a route and control automatic travel of the work vehicle 100.
  • the management device 600 first obtains a map and a work plan from the storage device 650 (step S141). Next, the management device 600 designs a global route for the work vehicle 100 using the method described above based on the map and the work plan (step S142).
  • the global route design can be performed at any timing before the work vehicle 100 starts traveling.
  • the global route design may be performed immediately before the work vehicle 100 starts traveling, or may be performed the day before the work vehicle 100 starts traveling. Further, the global route may be generated based on information input by the user using the terminal device 400 (for example, starting point, destination point, way point, etc.).
  • the management device 600 uses attribute information of each road on the map. Based on this, at least one of a route giving priority to a farm road, a route giving priority to a road along a specific feature, and a route giving priority to a road on which satellite signals can be normally received is generated as a route for work vehicle 100.
  • Management device 600 transmits data indicating the generated global route to work vehicle 100. Thereafter, the management device 600 issues an instruction to the work vehicle 100 to travel at a predetermined timing.
  • control device 180 of work vehicle 100 controls drive device 240 to start traveling of work vehicle 100 (step S143).
  • work vehicle 100 starts traveling.
  • the timing of starting traveling can be set, for example, to an appropriate timing at which work vehicle 100 can reach the field by the scheduled start time of the first farm work on each work day indicated by the work plan.
  • the ECU 185 of the control device 180 performs local route design to avoid collisions with obstacles using the method described above (step S144). If no obstacle is detected, ECU 185 generates a local path approximately parallel to the global path. If an obstacle is detected, the ECU 185 generates a local route that can avoid the obstacle.
  • ECU 184 determines whether or not to end traveling of work vehicle 100 (step S145). For example, if a local route that avoids obstacles cannot be generated, or if work vehicle 100 arrives at the destination point, ECU 184 stops work vehicle 100 (step S146). If no obstacle is detected, or if a local route that can avoid the obstacle is generated, the process returns to step S143, and the ECU 184 causes the work vehicle 100 to travel along the generated local route. Thereafter, the operations from steps S143 to S145 are repeated until it is determined in step S145 that the travel is to be ended.
  • the global route is not limited to such an example, and the global route may be modified while the work vehicle 100 is traveling.
  • the ECU 185 determines the state of the road on which the work vehicle 100 is traveling, the surroundings of the work vehicle 100, based on sensing data acquired by a sensing device such as the camera 120 or the LiDAR sensor 140 while the work vehicle 100 is traveling.
  • the global route may be changed when the recognized state satisfies a predetermined condition. When the work vehicle 100 is traveling along a global route, some roads may be difficult to pass.
  • roads may become muddy due to heavy rain, the road surface may be caved in, or it may become impassable due to an accident or other cause.
  • the vegetation around farm roads may have grown longer than expected, or new buildings may have been constructed, making it difficult to receive satellite signals from GNSS satellites.
  • the ECU 185 detects roads that are difficult to pass based on sensing data acquired while the work vehicle 100 is traveling, and changes the route to avoid such roads. It's okay.
  • the ECU 185 may cause the storage device 170 to store the changed route, and may transmit information on the changed route to the management device 600.
  • the management device 600 may adopt the changed route when generating a route to the same field next time. This enables flexible route planning in response to changes in the driving environment.
  • the work vehicle 100 that performs automatic driving includes one or more sensors (sensing devices) that sense the environment around the work vehicle 100 and output sensor data, and a system that detects the work vehicle 100 based on the sensor data. It includes a control device 180 for controlling automatic operation, and a coupling device 108 for coupling the implements.
  • the control device 180 executes the following (i) to (iii) when the work vehicle 100 performs automatic operation with the implement 300 connected to the work vehicle 100. (i) Perform object detection and classification based on sensor data.
  • the second degree of influence shown is determined according to the classification result of the object.
  • automatic operation of work vehicle 100 is continued without performing an operation to avoid contact with an object and an operation to avoid contact with an object. Execute one of the actions.
  • "Obstacle avoidance" refers to performing either an action to avoid contact with a detected object or an action to continue automatic operation of work vehicle 100 without performing an action to avoid contact with a detected object. It is sometimes referred to as ⁇ performing an action''.
  • the work vehicle 100 can also be expressed as follows.
  • Work vehicle 100 performs an obstacle avoidance operation as follows based on sensor data during automatic driving.
  • the work vehicle 100 determines the classification result of the object detected based on the sensor data and the influence according to the classification result of the object when the object comes into contact with the work vehicle 100 and the implement 300 connected to the work vehicle 100.
  • the obstacle avoidance operation is controlled based on the degree of influence (that is, the first degree of influence and the second degree of influence).
  • a plurality of ECUs included in the control device 180 may cooperate to execute a process for executing an obstacle avoidance operation.
  • the control device 180 may further include an ECU for performing part or all of the process of executing the obstacle avoidance operation.
  • FIG. 13 is a flowchart showing an example of a procedure for the work vehicle 100 to perform an obstacle avoidance operation, which is executed when the work vehicle 100 performs automatic driving with the implement 300 connected to the work vehicle 100. This is the procedure.
  • step S141 the control device 180 performs object detection and classification based on the sensor data.
  • sensor data is output from one or more sensors (sensing devices) that the work vehicle 100 has.
  • the work vehicle 100 performs automatic driving while sensing the surrounding environment using one or more sensors (sensing devices) that the work vehicle 100 has.
  • the sensing device included in the work vehicle 100 includes a plurality of cameras 120, a LiDAR sensor 140, and a plurality of obstacle sensors 130.
  • the sensing device of work vehicle 100 may include at least one of camera 120, obstacle sensor 130, and LiDAR sensor 140.
  • the control device 180 uses sensor data acquired by at least one of the sensing devices included in the work vehicle 100, such as image data acquired by the camera 120, and data output from the obstacle sensor 130 or the LiDAR sensor 140 (for example, point cloud data).
  • Object detection may be performed constantly while the work vehicle 100 is operating automatically while sensing the surrounding environment, or may be performed at predetermined time intervals. Detection and classification of objects may be performed based on sensor data obtained from the same sensing device or may be performed based on sensor data obtained from different sensing devices. Detection and classification of the object may be performed simultaneously, or classification of the detected object (i.e., identification of the type of the detected object) may be performed after the object is detected.
  • the control device 180 identifies the type of the detected object and performs classification based on the image data of the object acquired by the camera 120. For example, the control device 180 classifies objects using a trained model constructed by deep learning of artificial intelligence. A trained model can be constructed by storing image data of various objects in a computer that performs learning using artificial intelligence.
  • the control device 180 may also perform object classification by identifying the object through pattern matching and obtaining the classification of the identified object from a database.
  • Objects detected by the control device 180 based on sensor data include objects that may be obstacles (that is, objects that pose an obstacle to the travel of the work vehicle 100), such as moving or stationary objects on the ground. , and includes a portion of the ground that is in a particular state. Examples of "a part of the ground in a specific state” include unevenness (including potholes, depressions, holes, cracks in the road surface, etc.) that impede driving, mud, puddles, etc.
  • FIGS. 14A and 14B are diagrams schematically showing examples of areas that can be sensed by LiDAR sensor 140 and camera 120 of work vehicle 100.
  • the work vehicle 100 includes four LiDAR sensors 140 (140a, 140b, 140c, and 140d) and four cameras 120 provided on the front, rear, left, and right sides of the work vehicle 100. (120a, 120b, 120c, and 120d), and the surrounding environment can be sensed by these.
  • FIGS. 14A and 14B an example of the range sensed by the LiDAR sensor 140 and camera 120 is shown as a gray sector or triangle.
  • the LiDAR sensor 140 emits laser beam pulses (hereinafter abbreviated as "laser pulses”) one after another while changing the emission direction, and calculates each pulse based on the time difference between the emission time and the time when the reflected light of each laser pulse is acquired.
  • the distance to the position of the reflection point can be measured (ToF (Time of Flight) method).
  • the LiDAR sensor 140 may be a sensor that measures distance using FMCW (Frequency Modulated Continuous Wave) technology.
  • a LiDAR sensor using FMCW technology emits a laser beam whose frequency is linearly modulated, and detects the interference between the emitted light and the reflected light.
  • the LiDAR sensor uses the frequency of the beat signal obtained by detecting the interference light between the emitted light and the reflected light to determine the distance to the reflection point. Distance and speed can be determined.
  • a “reflection point” may be a point on the surface of an object located in the environment around work vehicle 100.
  • the LiDAR sensor 140 can measure the distance from the LiDAR sensor 140 to an object using any method. Measurement methods for the LiDAR sensor 140 include, for example, a mechanical rotation method, a MEMS method, and a phased array method. These measurement methods differ in the method of emitting laser pulses (scanning method).
  • a mechanical rotation type LiDAR sensor rotates a cylindrical head that emits laser pulses and detects reflected light of the laser pulses to scan the surrounding environment in all directions of 360 degrees around the rotation axis.
  • a MEMS LiDAR sensor uses a MEMS mirror to swing the emission direction of a laser pulse, and scans the surrounding environment within a predetermined angular range around the swing axis.
  • a phased array type LiDAR sensor controls the phase of light to swing the light emission direction, and scans the surrounding environment within a predetermined angular range around the swing axis.
  • step S142 the control device 180 controls the first influence indicating the magnitude of the influence on the work vehicle 100 when the detected and classified object contacts the work vehicle 100, according to the object classification result in the step S142. and a second degree of influence indicating the magnitude of the influence on the implement 300 when the detected and classified object comes into contact with the implement 300.
  • the first degree of influence and the second degree of influence may be expressed independently, for example, in a plurality of stages (levels) indicating the magnitude of influence (for example, three stages of small, medium, and large), or they may be expressed in a continuous manner. It may be expressed as a numerical value.
  • the control device 180 may calculate the values (scores) of the first degree of influence and the second degree of influence using a predetermined evaluation formula (or evaluation function). The control device 180 may determine the first degree of influence and the second degree of influence by referring to a table.
  • a table including values (or levels) of the first degree of influence and the second degree of influence for each classification (type) of objects is stored in the storage device 170 of the work vehicle 100, and the control device 180
  • the first degree of influence and the second degree of influence may be determined based on the object classification result and the object classification result.
  • the control device 180 determines whether the detected object contacts the work vehicle 100 and whether the detected object contacts the implement 300. You may. A specific determination method will be described later with reference to FIGS. 17A and 17B. Further, as a specific method for determining whether or not the detected object contacts the work vehicle 100 and whether or not the detected object contacts the implement 300, the method described in Patent Document 2 is applied. You may. The entire disclosure of Patent Document 2 is incorporated herein by reference.
  • step S143 the control device 180 determines whether to perform an operation to avoid contact with the object, depending on the first degree of influence and/or the second degree of influence.
  • the control device 180 compares the first degree of influence and the second degree of influence with a predetermined reference value to determine whether to perform an operation to avoid contact with the object. For example, if the first degree of influence is smaller than the first reference value and the second degree of influence is smaller than the second reference value, the control device 180 controls the work vehicle 100 without performing an operation to avoid contact with the object. continues the automatic operation, and if the first degree of influence is greater than or equal to the first reference value or the second degree of influence is greater than or equal to the second reference value, an action to avoid contact with the object is executed. That is, if the first degree of influence is smaller than the first reference value and the second degree of influence is smaller than the second reference value, the control device 180 allows contact with the object and stops the automatic operation of the work vehicle 100. continue.
  • the first reference value and the second reference value are For example, suppose it is "medium”. In this case, if both the first influence degree and the second influence degree are "small", automatic operation of the work vehicle 100 is continued without performing an action to avoid contact with the object, and the first influence degree and the second influence degree are "small”. If either of the two influence degrees is "medium” or "large”, an action to avoid contact with the object is performed.
  • the first reference value and the second reference value may be determined in advance, or may be set by the user. Note that the first reference value and the second reference value may be the same or different.
  • a permissible range for the magnitude of the influence on the work vehicle 100 when an object comes into contact with the work vehicle 100, and a permissible range for the magnitude of the influence on the implement 300 when an object comes into contact with the implement 300. may be different.
  • control device 180 executes an operation to avoid contact with the object (step S144), or automatically operates the work vehicle 100 without performing an operation to avoid contact with the object.
  • the continuing operation is executed (step S145).
  • step S144 that is, when performing an operation to avoid contact with an object
  • the control device 180 avoids contact with the object using the method described with reference to FIGS. 11 and 12, for example.
  • the target route of work vehicle 100 is changed so that.
  • the control device 180 stops the work vehicle 100 for a predetermined period of time, senses the surrounding environment after the predetermined period of time has elapsed, and converts it into sensor data. If no object is detected based on the detection result, the work vehicle 100 may be allowed to resume traveling.
  • control device 180 changes the target route of work vehicle 100 to avoid the object, for example, by the method described with reference to FIGS. 11 and 12.
  • Control device 180 may stop traveling of work vehicle 100 when proceeding to step S144 (that is, when performing an operation to avoid contact with an object).
  • the control device 180 may transmit a signal to an external device when the work vehicle 100 stops traveling.
  • step S145 that is, when performing an operation to continue automatic operation of the work vehicle 100 without performing an operation to avoid contact with the object
  • the control device 180 allows the contact with the object.
  • the automatic operation of the work vehicle 100 is continued without changing the target route of the work vehicle 100.
  • the speed of work vehicle 100 may be changed as necessary (for example, the speed may be reduced).
  • the control device 180 repeats the steps S141 to S145 until a command to end the operation is issued (step S146).
  • the work vehicle 100 executes the obstacle avoidance operation according to the above procedure.
  • the work vehicle 100 is configured to operate when an object that may be an obstacle is detected, when the object contacts the work vehicle 100, and when the object contacts the implement 300.
  • the magnitude of the influence of the object is determined as the first influence degree and the second influence degree, and if both the first influence degree and the second influence degree are tolerably small, contact with the object is allowed, Automatic driving can be continued without changing the target route of work vehicle 100.
  • the work vehicle 100 can more efficiently travel by automatic operation than the work vehicle of Patent Document 2.
  • FIG. 16 is a flowchart showing another example of the procedure for the work vehicle 100 to perform the obstacle avoidance operation. Detailed description of steps common to or corresponding to the flowchart of FIG. 13 may be omitted.
  • step S161 the control device 180 detects objects existing in the environment around the work vehicle 100 based on the sensor data.
  • step S162 the control device 180 determines whether the object detected in step S161 is located on or near the target route of the work vehicle 100. If it is determined in step S162 that the detected object is located on or near the target route of work vehicle 100, the process advances to step S163.
  • step S163 the control device 180 acquires information regarding the position, size, and type of the detected object.
  • step S164 the control device 180 determines (estimates) whether the detected object will come into contact with the work vehicle 100 and whether the detected object will come into contact with the implement 300. For example, the control device 180 determines whether or not the detected object will contact the work vehicle 100, based on the position of the detected object, the size of the work vehicle 100, and the size of the implement 300. It is determined whether or not the implement 300 comes into contact with the implement 300. A specific determination method will be described with reference to FIGS. 17A and 17B, which will be described later.
  • step S165 If the control device 180 determines in step S165 that the detected object will contact at least one of the work vehicle 100 and the implement 300, the process proceeds to step S166.
  • step S166 the control device 180 determines at least one of the first degree of influence and the second degree of influence according to the classification result of the object.
  • step S165 if it is determined in step S165 that the detected object contacts both the work vehicle 100 and the implement 300, the control device 180 adds both the first influence degree and the second influence degree to the object classification result. Decide accordingly.
  • step S165 if it is determined in step S165 that the detected object contacts only one of the work vehicle 100 and the implement 300, the control device 180 controls the corresponding one of the first degree of influence and the second degree of influence. is determined according to the object classification result.
  • step S167 the control device 180 compares the first degree of influence and/or the second degree of influence determined in step S166 with predetermined reference values (first reference value, second reference value), Determine whether to perform an action to avoid contact with an object.
  • the control device 180 determines that the first degree of influence is smaller than the first reference value, and the second degree of influence is the second reference value. If it is smaller than , the automatic operation of the work vehicle 100 is continued without performing any action to avoid contact with the object, and the first influence degree is equal to or greater than the first reference value, or the second influence degree is equal to or greater than the second reference value. If so, take action to avoid contact with the object. Alternatively, if only one of the first influence degree and the second influence degree is determined in step S166, the control device 180 determines that the determined first influence degree or the second influence degree is the first influence degree or the second influence degree.
  • the automatic operation of the work vehicle 100 is continued without performing any action to avoid contact with the object, and the determined first influence degree or second influence degree is lower than the first reference value or the first influence degree. If it is two or more reference values, an operation is performed to avoid contact with the object.
  • control device 180 Based on the determination in step S167, control device 180 performs an operation to avoid contact with the object (step S168), or automatically operates work vehicle 100 without performing an operation to avoid contact with the object. The continuing operation is executed (step S169).
  • the control device 180 repeats the steps S161 to S170 until a command to end the operation is issued (step S170).
  • the control device 180 estimates the moving speed of the object and determines whether the object will come into contact with the work vehicle 100 and the implement 300. may be determined.
  • 17A and 17B a method for controlling device 180 to determine whether or not a detected object contacts work vehicle 100 and whether or not the detected object contacts implement 300 is explained.
  • 17A and 17B are top views schematically showing the work vehicle 100 and the work machine 300 connected to the work vehicle 100.
  • the control device 180 determines the position of the object (for example, the position of the object in the width direction of the work vehicle 100 and the implement 300); Based on the width (vehicle body width) W20 of the work vehicle 100 and the width W30 of the implement 300, it is determined whether the detected object contacts the work vehicle 100 and whether the detected object contacts the implement 300. Determine whether or not.
  • Control device 180 determines that an object located outside width W20 of work vehicle 100 and width W30 of implement 300, like object Ob1, does not come into contact with work vehicle 100 and implement 300. Control device 180 determines that an object located outside width W20 of work vehicle 100, such as object Ob2, does not come into contact with work vehicle 100. When an object, such as object Ob2, is located inside the width W30 of the implement 300, the control device 180 determines the height H22 from the ground of the implement 300 (see FIG. 2) and the height of the object Ob2. Furthermore, based on this, it is determined whether or not there is contact with the implement 300.
  • control device 180 determines that the object Ob3 does not come into contact with the work vehicle 100 and the implement 300. If the object Ob4 is in a position where it interferes with the wheels 104, the control device 180 determines that the object Ob4 will come into contact with the work vehicle 100.
  • the control device 180 determines the position of the recess (for example, the position of the recess in the width direction of the work vehicle 100 and the implement 300); Based on the width (vehicle body width) W20 of the work vehicle 100 and the width W30 of the implement 300, it is determined whether the detected object contacts the work vehicle 100 and whether the detected object contacts the implement 300. Determine whether or not. Based on the position of the recess and the position of the wheels 104 of the work vehicle 100, the control device 180 determines whether the detected object will come into contact with the work vehicle 100 and whether the detected object will come into contact with the implement 300. It may be determined whether or not.
  • the control device 180 determines that the recess On1 does not contact the work vehicle 100 and the implement 300. If the concave portion On2 is located outside the width W20 of the work vehicle 100 and inside the width W30 of the implement 300, the control device 180 determines that it does not contact the work vehicle 100 and the implement 300. .
  • the control device 180 controls the wheels 104 (front wheels 104F and rear wheels 104R) of the work vehicle 100. Determine whether or not there will be contact. If the recess On3 is located at a position that does not interfere with the wheels 104, the control device 180 determines that the recess On3 does not come into contact with the work vehicle 100 and the implement 300. When the control device 180 is located at a position that interferes with the wheel 104 like the object Ob4, the control device 180 controls the width and depth of the recess On4, the size of the wheel 104, the height H22 of the implement 300 from the ground, and the work vehicle 100.
  • the control device 180 may determine that the recesses On1 to On4 do not contact the work vehicle 100.
  • the control device 180 determines the length L1X of the implement 300 and the coupling device. Information such as the length L2X of the instrument 108 in the front-rear direction and the offset length of the implement 300 in the left-right direction may be further acquired and used. In the examples of FIGS. 17A and 17B, the offset length of the implement 300 in the left-right direction is zero, but it is not limited thereto.
  • the control device 180 controls the automatic operation of the work vehicle 100 based on sensor data output from one or more sensing devices included in the work vehicle 100.
  • the work vehicle 100 senses the surrounding environment using one or more sensing devices possessed by another moving body such as an agricultural machine different from the work vehicle 100 or a drone (Unmanned Arial Vehicle: UAV). You may perform automatic operation while doing so.
  • the control device 180 may control the automatic operation of the work vehicle 100, for example, using sensor data acquired by a sensing device included in an agricultural machine different from the work vehicle 100 or in another mobile object such as a drone.
  • part or all of the processing executed by the control device 180 of the work vehicle 100 according to the present embodiment may be executed by another device.
  • Such other device functions as a control device of the control system according to the present embodiment, and may be, for example, any one of the management device 600 (processor 660), the terminal device 400 (processor 460), and the operation terminal 200.
  • the combination of the control device 180 and the management device 600 functions as a control device of the control system.
  • the control system is a control system for a work vehicle that performs automatic driving, and includes one or more sensors that sense the environment around the work vehicle 100 and output sensor data, and a control system based on the sensor data. and a control device that controls automatic operation of the work vehicle 100.
  • the control device executes the following (i) to (iii) when the work vehicle 100 performs automatic operation with the implement 300 connected to the work vehicle 100.
  • (i) Perform object detection and classification based on sensor data.
  • the second degree of influence shown is determined according to the classification result of the object. (iii) Depending on at least one of the first degree of influence and the second degree of influence, automatic operation of work vehicle 100 is continued without performing an operation to avoid contact with an object and an operation to avoid contact with an object. Execute one of the actions.
  • the control method is a control method for a work vehicle 100 that performs automatic driving, and includes: (I) Detecting and classifying objects based on sensor data output from one or more sensors included in work vehicle 100; (II) A first degree of influence indicating the magnitude of influence when the detected and classified object comes into contact with the work vehicle 100 and when the detected and classified object comes into contact with the implement 300 connected to the work vehicle 100 (III) determining a second degree of influence indicating the magnitude of influence in a case according to the classification result of the object, and (III) determining a contact with the object according to at least one of the first degree of influence and the second degree of influence; carrying out either an action to avoid contact with an object, or an action to continue automatic operation of work vehicle 100 without performing an action to avoid contact with an object; including.
  • the present disclosure includes the work vehicle, control method, and control system described in the following items.
  • a work vehicle that operates automatically, one or more sensors that sense the environment around the work vehicle and output sensor data; a control device that controls the automatic operation of the work vehicle based on the sensor data; a coupling device for coupling the implements; Equipped with When the control device performs the automatic operation with the implement connected to the work vehicle, performing object detection and classification based on the sensor data; A first degree of influence indicating the magnitude of influence when the object comes into contact with the work vehicle, and a second degree of influence indicating the magnitude of influence when the object comes into contact with the implement, are classified into the classification of the object. Decide according to the results, Depending on at least one of the first degree of influence and the second degree of influence, one of an operation to avoid contact with the object and an operation to continue the automatic driving without performing the avoidance operation is performed. do, work vehicle.
  • the control device includes: If the first degree of influence is smaller than a first reference value and the second degree of influence is smaller than a second reference value, continuing the automatic operation without performing the avoidance operation, If the first degree of influence is greater than or equal to the first reference value, or if the second degree of influence is greater than or equal to the second reference value, performing an action to avoid contact with the object; Work vehicle described in item 1.
  • the control device includes: Based on the detected position of the object, the size of the work vehicle, and the size of the implement, whether the object contacts the work vehicle and whether the object contacts the implement. Determine, If it is determined that the object contacts at least one of the work vehicle and the implement, an operation of avoiding contact with the object according to at least one of the first degree of influence and the second degree of influence; Executing either one of the operations to continue the automatic operation without performing the avoidance operation, Work vehicle described in item 1 or 2.
  • control device determines that the object contacts at least one of the work vehicle and the implement, the control device determines at least one of the first degree of influence and the second degree of influence according to a classification result of the object.
  • [Item 7] further comprising a storage device that stores a table including respective values of the first degree of influence and the second degree of influence for each classification of objects, The control device determines the first degree of influence and the second degree of influence based on the table and the classification result of the object.
  • the work vehicle is an agricultural machine,
  • the implement is a machine that performs agricultural work;
  • a method for controlling a work vehicle that performs automatic driving comprising: Detecting and classifying objects based on sensor data output from one or more sensors included in the work vehicle; a first degree of influence indicating the magnitude of influence when the object contacts the work vehicle; and a second degree of influence indicating the magnitude of influence when the object contacts an implement connected to the work vehicle. is determined according to a classification result of the object, and an action to avoid contact with the object and an action to avoid contact are performed according to at least one of the first degree of influence and the second degree of influence. performing either one of the operations to continue the automatic operation without control methods including.
  • a work vehicle that performs obstacle avoidance operations based on sensor data during automatic driving, a classification result of the object detected based on the sensor data; and a degree of influence according to the classification result of the object when the object contacts each of the work vehicle and an implement connected to the work vehicle; The work vehicle controls the obstacle avoidance operation based on the above.
  • a control system for a work vehicle that performs automatic driving, one or more sensors that sense the environment around the work vehicle and output sensor data; a control device that controls the automatic operation of the work vehicle based on the sensor data; Equipped with When the work vehicle performs the automatic operation with the implement connected to the work vehicle, the control device performing object detection and classification based on the sensor data; A first degree of influence indicating the magnitude of influence when the object comes into contact with the work vehicle, and a second degree of influence indicating the magnitude of influence when the object comes into contact with the implement, are classified into the classification of the object. Decide according to the results, Depending on at least one of the first degree of influence and the second degree of influence, one of an operation to avoid contact with the object and an operation to continue the automatic driving without performing the avoidance operation is performed. do, control system.

Landscapes

  • Life Sciences & Earth Sciences (AREA)
  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Soil Sciences (AREA)
  • Environmental Sciences (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

作業車両は、自動運転を行う作業車両であって、作業車両の周辺の環境をセンシングしてセンサデータを出力する１つ以上のセンサと、センサデータに基づいて作業車両の自動運転を制御する制御装置と、インプルメントを連結するための連結装置と、を備える。制御装置は、インプルメントが作業車両に連結されている状態で自動運転を行うとき、センサデータに基づいて、物体の検出および分類を実行し、物体が作業車両に接触した場合の影響の大きさを示す第１影響度、および物体がインプルメントに接触した場合の影響の大きさを示す第２影響度を、物体の分類結果に応じて決定し、第１影響度および第２影響度の少なくとも一方に応じて、物体との接触を回避する動作、および回避する動作を行わずに自動運転を継続する動作のいずれか一方を実行する。

Description

作業車両、制御方法および制御システム
　本開示は、自動運転を行う作業車両、自動運転を行う作業車両の制御方法、および、自動運転を行う作業車両のための制御システムに関する。
　農業機械の自動化に向けた研究開発が進められている。例えば、ＧＮＳＳ（Global Navigation Satellite System）などの測位システムを利用して圃場内を自動で走行するトラクタ、コンバイン、および田植機などの作業車両が実用化されている。圃場内だけでなく、圃場外でも自動で走行する作業車両の研究開発も進められている。特許文献１は、道路を挟んで互いに離れた２つの圃場間で無人の作業車両を自動走行させるシステムを開示している。特許文献２は、走行する道路の状態と、作業車両に連結されたインプルメントの状態とに基づいて、自動走行の制御が行われる作業車両を開示している。
特開２０２１－０２９２１８号公報 国際公開第２０２２／０３８８６０号
　自動運転による作業車両（農業機械を含む。）の走行が効率的に行われるよう制御することが求められている。
　本開示は、自動運転による走行を効率的に行うことができる作業車両、自動運転を行う作業車両の走行が効率的に行われるよう制御する方法、および、自動運転による作業車両の走行が効率的に行われるよう制御することができる制御システムを提供する。
　本開示の一態様による作業車両は、自動運転を行う作業車両であって、前記作業車両の周辺の環境をセンシングしてセンサデータを出力する１つ以上のセンサと、前記センサデータに基づいて前記作業車両の前記自動運転を制御する制御装置と、インプルメントを連結するための連結装置と、を備え、前記制御装置は、前記インプルメントが前記作業車両に連結されている状態で前記自動運転を行うとき、前記センサデータに基づいて、物体の検出および分類を実行し、前記物体が前記作業車両に接触した場合の影響の大きさを示す第１影響度、および前記物体が前記インプルメントに接触した場合の影響の大きさを示す第２影響度を、前記物体の分類結果に応じて決定し、前記第１影響度および前記第２影響度の少なくとも一方に応じて、前記物体との接触を回避する動作、および前記回避する動作を行わずに前記自動運転を継続する動作のいずれか一方を実行する。
　本開示の一態様による制御方法は、自動運転を行う作業車両の制御方法であって、前記作業車両が備える１つ以上のセンサから出力されたセンサデータに基づいて、物体の検出および分類を実行すること、前記物体が前記作業車両に接触した場合の影響の大きさを示す第１影響度、および前記物体が前記作業車両に連結されたインプルメントに接触した場合の影響の大きさを示す第２影響度を、前記物体の分類結果に応じて決定すること、および前記第１影響度および前記第２影響度の少なくとも一方に応じて、前記物体との接触を回避する動作、および前記回避する動作を行わずに前記自動運転を継続する動作のいずれか一方を実行すること、を含む制御方法。
　本開示の一態様による制御システムは、自動運転を行う作業車両のための制御システムであって、前記作業車両の周辺の環境をセンシングしてセンサデータを出力する１つ以上のセンサと、前記センサデータに基づいて前記作業車両の前記自動運転を制御する制御装置と、を備え、前記制御装置は、インプルメントが前記作業車両に連結されている状態で前記作業車両が前記自動運転を行うとき、前記センサデータに基づいて、物体の検出および分類を実行し、前記物体が前記作業車両に接触した場合の影響の大きさを示す第１影響度、および前記物体が前記インプルメントに接触した場合の影響の大きさを示す第２影響度を、前記物体の分類結果に応じて決定し、前記第１影響度および前記第２影響度の少なくとも一方に応じて、前記物体との接触を回避する動作、および前記回避する動作を行わずに前記自動運転を継続する動作のいずれか一方を実行する。
　本開示の包括的または具体的な態様は、装置、システム、方法、集積回路、コンピュータプログラム、もしくはコンピュータが読み取り可能な非一時的記憶媒体、またはこれらの任意の組み合わせによって実現され得る。コンピュータが読み取り可能な記憶媒体は、揮発性の記憶媒体を含んでいてもよいし、不揮発性の記憶媒体を含んでいてもよい。装置は、複数の装置で構成されていてもよい。装置が２つ以上の装置で構成される場合、当該２つ以上の装置は、１つの機器内に配置されてもよいし、分離した２つ以上の機器内に分かれて配置されていてもよい。
　本開示の実施形態によると、自動運転による走行を効率的に行うことができる作業車両、自動運転を行う作業車両の走行が効率的に行われるよう制御する方法、および、自動運転による作業車両の走行が効率的に行われるよう制御することができる制御システムが提供される。
本開示の例示的な実施形態による農業管理システムの概要を説明するための図である。 作業車両、および作業車両に連結されたインプルメントの例を模式的に示す側面図である。 作業車両およびインプルメントの構成例を示すブロック図である。 ＲＴＫ－ＧＮＳＳによる測位を行う作業車両の例を示す概念図である。 キャビンの内部に設けられる操作端末および操作スイッチ群の例を示す図である。 管理装置および端末装置のハードウェア構成を例示するブロック図である。 圃場内を目標経路に沿って自動で走行する作業車両の例を模式的に示す図である。 自動運転時の操舵制御の動作の例を示すフローチャートである。 目標経路Ｐに沿って走行する作業車両の例を示す図である。 目標経路Ｐから右にシフトした位置にある作業車両の例を示す図である。 目標経路Ｐから左にシフトした位置にある作業車両の例を示す図である。 目標経路Ｐに対して傾斜した方向を向いている作業車両の例を示す図である。 複数の作業車両が圃場の内部および圃場の外側の道を自動走行している状況の例を模式的に示す図である。 障害物が存在する環境で生成される大域的経路および局所的経路の一例を示す図である。 経路計画および走行制御の方法を示すフローチャートである。 作業車両が障害物回避動作を実行する手順の例を示すフローチャートである。 作業車両が有するＬｉＤＡＲセンサがセンシング可能な領域の例を模式的に示す図である。 作業車両が有するカメラがセンシング可能な領域の例を模式的に示す図である。 記憶装置に記憶される、物体の種別ごとの第１影響度および第２影響度を含むテーブルの例を示す図である。 作業車両が障害物回避動作を実行する手順の例を示すフローチャートである。 検出された物体が、作業車両およびインプルメントに接触するか否かを判定する方法を説明するための模式的な図である。 検出された物体が、作業車両およびインプルメントに接触するか否かを判定する方法を説明するための模式的な図である。
　（用語の定義）
　本開示において「農業機械」は、農業用途で使用される機械を意味する。農業機械の例は、トラクタ、収穫機、田植機、乗用管理機、野菜移植機、草刈機、播種機、施肥機、および農業用移動ロボットを含む。トラクタのような作業車両が単独で「農業機械」として機能する場合だけでなく、作業車両に装着または牽引される作業機（インプルメント）と作業車両の全体が１つの「農業機械」として機能する場合がある。農業機械は、圃場内の地面に対して、耕耘、播種、防除、施肥、作物の植え付け、または収穫などの農作業を行う。これらの農作業を「対地作業」または単に「作業」と称することがある。車両型の農業機械が農作業を行いながら走行することを「作業走行」と称することがある。
　「自動運転」は、運転者による手動操作によらず、制御装置の働きによって農業機械の移動を制御することを意味する。自動運転を行う農業機械は「自動運転農機」または「ロボット農機」と呼ばれることがある。自動運転中、農業機械の移動だけでなく、農作業の動作（例えば作業機の動作）も自動で制御されてもよい。農業機械が車両型の機械である場合、自動運転によって農業機械が走行することを「自動走行」と称する。制御装置は、農業機械の移動に必要な操舵、移動速度の調整、移動の開始および停止の少なくとも１つを制御し得る。作業機が装着された作業車両を制御する場合、制御装置は、作業機の昇降、作業機の動作の開始および停止などの動作を制御してもよい。自動運転による移動には、農業機械が所定の経路に沿って目的地に向かう移動のみならず、追尾目標に追従する移動も含まれ得る。自動運転を行う農業機械は、部分的にユーザの指示に基づいて移動してもよい。また、自動運転を行う農業機械は、自動運転モードに加えて、運転者の手動操作によって移動する手動運転モードで動作してもよい。手動によらず、制御装置の働きによって農業機械の操舵を行うことを「自動操舵」と称する。制御装置の一部または全部が農業機械の外部にあってもよい。農業機械の外部にある制御装置と農業機械との間では、制御信号、コマンド、またはデータなどの通信が行われ得る。自動運転を行う農業機械は、人がその農業機械の移動の制御に関与することなく、周囲の環境をセンシングしながら自律的に移動してもよい。自律的な移動が可能な農業機械は、無人で圃場内または圃場外（例えば道路）を走行することができる。自律移動中に、障害物の検出および障害物の回避動作を行ってもよい。
　「作業計画」は、農業機械によって実行される１つ以上の農作業の予定を定めるデータである。作業計画は、例えば、農業機械によって実行される農作業の順序および各農作業が行われる圃場を示す情報を含み得る。作業計画は、各農作業が行われる予定の日および時刻の情報を含んでいてもよい。各農作業が行われる予定の日および時刻の情報を含む作業計画を、特に「作業スケジュール」または単に「スケジュール」と称する。作業スケジュールは、各作業日に行われる各農作業の開始予定時刻および／または終了予定時刻の情報を含み得る。作業計画あるいは作業スケジュールは、農作業ごとに、作業の内容、使用されるインプルメント、および／または、使用される農業資材の種類および分量などの情報を含んでいてもよい。ここで「農業資材」とは、農業機械が行う農作業で使用される物資を意味する。農業資材を単に「資材」と呼ぶことがある。農業資材は、例えば農薬、肥料、種、または苗などの、農作業によって消費される物資を含み得る。作業計画は、農業機械と通信して農作業を管理する処理装置、または農業機械に搭載された処理装置によって作成され得る。処理装置は、例えば、ユーザ（農業経営者または農作業者など）が端末装置を操作して入力した情報に基づいて作業計画を作成することができる。本明細書において、農業機械と通信して農作業を管理する処理装置を「管理装置」と称する。管理装置は、複数の農業機械の農作業を管理してもよい。その場合、管理装置は、複数の農業機械の各々が実行する各農作業に関する情報を含む作業計画を作成してもよい。作業計画は、各農業機械によってダウンロードされ、記憶装置に格納され得る。各農業機械は、作業計画に従って、予定された農作業を実行するために、自動で圃場に向かい、農作業を実行することができる。
　「環境地図」は、農業機械が移動する環境に存在する物の位置または領域を所定の座標系によって表現したデータである。環境地図を単に「地図」または「地図データ」と称することがある。環境地図を規定する座標系は、例えば、地球に対して固定された地理座標系などのワールド座標系であり得る。環境地図は、環境に存在する物について、位置以外の情報（例えば、属性情報その他の情報）を含んでいてもよい。環境地図は、点群地図または格子地図など、さまざまな形式の地図を含む。環境地図を構築する過程で生成または処理される局所地図または部分地図のデータについても、「地図」または「地図データ」と呼ぶ。
　「農道」は、主に農業目的で利用される道を意味する。農道は、アスファルトで舗装された道に限らず、土または砂利等で覆われた未舗装の道も含む。農道は、車両型の農業機械（例えばトラクタ等の作業車両）のみが専ら通行可能な道（私道を含む）と、一般の車両（乗用車、トラック、バス等）も通行可能な道路とを含む。作業車両は、農道に加えて一般道を自動で走行してもよい。一般道は、一般の車両の交通のために整備された道路である。
　「地物」は、地上に存在する物を意味する。地物の例は、水路、草、木、道、圃場、溝、川、橋、林、山、岩石、建物、線路などを含む。境界線、地名、建物名、圃場名、路線名といった実世界に存在しないものは本開示における「地物」に含まれない。
　「ＧＮＳＳ衛星」は、全球測位衛星システム（ＧＮＳＳ）における人工衛星を意味する。ＧＮＳＳは、ＧＰＳ（Global Positioning System）、ＱＺＳＳ（Quasi-Zenith Satellite System）、ＧＬＯＮＡＳＳ、Ｇａｌｉｌｅｏ、およびＢｅｉＤｏｕなどの衛星測位システムの総称である。ＧＮＳＳ衛星は、これらの測位システムにおける衛星である。ＧＮＳＳ衛星から送信される信号を「衛星信号」と称する。「ＧＮＳＳ受信機」は、ＧＮＳＳにおける複数の衛星から送信される電波を受信し、当該電波に重畳された信号に基づいて測位を行う装置である。「ＧＮＳＳデータ」は、ＧＮＳＳ受信機から出力されるデータである。ＧＮＳＳデータは、例えばＮＭＥＡ－０１８３フォーマットなどの所定のフォーマットで生成され得る。ＧＮＳＳデータは、例えば、個々の衛星から受信した衛星信号の受信状況を示す情報を含み得る。例えば、ＧＮＳＳデータは、衛星信号が受信されたそれぞれの衛星の識別番号、仰角、方位角、および受信強度を示す値を含み得る。受信強度は、受信された衛星信号の強度を示す数値である。受信強度は、例えば搬送波雑音電力密度比（Carrier to Noise Density Ratio：Ｃ／Ｎ０）などの値で表現され得る。ＧＮＳＳデータは、受信された複数の衛星信号に基づいて計算されたＧＮＳＳ受信機または農業機械の位置情報を含み得る。位置情報は、例えば緯度、経度、および平均海水面からの高さなどによって表され得る。ＧＮＳＳデータは、さらに、位置情報の信頼性を示す情報を含んでいてもよい。
　「衛星信号を正常に受信できる」とは、測位の信頼性が大きく低下しない程度に安定して衛星信号を受信できることを意味する。衛星信号を正常に受信できないことを「衛星信号の受信障害」が生じていると表現することがある。「衛星信号の受信障害」は、衛星信号の受信状況の悪化によって正常時と比較して測位の信頼性が低下している状態である。受信障害は、例えば、検出された衛星の数が少ない場合（例えば３以下など）、各衛星信号の受信強度が低い場合、またはマルチパスが生じている場合などに生じ得る。受信障害が生じているか否かは、例えばＧＮＳＳデータに含まれる衛星に関する情報に基づいて判断され得る。例えば、ＧＮＳＳデータに含まれる衛星ごとの受信強度の値、または衛星の配置状況を示すＤＯＰ（Dilution of Precision）の値などに基づいて、受信障害の有無を判断することができる。
　「大域的経路」（global path）は、経路計画を行う処理装置によって生成される、農業機械が自動で移動するときの出発地点から目的地点までを結ぶ経路のデータを意味する。大域的経路を生成することを大域的経路計画（global path planning）または大域的経路設計と称する。以下の説明において、大域的経路を「目標経路」または単に「経路」とも称する。大域的経路は、例えば、農業機械が通過すべき複数の点の座標値によって規定され得る。農業機械が通過すべき点を「ウェイポイント」と称し、隣り合うウェイポイント間を結ぶ線分を「リンク」と称する。
　「局所的経路」（local path）は、大域的経路に沿って農業機械が自動で移動するときに逐次生成される、障害物を回避可能な局所的な経路を意味する。局所的経路を生成することを局所的経路計画（local path planning）または局所的経路設計と称する。局所的経路は、農業機械が移動している間に、農業機械が備える１つ以上のセンシング装置によって取得されたデータに基づいて逐次生成される。局所的経路は、大域的経路の一部に沿った複数のウェイポイントによって規定され得る。ただし、大域的経路の付近に障害物が存在する場合、その障害物を迂回するようにウェイポイントが設定され得る。局所的経路におけるウェイポイント間のリンクの長さは、大域的経路におけるウェイポイント間のリンクの長さよりも短い。局所的経路を生成する装置は、大域的経路を生成する装置と同一でもよいし、異なっていてもよい。例えば、農業機械による農作業を管理する管理装置が大域的経路を生成し、農業機械に搭載された制御装置が局所的経路を生成してもよい。その場合、管理装置と制御装置との組み合わせが、経路計画を行う「処理装置」として機能する。農業機械の制御装置が、大域的経路設計および局所的経路設計の両方を行う処理装置として機能してもよい。
　「保管場所」は、農業機械を保管するために設けられる場所である。保管場所は、例えば、農業機械のユーザが管理する場所、または複数のユーザが共同で運営する場所であり得る。保管場所は、例えば、ユーザ（農業従事者など）の自宅もしくは事業所における倉庫、納屋、または駐車場などの、農業機械の保管のために確保された場所であり得る。保管場所の位置は、予め登録され、記憶装置に記録され得る。
　「待機場所」は、農業機械が農作業を行わない間、待機するために設けられる場所である。農業機械が自動運転を行う環境中に、１つ以上の待機場所が設けられ得る。上記の保管場所は、待機場所の一例である。待機場所は、複数のユーザが共同で管理または使用する場所であってもよい。待機場所は、例えば、倉庫、車庫、納屋、駐車場、またはその他の施設であり得る。待機場所は、農業機械のユーザとは異なる農業従事者の自宅または事業所における倉庫、納屋、車庫、または駐車場であってもよい。農業機械が移動する環境中に複数の待機場所が点在していてもよい。待機場所において、農業機械の部品もしくはインプルメントの交換もしくはメンテナンス、または資材の補充などの作業が行われてもよい。その場合、待機場所には、それらの作業に必要な部品、工具類、または資材が配置され得る。
　（実施形態）
　以下、本開示の実施形態を説明する。ただし、必要以上に詳細な説明は省略することがある。例えば、既によく知られた事項の詳細な説明および実質的に同一の構成に関する重複する説明を省略することがある。これは、以下の説明が不必要に冗長になることを避け、当業者の理解を容易にするためである。なお、発明者は、当業者が本開示を十分に理解するために添付図面および以下の説明を提供するのであって、これらによって特許請求の範囲に記載の主題を限定することを意図するものではない。以下の説明において、同一または類似の機能を有する構成要素については、同一の参照符号を付している。
　本開示の包括的または具体的な態様は、装置、システム、方法、集積回路、コンピュータプログラム、もしくはコンピュータが読み取り可能な非一時的記憶媒体、またはこれらの任意の組み合わせによって実現され得る。コンピュータが読み取り可能な記憶媒体は、揮発性の記憶媒体を含んでいてもよいし、不揮発性の記憶媒体を含んでいてもよい。装置は、複数の装置で構成されていてもよい。装置が２つ以上の装置で構成される場合、当該２つ以上の装置は、１つの機器内に配置されてもよいし、分離した２つ以上の機器内に分かれて配置されていてもよい。
　以下の実施形態は例示であり、本開示の技術は以下の実施形態に限定されない。例えば、以下の実施形態で示される数値、形状、材料、ステップ、ステップの順序、表示画面のレイアウトなどは、あくまでも一例であり、技術的に矛盾が生じない限りにおいて種々の改変が可能である。また、技術的に矛盾が生じない限りにおいて、一の態様と他の態様とを組み合わせることが可能である。
　以下、農業機械の一例であるトラクタなどの作業車両に本開示の技術を適用した実施形態を主に説明する。本開示の技術は、トラクタなどの作業車両に限らず、他の種類の農業機械にも適用することができる。
　図１は、本開示の例示的な実施形態による農業管理システムの概要を説明するための図である。図１に示す農業管理システムは、作業車両１００と、端末装置４００と、管理装置６００とを備える。端末装置４００は、作業車両１００を遠隔で監視するユーザが使用するコンピュータである。管理装置６００は、農業管理システムを運営する事業者が管理するコンピュータである。作業車両１００、端末装置４００、および管理装置６００は、ネットワーク８０を介して互いに通信することができる。図１には１台の作業車両１００が例示されているが、農業管理システムは、複数の作業車両またはその他の農業機械を含んでいてもよい。
　本実施形態における作業車両１００はトラクタである。作業車両１００は、後部および前部の一方または両方にインプルメントを装着することができる。作業車両１００は、インプルメントの種類に応じた農作業を行いながら圃場内を走行することができる。作業車両１００は、インプルメントを装着しない状態で圃場内または圃場外を走行してもよい。
　作業車両１００は、自動運転機能を備える。すなわち、作業車両１００は、手動によらず、制御装置の働きによって走行することができる。本実施形態における制御装置は、作業車両１００の内部に設けられ、作業車両１００の速度および操舵の両方を制御することができる。作業車両１００は、圃場内に限らず、圃場外（例えば道路）を自動走行することもできる。
　作業車両１００は、ＧＮＳＳ受信機およびＬｉＤＡＲセンサなどの、測位あるいは自己位置推定のために利用される装置を備える。作業車両１００の制御装置は、作業車両１００の位置と、管理装置６００によって生成された目標経路の情報とに基づいて、作業車両１００を自動で走行させる。制御装置は、作業車両１００の走行制御に加えて、インプルメントの動作の制御も行う。これにより、作業車両１００は、圃場内を自動で走行しながらインプルメントを用いて農作業を実行することができる。さらに、作業車両１００は、圃場外の道（例えば、農道または一般道）を目標経路に沿って自動で走行することができる。作業車両１００は、圃場外の道に沿って自動走行を行うとき、カメラまたはＬｉＤＡＲセンサなどのセンシング装置から出力されるデータに基づいて、障害物を回避可能な局所的経路を目標経路に沿って生成しながら走行する。作業車両１００は、圃場内においては、上記と同様に局所的経路を生成しながら走行してもよいし、局所的経路を生成せずに目標経路に沿って走行し、障害物が検出された場合に停止する、という動作を行ってもよい。
　管理装置６００は、作業車両１００による農作業を管理するコンピュータである。管理装置６００は、例えば圃場に関する情報をクラウド上で一元管理し、クラウド上のデータを活用して農業を支援するサーバコンピュータであり得る。管理装置６００は、例えば、作業車両１００の作業計画を作成し、その作業計画に従って、作業車両１００の目標経路を生成することができる。あるいは、管理装置６００は、ユーザによる端末装置４００を用いた操作に応答して、作業車両１００の目標経路を生成してもよい。以下、特に断らない限り、管理装置６００が生成する作業車両１００の目標経路（すなわち大域的経路）を単に「経路」と称する。
　管理装置６００は、圃場内と圃場外とで異なる方法で目標経路を生成する。管理装置６００は、圃場内の目標経路を、圃場に関する情報に基づいて生成する。例えば、管理装置６００は、予め登録された圃場の外形、圃場の面積、圃場の出入口の位置、作業車両１００の幅、インプルメントの幅、作業の内容、栽培される作物の種類、作物の生育領域、作物の生育状況、または作物列もしくは畝の間隔などの、種々の情報に基づいて圃場内の目標経路を生成することができる。管理装置６００は、例えば、ユーザが端末装置４００または他のデバイスを用いて入力した情報に基づいて圃場内の目標経路を生成する。管理装置６００は、圃場内の経路を、例えば作業が行われる作業領域の全体をカバーするように生成する。一方、管理装置６００は、圃場外の目標経路を、作業計画またはユーザの指示に従って生成する。例えば、管理装置６００は、作業計画が示す農作業の順序、各農作業が行われる圃場の位置、圃場の出入口の位置、各農作業の開始予定時刻および終了予定時刻、地図に記録された各道の属性情報、路面状態、気象状況、または交通状況などの、種々の情報に基づいて圃場外の目標経路を生成することができる。管理装置６００は、作業計画によらず、ユーザが端末装置４００を操作して指定した経路または経由地点を示す情報に基づいて目標経路を生成してもよい。
　管理装置６００は、さらに、作業車両１００または他の移動体がＬｉＤＡＲセンサなどのセンシング装置を用いて収集したデータに基づいて、環境地図の生成および編集を行ってもよい。管理装置６００は、生成した作業計画、目標経路、および環境地図のデータを作業車両１００に送信する。作業車両１００は、それらのデータに基づいて、移動および農作業を自動で行う。
　なお、大域的経路設計および環境地図の生成（または編集）は、管理装置６００に限らず、他の装置が行ってもよい。例えば、作業車両１００の制御装置が、大域的経路設計または環境地図の生成もしくは編集を行ってもよい。
　端末装置４００は、作業車両１００から離れた場所にいるユーザが使用するコンピュータである。図１に示す端末装置４００はラップトップコンピュータであるが、これに限定されない。端末装置４００は、デスクトップＰＣ（personal computer）などの据え置き型のコンピュータであってもよいし、スマートフォンまたはタブレットコンピュータなどのモバイル端末でもよい。端末装置４００は、作業車両１００を遠隔監視したり、作業車両１００を遠隔操作したりするために用いられ得る。例えば、端末装置４００は、作業車両１００が備える１台以上のカメラ（撮像装置）が撮影した映像をディスプレイに表示させることができる。ユーザは、その映像を見て、作業車両１００の周囲の状況を確認し、作業車両１００に停止または発進の指示を送ることができる。端末装置４００は、さらに、作業車両１００の作業計画（例えば各農作業のスケジュール）を作成するために必要な情報をユーザが入力するための設定画面をディスプレイに表示することもできる。ユーザが設定画面上で必要な情報を入力し送信の操作を行うと、端末装置４００は、入力された情報を管理装置６００に送信する。管理装置６００は、その情報に基づいて作業計画を作成する。端末装置４００は、作業車両１００が農作業を実行する１つ以上の圃場、作業車両１００の保管場所、および作業車両１００が一時的に待機する１つ以上の待機場所の登録にも使用され得る。端末装置４００は、さらに、目標経路を設定するために必要な情報をユーザが入力するための設定画面をディスプレイに表示する機能を備えていてもよい。
　以下、本実施形態におけるシステムの構成および動作をより詳細に説明する。
　［１．構成］
　図２は、作業車両１００、および作業車両１００に連結された作業機３００の例を模式的に示す側面図である。本実施形態における作業車両１００は、手動運転モードと自動運転モードの両方で動作することができる。自動運転モードにおいて、作業車両１００は無人で走行することができる。作業車両１００は、圃場内と圃場外の両方で自動運転が可能である。
　図２に示すように、作業車両１００は、車両本体１０１と、原動機（エンジン）１０２と、変速装置（トランスミッション）１０３とを備える。車両本体１０１には、タイヤ付きの車輪１０４と、キャビン１０５とが設けられている。車輪１０４は、一対の前輪１０４Ｆと一対の後輪１０４Ｒとを含む。キャビン１０５の内部に運転席１０７、操舵装置１０６、操作端末２００、および操作のためのスイッチ群が設けられている。作業車両１００が圃場内で作業走行を行うとき、前輪１０４Ｆおよび後輪１０４Ｒの一方または両方は、タイヤ付き車輪ではなく無限軌道（track）を装着した複数の車輪（クローラ）に置き換えられてもよい。
　作業車両１００は、作業車両１００の周囲の環境をセンシングする少なくとも１つのセンシング装置を備える。図２に示す例では、作業車両１００は複数のセンシング装置を備える。センシング装置は、複数のカメラ１２０と、ＬｉＤＡＲセンサ１４０と、複数の障害物センサ１３０とを含む。
　カメラ１２０は、例えば作業車両１００の前後左右に設けられ得る。カメラ１２０は、作業車両１００の周囲の環境を撮影し、画像データを生成する。カメラ１２０が取得した画像は、遠隔監視を行うための端末装置４００に送信され得る。当該画像は、無人運転時に作業車両１００を監視するために用いられ得る。カメラ１２０は、作業車両１００が圃場外の道（農道または一般道）を走行するときに、周辺の地物もしくは障害物、白線、標識、または表示などを認識するための画像を生成する用途でも使用され得る。
　図２の例におけるＬｉＤＡＲセンサ１４０は、車両本体１０１の前面下部に配置されている。ＬｉＤＡＲセンサ１４０は、他の位置に設けられていてもよい。例えばＬｉＤＡＲセンサ１４０は、キャビン１０５の上部に設けられていてもよい。ＬｉＤＡＲセンサ１４０は、３Ｄ－ＬｉＤＡＲセンサであり得るが、２Ｄ－ＬｉＤＡＲセンサであってもよい。ＬｉＤＡＲセンサ１４０は、作業車両１００の周辺の環境をセンシングして、センシングデータを出力する。ＬｉＤＡＲセンサ１４０は、作業車両１００が走行している間、周囲の環境に存在する物体の各計測点までの距離および方向、または各計測点の２次元もしくは３次元の座標値を示すセンサデータを繰り返し出力する。ＬｉＤＡＲセンサ１４０から出力されたセンサデータは、作業車両１００の制御装置によって処理される。制御装置は、センサデータと、環境地図とのマッチングにより、作業車両１００の自己位置推定を行うことができる。制御装置は、さらに、センサデータに基づいて、作業車両１００の周辺に存在する障害物などの物体を検出することができる。制御装置は、例えばＳＬＡＭ（Simultaneous Localization and Mapping）などのアルゴリズムを利用して、環境地図を生成または編集することもできる。作業車両１００は、異なる位置に異なる向きで配置された複数のＬｉＤＡＲセンサを備えていてもよい。
　図２に示す複数の障害物センサ１３０は、キャビン１０５の前部および後部に設けられている。障害物センサ１３０は、他の部位にも配置され得る。例えば、車両本体１０１の側部、前部、および後部の任意の位置に、１または複数の障害物センサ１３０が設けられ得る。障害物センサ１３０は、例えばレーザスキャナまたは超音波ソナーを含み得る。障害物センサ１３０は、自動走行時に周囲の障害物を検出して作業車両１００を停止したり迂回したりするために用いられる。ＬｉＤＡＲセンサ１４０が障害物センサ１３０の１つとして利用されてもよい。
　作業車両１００は、さらに、ＧＮＳＳユニット１１０を備える。ＧＮＳＳユニット１１０は、ＧＮＳＳ受信機を含む。ＧＮＳＳ受信機は、ＧＮＳＳ衛星からの信号を受信するアンテナと、アンテナが受信した信号に基づいて作業車両１００の位置を計算するプロセッサとを備え得る。ＧＮＳＳユニット１１０は、複数のＧＮＳＳ衛星から送信される衛星信号を受信し、衛星信号に基づいて測位を行う。ＧＮＳＳは、ＧＰＳ（Global Positioning System）、ＱＺＳＳ（Quasi-Zenith Satellite System、例えばみちびき）、ＧＬＯＮＡＳＳ、Ｇａｌｉｌｅｏ、およびＢｅｉＤｏｕなどの衛星測位システムの総称である。本実施形態におけるＧＮＳＳユニット１１０は、キャビン１０５の上部に設けられているが、他の位置に設けられていてもよい。
　ＧＮＳＳユニット１１０は、慣性計測装置（ＩＭＵ）を含み得る。ＩＭＵからの信号を利用して位置データを補完することができる。ＩＭＵは、作業車両１００の傾きおよび微小な動きを計測することができる。ＩＭＵによって取得されたデータを用いて、衛星信号に基づく位置データを補完することにより、測位の性能を向上させることができる。
　作業車両１００の制御装置は、ＧＮＳＳユニット１１０による測位結果に加えて、カメラ１２０またはＬｉＤＡＲセンサ１４０などのセンシング装置が取得したセンシングデータを測位に利用してもよい。農道、林道、一般道、または果樹園のように、作業車両１００が走行する環境内に特徴点として機能する地物が存在する場合、カメラ１２０またはＬｉＤＡＲセンサ１４０によって取得されたデータと、予め記憶装置に格納された環境地図とに基づいて、作業車両１００の位置および向きを高い精度で推定することができる。カメラ１２０またはＬｉＤＡＲセンサ１４０が取得したデータを用いて、衛星信号に基づく位置データを補正または補完することで、より高い精度で作業車両１００の位置を特定できる。
　原動機１０２は、例えばディーゼルエンジンであり得る。ディーゼルエンジンに代えて電動モータが使用されてもよい。変速装置１０３は、変速によって作業車両１００の推進力および移動速度を変化させることができる。変速装置１０３は、作業車両１００の前進と後進とを切り換えることもできる。
　操舵装置１０６は、ステアリングホイールと、ステアリングホイールに接続されたステアリングシャフトと、ステアリングホイールによる操舵を補助するパワーステアリング装置とを含む。前輪１０４Ｆは操舵輪であり、その切れ角（「操舵角」とも称する。）を変化させることにより、作業車両１００の走行方向を変化させることができる。前輪１０４Ｆの操舵角は、ステアリングホイールを操作することによって変化させることができる。パワーステアリング装置は、前輪１０４Ｆの操舵角を変化させるための補助力を供給する油圧装置または電動モータを含む。自動操舵が行われるときには、作業車両１００内に配置された制御装置からの制御により、油圧装置または電動モータの力によって操舵角が自動で調整される。
　車両本体１０１の後部には、連結装置１０８が設けられている。連結装置１０８は、例えば３点支持装置（「３点リンク」または「３点ヒッチ」とも称する。）、ＰＴＯ（Power Take Off）軸、ユニバーサルジョイント、および通信ケーブルを含む。連結装置１０８によって作業機３００を作業車両１００に着脱することができる。連結装置１０８は、例えば油圧装置によって３点リンクを昇降させ、作業機３００の位置または姿勢を変化させることができる。また、ユニバーサルジョイントを介して作業車両１００から作業機３００に動力を送ることができる。作業車両１００は、作業機３００を引きながら、作業機３００に所定の作業を実行させることができる。連結装置は、車両本体１０１の前部に設けられていてもよい。その場合、作業車両１００の前部にインプルメントを接続することができる。
　図２に示す作業機３００は、ロータリ耕耘機であるが、作業機３００はロータリ耕耘機に限定されない。例えば、シーダ（播種機）、スプレッダ（施肥機）、移植機、モーア（草刈機）、レーキ、ベーラ（集草機）、ハーベスタ（収穫機）、スプレイヤ、またはハローなどの、任意のインプルメントを作業車両１００に接続して使用することができる。
　図２に示す作業車両１００は、有人運転が可能であるが、無人運転のみに対応していてもよい。その場合には、キャビン１０５、操舵装置１０６、および運転席１０７などの、有人運転にのみ必要な構成要素は、作業車両１００に設けられていなくてもよい。無人の作業車両１００は、自律走行、またはユーザによる遠隔操作によって走行することができる。
　図３は、作業車両１００および作業機３００の構成例を示すブロック図である。作業車両１００と作業機３００は、連結装置１０８に含まれる通信ケーブルを介して互いに通信することができる。作業車両１００は、ネットワーク８０を介して、端末装置４００および管理装置６００と通信することができる。
　図３の例における作業車両１００は、ＧＮＳＳユニット１１０、カメラ１２０、障害物センサ１３０、ＬｉＤＡＲセンサ１４０および操作端末２００に加え、作業車両１００の動作状態を検出するセンサ群１５０、制御システム１６０、通信装置１９０、操作スイッチ群２１０、ブザー２２０、および駆動装置２４０を備える。これらの構成要素は、バスを介して相互に通信可能に接続される。ＧＮＳＳユニット１１０は、ＧＮＳＳ受信機１１１と、ＲＴＫ受信機１１２と、慣性計測装置（ＩＭＵ）１１５と、処理回路１１６とを備える。センサ群１５０は、ステアリングホイールセンサ１５２と、切れ角センサ１５４、車軸センサ１５６とを含む。制御システム１６０は、記憶装置１７０と、制御装置１８０とを備える。制御装置１８０は、複数の電子制御ユニット（ＥＣＵ）１８１から１８６を備える。作業機３００は、駆動装置３４０と、制御装置３８０と、通信装置３９０とを備える。なお、図３には、作業車両１００による自動運転の動作との関連性が相対的に高い構成要素が示されており、それ以外の構成要素の図示は省略されている。
　ＧＮＳＳユニット１１０におけるＧＮＳＳ受信機１１１は、複数のＧＮＳＳ衛星から送信される衛星信号を受信し、衛星信号に基づいてＧＮＳＳデータを生成する。ＧＮＳＳデータは、例えばＮＭＥＡ－０１８３フォーマットなどの所定のフォーマットで生成される。ＧＮＳＳデータは、例えば、衛星信号が受信されたそれぞれの衛星の識別番号、仰角、方位角、および受信強度を示す値を含み得る。受信強度は、例えば搬送波雑音電力密度比（Ｃ／Ｎ０）などの値で表現され得る。ＧＮＳＳデータは、受信された複数の衛星信号に基づいて計算された作業車両１００の位置情報、および当該位置情報の信頼性を示す情報も含み得る。位置情報は、例えば緯度、経度、および平均海水面からの高さなどによって表され得る。位置情報の信頼性は、例えば衛星の配置状況を示すＤＯＰ値などによって表され得る。
　図３に示すＧＮＳＳユニット１１０は、ＲＴＫ（Real Time Kinematic）－ＧＮＳＳを利用して作業車両１００の測位を行う。図４は、ＲＴＫ－ＧＮＳＳによる測位を行う作業車両１００の例を示す概念図である。ＲＴＫ－ＧＮＳＳによる測位では、複数のＧＮＳＳ衛星５０から送信される衛星信号に加えて、基準局６０から送信される補正信号が利用される。基準局６０は、作業車両１００が作業走行を行う圃場の付近（例えば、作業車両１００から１０ｋｍ以内の位置）に設置され得る。基準局６０は、複数のＧＮＳＳ衛星５０から受信した衛星信号に基づいて、例えばＲＴＣＭフォーマットの補正信号を生成し、ＧＮＳＳユニット１１０に送信する。ＲＴＫ受信機１１２は、アンテナおよびモデムを含み、基準局６０から送信される補正信号を受信する。ＧＮＳＳユニット１１０の処理回路１１６は、補正信号に基づき、ＧＮＳＳ受信機１１１による測位結果を補正する。ＲＴＫ－ＧＮＳＳを用いることにより、例えば誤差数ｃｍの精度で測位を行うことが可能である。緯度、経度、および高度の情報を含む位置情報が、ＲＴＫ－ＧＮＳＳによる高精度の測位によって取得される。ＧＮＳＳユニット１１０は、例えば１秒間に１回から１０回程度の頻度で、作業車両１００の位置を計算する。
　なお、測位方法はＲＴＫ－ＧＮＳＳに限らず、必要な精度の位置情報が得られる任意の測位方法（干渉測位法または相対測位法など）を用いることができる。例えば、ＶＲＳ（Virtual Reference Station）またはＤＧＰＳ（Differential Global Positioning System）を利用した測位を行ってもよい。基準局６０から送信される補正信号を用いなくても必要な精度の位置情報が得られる場合は、補正信号を用いずに位置情報を生成してもよい。その場合、ＧＮＳＳユニット１１０は、ＲＴＫ受信機１１２を備えていなくてもよい。
　ＲＴＫ－ＧＮＳＳを利用する場合であっても、基準局６０からの補正信号が得られない場所（例えば圃場から遠く離れた道路上）では、ＲＴＫ受信機１１２からの信号によらず、他の方法で作業車両１００の位置が推定される。例えば、ＬｉＤＡＲセンサ１４０および／またはカメラ１２０から出力されたデータと、高精度の環境地図とのマッチングによって、作業車両１００の位置が推定され得る。
　本実施形態におけるＧＮＳＳユニット１１０は、さらにＩＭＵ１１５を備える。ＩＭＵ１１５は、３軸加速度センサおよび３軸ジャイロスコープを備え得る。ＩＭＵ１１５は、３軸地磁気センサなどの方位センサを備えていてもよい。ＩＭＵ１１５は、モーションセンサとして機能し、作業車両１００の加速度、速度、変位、および姿勢などの諸量を示す信号を出力することができる。処理回路１１６は、衛星信号および補正信号に加えて、ＩＭＵ１１５から出力された信号に基づいて、作業車両１００の位置および向きをより高い精度で推定することができる。ＩＭＵ１１５から出力された信号は、衛星信号および補正信号に基づいて計算される位置の補正または補完に用いられ得る。ＩＭＵ１１５は、ＧＮＳＳ受信機１１１よりも高い頻度で信号を出力する。その高頻度の信号を利用して、処理回路１１６は、作業車両１００の位置および向きをより高い頻度（例えば、１０Ｈｚ以上）で計測することができる。ＩＭＵ１１５に代えて、３軸加速度センサおよび３軸ジャイロスコープを別々に設けてもよい。ＩＭＵ１１５は、ＧＮＳＳユニット１１０とは別の装置として設けられていてもよい。
　カメラ１２０は、作業車両１００の周囲の環境を撮影する撮像装置である。カメラ１２０は、例えば、ＣＣＤ（Charge Coupled Device）またはＣＭＯＳ（Complementary Metal Oxide Semiconductor）などのイメージセンサを備える。カメラ１２０は、他にも、１つ以上のレンズを含む光学系、および信号処理回路を備え得る。カメラ１２０は、作業車両１００の走行中、作業車両１００の周囲の環境を撮影し、画像（例えば動画）のデータを生成する。カメラ１２０は、例えば、３フレーム／秒（ｆｐｓ: frames per second）以上のフレームレートで動画を撮影することができる。カメラ１２０によって生成された画像は、例えば遠隔の監視者が端末装置４００を用いて作業車両１００の周囲の環境を確認するときに利用され得る。カメラ１２０によって生成された画像は、測位または障害物の検出に利用されてもよい。図２に示すように、複数のカメラ１２０が作業車両１００の異なる位置に設けられていてもよいし、単数のカメラが設けられていてもよい。可視光画像を生成する可視カメラと、赤外線画像を生成する赤外カメラとが別々に設けられていてもよい。可視カメラと赤外カメラの両方が監視用の画像を生成するカメラとして設けられていてもよい。赤外カメラは、夜間において障害物の検出にも用いられ得る。
　障害物センサ１３０は、作業車両１００の周囲に存在する物体を検出する。障害物センサ１３０は、例えばレーザスキャナまたは超音波ソナーを含み得る。障害物センサ１３０は、障害物センサ１３０から所定の距離よりも近くに物体が存在する場合に、障害物が存在することを示す信号を出力する。複数の障害物センサ１３０が作業車両１００の異なる位置に設けられていてもよい。例えば、複数のレーザスキャナと、複数の超音波ソナーとが、作業車両１００の異なる位置に配置されていてもよい。そのような多くの障害物センサ１３０を備えることにより、作業車両１００の周囲の障害物の監視における死角を減らすことができる。
　ステアリングホイールセンサ１５２は、作業車両１００のステアリングホイールの回転角を計測する。切れ角センサ１５４は、操舵輪である前輪１０４Ｆの切れ角を計測する。ステアリングホイールセンサ１５２および切れ角センサ１５４による計測値は、制御装置１８０による操舵制御に利用される。
　車軸センサ１５６は、車輪１０４に接続された車軸の回転速度、すなわち単位時間あたりの回転数を計測する。車軸センサ１５６は、例えば磁気抵抗素子（ＭＲ）、ホール素子、または電磁ピックアップを利用したセンサであり得る。車軸センサ１５６は、例えば、車軸の１分あたりの回転数（単位：ｒｐｍ）を示す数値を出力する。車軸センサ１５６は、作業車両１００の速度を計測するために使用される。
　駆動装置２４０は、前述の原動機１０２、変速装置１０３、操舵装置１０６、および連結装置１０８などの、作業車両１００の走行および作業機３００の駆動に必要な各種の装置を含む。原動機１０２は、例えばディーゼル機関などの内燃機関を備え得る。駆動装置２４０は、内燃機関に代えて、あるいは内燃機関とともに、トラクション用の電動モータを備えていてもよい。
　ブザー２２０は、異常を報知するための警告音を発する音声出力装置である。ブザー２２０は、例えば、自動運転時に、障害物が検出された場合に警告音を発する。ブザー２２０は、制御装置１８０によって制御される。
　記憶装置１７０は、フラッシュメモリまたは磁気ディスクなどの１つ以上の記憶媒体を含む。記憶装置１７０は、ＧＮＳＳユニット１１０、カメラ１２０、障害物センサ１３０、ＬｉＤＡＲセンサ１４０、センサ群１５０、および制御装置１８０が生成する各種のデータを記憶する。記憶装置１７０が記憶するデータには、作業車両１００が走行する環境内の地図データ（環境地図）、および自動運転のための大域的経路（目標経路）のデータが含まれ得る。環境地図は、作業車両１００が農作業を行う複数の圃場およびその周辺の道の情報を含む。環境地図および目標経路は、管理装置６００における処理装置（プロセッサ）によって生成され得る。なお、制御装置１８０が、環境地図および目標経路を生成または編集する機能を備えていてもよい。制御装置１８０は、管理装置６００から取得した環境地図および目標経路を、作業車両１００の走行環境に応じて編集することができる。記憶装置１７０は、通信装置１９０が管理装置６００から受信した作業計画のデータも記憶する。
　作業計画は、複数の作業日にわたって作業車両１００が実行する複数の農作業に関する情報を含む。作業計画は、例えば、各作業日において作業車両１００が実行する各農作業の予定時刻の情報を含む作業スケジュールのデータであり得る。
　記憶装置１７０は、制御装置１８０における各ＥＣＵに、後述する各種の動作を実行させるコンピュータプログラムも記憶する。そのようなコンピュータプログラムは、記憶媒体（例えば半導体メモリまたは光ディスク等）または電気通信回線（例えばインターネット）を介して作業車両１００に提供され得る。そのようなコンピュータプログラムが、商用ソフトウェアとして販売されてもよい。
　制御装置１８０は、複数のＥＣＵを含む。複数のＥＣＵは、例えば、速度制御用のＥＣＵ１８１、ステアリング制御用のＥＣＵ１８２、インプルメント制御用のＥＣＵ１８３、自動運転制御用のＥＣＵ１８４、経路生成用のＥＣＵ１８５、および地図作成用のＥＣＵ１８６を含む。
　ＥＣＵ１８１は、駆動装置２４０に含まれる原動機１０２、変速装置１０３、およびブレーキを制御することによって作業車両１００の速度を制御する。
　ＥＣＵ１８２は、ステアリングホイールセンサ１５２の計測値に基づいて、操舵装置１０６に含まれる油圧装置または電動モータを制御することによって作業車両１００のステアリングを制御する。
　ＥＣＵ１８３は、作業機３００に所望の動作を実行させるために、連結装置１０８に含まれる３点リンクおよびＰＴＯ軸などの動作を制御する。ＥＣＵ１８３はまた、作業機３００の動作を制御する信号を生成し、その信号を通信装置１９０から作業機３００に送信する。
　ＥＣＵ１８４は、ＧＮＳＳユニット１１０、カメラ１２０、障害物センサ１３０、ＬｉＤＡＲセンサ１４０およびセンサ群１５０から出力されたデータに基づいて、自動運転を実現するための演算および制御を行う。例えば、ＥＣＵ１８４は、ＧＮＳＳユニット１１０、カメラ１２０、およびＬｉＤＡＲセンサ１４０の少なくとも１つから出力されたデータに基づいて、作業車両１００の位置を特定する。圃場内においては、ＥＣＵ１８４は、ＧＮＳＳユニット１１０から出力されたデータのみに基づいて作業車両１００の位置を決定してもよい。ＥＣＵ１８４は、カメラ１２０またはＬｉＤＡＲセンサ１４０が取得したデータに基づいて作業車両１００の位置を推定または補正してもよい。カメラ１２０またはＬｉＤＡＲセンサ１４０が取得したデータを利用することにより、測位の精度をさらに高めることができる。また、圃場外においては、ＥＣＵ１８４は、ＬｉＤＡＲセンサ１４０またはカメラ１２０から出力されるデータを利用して作業車両１００の位置を推定する。例えば、ＥＣＵ１８４は、ＬｉＤＡＲセンサ１４０またはカメラ１２０から出力されるデータと、環境地図とのマッチングにより、作業車両１００の位置を推定してもよい。自動運転中、ＥＣＵ１８４は、推定された作業車両１００の位置に基づいて、目標経路または局所的経路に沿って作業車両１００が走行するために必要な演算を行う。ＥＣＵ１８４は、ＥＣＵ１８１に速度変更の指令を送り、ＥＣＵ１８２に操舵角変更の指令を送る。ＥＣＵ１８１は、速度変更の指令に応答して原動機１０２、変速装置１０３、またはブレーキを制御することによって作業車両１００の速度を変化させる。ＥＣＵ１８２は、操舵角変更の指令に応答して操舵装置１０６を制御することによって操舵角を変化させる。
　ＥＣＵ１８５は、作業車両１００が目標経路に沿って走行している間、障害物を回避可能な局所的経路を逐次生成する。ＥＣＵ１８５は、作業車両１００の走行中、カメラ１２０、障害物センサ１３０、およびＬｉＤＡＲセンサ１４０から出力されたデータに基づいて、作業車両１００の周囲に存在する障害物を認識する。ＥＣＵ１８５は、認識した障害物を回避するように局所的経路を生成する。
　ＥＣＵ１８５は、管理装置６００の代わりに大域的経路設計を行う機能を備えていてもよい。その場合、ＥＣＵ１８５は、記憶装置１７０に格納された作業計画に基づいて作業車両１００の移動先を決定し、作業車両１００の移動の開始地点から目的地点までの目標経路を決定する。ＥＣＵ１８５は、記憶装置１７０に格納された道路情報を含む環境地図に基づき、例えば最短の時間で移動先に到達できる経路を目標経路として作成することができる。あるいは、ＥＣＵ１８５は、環境地図に含まれる各道の属性情報に基づいて、特定の種類の道（例えば、農道、水路などの特定の地物に沿った道、またはＧＮＳＳ衛星からの衛星信号を良好に受信できる道など）を優先する経路を目標経路として生成してもよい。
　ＥＣＵ１８６は、作業車両１００が走行する環境の地図を生成または編集する。本実施形態では、管理装置６００などの外部の装置によって生成された環境地図が作業車両１００に送信され、記憶装置１７０に記録されるが、ＥＣＵ１８６が代わりに環境地図を生成または編集することもできる。以下、ＥＣＵ１８６が環境地図を生成する場合の動作を説明する。環境地図は、ＬｉＤＡＲセンサ１４０から出力されたセンサデータに基づいて生成され得る。環境地図を生成するとき、ＥＣＵ１８６は、作業車両１００が走行している間にＬｉＤＡＲセンサ１４０から出力されたセンサデータに基づいて３次元の点群データを逐次生成する。ＥＣＵ１８６は、例えばＳＬＡＭなどのアルゴリズムを利用して、逐次生成した点群データを繋ぎ合わせることにより、環境地図を生成することができる。このようにして生成された環境地図は、高精度の３次元地図であり、ＥＣＵ１８４による自己位置推定に利用され得る。この３次元地図に基づいて、大域的経路計画に利用される２次元地図が生成され得る。本明細書では、自己位置推定に利用される３次元地図と、大域的経路計画に利用される２次元地図とを、いずれも「環境地図」と称する。ＥＣＵ１８６は、さらに、カメラ１２０またはＬｉＤＡＲセンサ１４０から出力されたデータに基づいて認識された地物（例えば、水路、川、草、木など）、道の種類（例えば農道か否か）、路面の状態、または道の通行可能性等に関する種々の属性情報を、地図に付加することによって地図を編集することもできる。
　これらのＥＣＵの働きにより、制御装置１８０は、自動運転を実現する。自動運転時において、制御装置１８０は、計測または推定された作業車両１００の位置と、目標経路とに基づいて、駆動装置２４０を制御する。これにより、制御装置１８０は、作業車両１００を目標経路に沿って走行させることができる。
　制御装置１８０に含まれる複数のＥＣＵは、例えばＣＡＮ（Controller Area Network）などのビークルバス規格に従って、相互に通信することができる。ＣＡＮに代えて、車載イーサネット（登録商標）などの、より高速の通信方式が用いられてもよい。図３において、ＥＣＵ１８１から１８６のそれぞれは、個別のブロックとして示されているが、これらのそれぞれの機能が、複数のＥＣＵによって実現されていてもよい。ＥＣＵ１８１から１８６の少なくとも一部の機能を統合した車載コンピュータが設けられていてもよい。制御装置１８０は、ＥＣＵ１８１から１８６以外のＥＣＵを備えていてもよく、機能に応じて任意の個数のＥＣＵが設けられ得る。各ＥＣＵは、１つ以上のプロセッサを含む処理回路を備える。
　通信装置１９０は、作業機３００、端末装置４００、および管理装置６００と通信を行う回路を含む装置である。通信装置１９０は、例えばＩＳＯＢＵＳ－ＴＩＭ等のＩＳＯＢＵＳ規格に準拠した信号の送受信を、作業機３００の通信装置３９０との間で実行する回路を含む。これにより、作業機３００に所望の動作を実行させたり、作業機３００から情報を取得したりすることができる。通信装置１９０は、さらに、ネットワーク８０を介した信号の送受信を、端末装置４００および管理装置６００のそれぞれの通信装置との間で実行するためのアンテナおよび通信回路を含み得る。ネットワーク８０は、例えば、３Ｇ、４Ｇもしくは５Ｇなどのセルラー移動体通信網およびインターネットを含み得る。通信装置１９０は、作業車両１００の近くにいる監視者が使用する携帯端末と通信する機能を備えていてもよい。そのような携帯端末との間では、Ｗｉ－Ｆｉ（登録商標）、３Ｇ、４Ｇもしくは５Ｇなどのセルラー移動体通信、またはＢｌｕｅｔｏｏｔｈ（登録商標）などの、任意の無線通信規格に準拠した通信が行われ得る。
　操作端末２００は、作業車両１００の走行および作業機３００の動作に関する操作をユーザが実行するための端末であり、バーチャルターミナル（ＶＴ）とも称される。操作端末２００は、タッチスクリーンなどの表示装置、および／または１つ以上のボタンを備え得る。表示装置は、例えば液晶または有機発光ダイオード（ＯＬＥＤ）などのディスプレイであり得る。ユーザは、操作端末２００を操作することにより、例えば自動運転モードのオン／オフの切り替え、環境地図の記録または編集、目標経路の設定、および作業機３００のオン／オフの切り替えなどの種々の操作を実行することができる。これらの操作の少なくとも一部は、操作スイッチ群２１０を操作することによっても実現され得る。操作端末２００は、作業車両１００から取り外せるように構成されていてもよい。作業車両１００から離れた場所にいるユーザが、取り外された操作端末２００を操作して作業車両１００の動作を制御してもよい。ユーザは、操作端末２００の代わりに、端末装置４００などの、必要なアプリケーションソフトウェアがインストールされたコンピュータを操作して作業車両１００の動作を制御してもよい。
　図５は、キャビン１０５の内部に設けられる操作端末２００および操作スイッチ群２１０の例を示す図である。キャビン１０５の内部には、ユーザが操作可能な複数のスイッチを含む操作スイッチ群２１０が配置されている。操作スイッチ群２１０は、例えば、主変速または副変速の変速段を選択するためのスイッチ、自動運転モードと手動運転モードとを切り替えるためのスイッチ、前進と後進とを切り替えるためのスイッチ、および作業機３００を昇降するためのスイッチ等を含み得る。なお、作業車両１００が無人運転のみを行い、有人運転の機能を備えていない場合、作業車両１００が操作スイッチ群２１０を備えている必要はない。
　図３に示す作業機３００における駆動装置３４０は、作業機３００が所定の作業を実行するために必要な動作を行う。駆動装置３４０は、例えば油圧装置、電気モータ、またはポンプなどの、作業機３００の用途に応じた装置を含む。制御装置３８０は、駆動装置３４０の動作を制御する。制御装置３８０は、通信装置３９０を介して作業車両１００から送信された信号に応答して、駆動装置３４０に各種の動作を実行させる。また、作業機３００の状態に応じた信号を通信装置３９０から作業車両１００に送信することもできる。
　次に、図６を参照しながら、管理装置６００および端末装置４００の構成を説明する。図６は、管理装置６００および端末装置４００の概略的なハードウェア構成を例示するブロック図である。
　管理装置６００は、記憶装置６５０と、プロセッサ６６０と、ＲＯＭ（Read Only Memory）６７０と、ＲＡＭ（Random Access Memory）６８０と、通信装置６９０とを備える。これらの構成要素は、バスを介して相互に通信可能に接続される。管理装置６００は、作業車両１００が実行する圃場における農作業のスケジュール管理を行い、管理するデータを活用して農業を支援するクラウドサーバとして機能し得る。ユーザは、端末装置４００を用いて作業計画の作成に必要な情報を入力し、その情報をネットワーク８０を介して管理装置６００にアップロードすることが可能である。管理装置６００は、その情報に基づき、農作業のスケジュール、すなわち作業計画を作成することができる。管理装置６００は、さらに、環境地図の生成または編集を実行することができる。環境地図は、管理装置６００の外部のコンピュータから配信されてもよい。
　通信装置６９０は、ネットワーク８０を介して作業車両１００および端末装置４００と通信するための通信モジュールである。通信装置６９０は、例えば、ＩＥＥＥ１３９４（登録商標）またはイーサネット（登録商標）などの通信規格に準拠した有線通信を行うことができる。通信装置６９０は、Ｂｌｕｅｔｏｏｔｈ（登録商標）規格もしくはＷｉ－Ｆｉ規格に準拠した無線通信、または、３Ｇ、４Ｇもしくは５Ｇなどのセルラー移動体通信を行ってもよい。
　プロセッサ６６０は、例えば中央演算処理装置（ＣＰＵ）を含む半導体集積回路であり得る。プロセッサ６６０は、マイクロプロセッサまたはマイクロコントローラによって実現され得る。あるいは、プロセッサ６６０は、ＣＰＵを搭載したＦＰＧＡ（Field Programmable Gate Array）、ＧＰＵ（Graphics Processing Unit）、ＡＳＩＣ（Application Specific Integrated Circuit）、ＡＳＳＰ（Application Specific Standard Product）、または、これら回路の中から選択される二つ以上の回路の組み合わせによっても実現され得る。プロセッサ６６０は、ＲＯＭ６７０に格納された、少なくとも１つの処理を実行するための命令群を記述したコンピュータプログラムを逐次実行し、所望の処理を実現する。
　ＲＯＭ６７０は、例えば、書き込み可能なメモリ（例えばＰＲＯＭ）、書き換え可能なメモリ（例えばフラッシュメモリ）、または読み出し専用のメモリである。ＲＯＭ６７０は、プロセッサ６６０の動作を制御するプログラムを記憶する。ＲＯＭ６７０は、単一の記憶媒体である必要はなく、複数の記憶媒体の集合体であってもよい。複数の記憶媒体の集合体の一部は、取り外し可能なメモリであってもよい。
　ＲＡＭ６８０は、ＲＯＭ６７０に格納された制御プログラムをブート時に一旦展開するための作業領域を提供する。ＲＡＭ６８０は、単一の記憶媒体である必要はなく、複数の記憶媒体の集合体であってもよい。
　記憶装置６５０は、主としてデータベースのストレージとして機能する。記憶装置６５０は、例えば、磁気記憶装置または半導体記憶装置であり得る。磁気記憶装置の例は、ハードディスクドライブ（ＨＤＤ）である。半導体記憶装置の例は、ソリッドステートドライブ（ＳＳＤ）である。記憶装置６５０は、管理装置６００とは独立した装置であってもよい。例えば、記憶装置６５０は、管理装置６００にネットワーク８０を介して接続される記憶装置、例えばクラウドストレージであってもよい。
　端末装置４００は、入力装置４２０と、表示装置４３０と、記憶装置４５０と、プロセッサ４６０と、ＲＯＭ４７０と、ＲＡＭ４８０と、通信装置４９０とを備える。これらの構成要素は、バスを介して相互に通信可能に接続される。入力装置４２０は、ユーザからの指示をデータに変換してコンピュータに入力するための装置である。入力装置４２０は、例えば、キーボード、マウス、またはタッチパネルであり得る。表示装置４３０は、例えば液晶ディスプレイまたは有機ＥＬディスプレイであり得る。プロセッサ４６０、ＲＯＭ４７０、ＲＡＭ４８０、記憶装置４５０、および通信装置４９０のそれぞれに関する説明は、管理装置６００のハードウェア構成例において記載したとおりであり、それらの説明を省略する。
　［２．動作］
　次に、作業車両１００、端末装置４００、および管理装置６００の動作を説明する。
　［２－１．自動走行動作］
　まず、作業車両１００による自動走行の動作の例を説明する。本実施形態における作業車両１００は、圃場内および圃場外の両方で自動で走行することができる。圃場内において、作業車両１００は、予め設定された目標経路に沿って走行しながら、作業機３００を駆動して所定の農作業を行う。作業車両１００は、圃場内を走行中、障害物センサ１３０によって障害物が検出された場合、例えば、走行を停止し、ブザー２２０からの警告音の発出、および端末装置４００への警告信号の送信などの動作を行ってもよい。圃場内において、作業車両１００の測位は、主にＧＮＳＳユニット１１０から出力されるデータに基づいて行われる。一方、圃場外において、作業車両１００は、圃場外の農道または一般道に設定された目標経路に沿って自動で走行する。作業車両１００は、圃場外を走行中、カメラ１２０またはＬｉＤＡＲセンサ１４０によって取得されたデータを活用して走行する。圃場外において、作業車両１００は、障害物が検出されると、例えば障害物を回避するか、その場で停止する。圃場外においては、ＧＮＳＳユニット１１０から出力される測位データに加え、ＬｉＤＡＲセンサ１４０またはカメラ１２０から出力されるデータに基づいて作業車両１００の位置が推定され得る。
　以下、作業車両１００が圃場内を自動走行する場合の動作の例を説明する。
　図７は、圃場内を目標経路に沿って自動で走行する作業車両１００の例を模式的に示す図である。この例において、圃場は、作業車両１００が作業機３００を用いて作業を行う作業領域７２と、圃場の外周縁付近に位置する枕地７４とを含む。地図上で圃場のどの領域が作業領域７２または枕地７４に該当するかは、ユーザによって事前に設定され得る。この例における目標経路は、並列する複数の主経路Ｐ１と、複数の主経路Ｐ１を接続する複数の旋回経路Ｐ２とを含む。主経路Ｐ１は作業領域７２内に位置し、旋回経路Ｐ２は枕地７４内に位置する。図７に示す各主経路Ｐ１は直線状の経路であるが、各主経路Ｐ１は曲線状の部分を含んでいてもよい。主経路Ｐ１は、例えば、ユーザが操作端末２００または端末装置４００に表示された圃場の地図を見ながら、圃場の端付近の２点（図７における点ＡおよびＢ）を指定する操作を行うことによって自動で生成され得る。その場合、ユーザが指定した点Ａと点Ｂとを結ぶ線分に平行に、複数の主経路Ｐ１が設定され、それらの主経路Ｐ１を旋回経路Ｐ２で接続することによって圃場内の目標経路が生成される。図７における破線は、作業機３００の作業幅を表している。作業幅は、予め設定され、記憶装置１７０に記録される。作業幅は、ユーザが操作端末２００または端末装置４００を操作することによって設定され、記録され得る。あるいは、作業幅は、作業機３００を作業車両１００に接続したときに自動で認識され、記録されてもよい。複数の主経路Ｐ１の間隔は、作業幅に合わせて設定され得る。目標経路は、自動運転が開始される前に、ユーザの操作に基づいて作成され得る。目標経路は、例えば圃場内の作業領域７２の全体をカバーするように作成され得る。作業車両１００は、図７に示すような目標経路に沿って、作業の開始地点から作業の終了地点まで、往復を繰り返しながら自動で走行する。なお、図７に示す目標経路は一例に過ぎず、目標経路の定め方は任意である。
　次に、制御装置１８０による圃場内における自動運転時の制御の例を説明する。
　図８は、制御装置１８０によって実行される自動運転時の操舵制御の動作の例を示すフローチャートである。制御装置１８０は、作業車両１００の走行中、図８に示すステップＳ１２１からＳ１２５の動作を実行することにより、自動操舵を行う。速度に関しては、例えば予め設定された速度に維持される。制御装置１８０は、作業車両１００の走行中、ＧＮＳＳユニット１１０によって生成された作業車両１００の位置を示すデータを取得する（ステップＳ１２１）。次に、制御装置１８０は、作業車両１００の位置と、目標経路との偏差を算出する（ステップＳ１２２）。偏差は、その時点における作業車両１００の位置と、目標経路との距離を表す。制御装置１８０は、算出した位置の偏差が予め設定された閾値を超えるか否かを判定する（ステップＳ１２３）。偏差が閾値を超える場合、制御装置１８０は、偏差が小さくなるように、駆動装置２４０に含まれる操舵装置の制御パラメータを変更することにより、操舵角を変更する。ステップＳ１２３において偏差が閾値を超えない場合、ステップＳ１２４の動作は省略される。続くステップＳ１２５において、制御装置１８０は、動作終了の指令を受けたか否かを判定する。動作終了の指令は、例えばユーザが遠隔操作で自動運転の停止を指示したり、作業車両１００が目的地に到達したりした場合に出され得る。動作終了の指令が出されていない場合、ステップＳ１２１に戻り、新たに計測された作業車両１００の位置に基づいて、同様の動作を実行する。制御装置１８０は、動作終了の指令が出されるまで、ステップＳ１２１からＳ１２５の動作を繰り返す。上記の動作は、制御装置１８０におけるＥＣＵ１８２、１８４によって実行される。
　図８に示す例では、制御装置１８０は、ＧＮＳＳユニット１１０によって特定された作業車両１００の位置と目標経路との偏差のみに基づいて駆動装置２４０を制御するが、方位の偏差もさらに考慮して制御してもよい。例えば、制御装置１８０は、ＧＮＳＳユニット１１０によって特定された作業車両１００の向きと、目標経路の方向との角度差である方位偏差が予め設定された閾値を超える場合に、その偏差に応じて駆動装置２４０の操舵装置の制御パラメータ（例えば操舵角）を変更してもよい。
　以下、図９Ａから図９Ｄを参照しながら、制御装置１８０による操舵制御の例をより具体的に説明する。
　図９Ａは、目標経路Ｐに沿って走行する作業車両１００の例を示す図である。図９Ｂは、目標経路Ｐから右にシフトした位置にある作業車両１００の例を示す図である。図９Ｃは、目標経路Ｐから左にシフトした位置にある作業車両１００の例を示す図である。図９Ｄは、目標経路Ｐに対して傾斜した方向を向いている作業車両１００の例を示す図である。これらの図において、ＧＮＳＳユニット１１０によって計測された作業車両１００の位置および向きを示すポーズがｒ（ｘ，ｙ，θ）と表現されている。（ｘ，ｙ）は、地球に固定された２次元座標系であるＸＹ座標系における作業車両１００の基準点の位置を表す座標である。図９Ａから図９Ｄに示す例において、作業車両１００の基準点はキャビン上のＧＮＳＳアンテナが設置された位置にあるが、基準点の位置は任意である。θは、作業車両１００の計測された向きを表す角度である。図示されている例においては、目標経路ＰがＹ軸に平行であるが、一般的には目標経路ＰはＹ軸に平行であるとは限らない。
　図９Ａに示すように、作業車両１００の位置および向きが目標経路Ｐから外れていない場合には、制御装置１８０は、作業車両１００の操舵角および速度を変更せずに維持する。
　図９Ｂに示すように、作業車両１００の位置が目標経路Ｐから右側にシフトしている場合には、制御装置１８０は、作業車両１００の走行方向が左寄りに傾き、経路Ｐに近付くように操舵角を変更する。このとき、操舵角に加えて速度も併せて変更してもよい。操舵角の大きさは、例えば位置偏差Δｘの大きさに応じて調整され得る。
　図９Ｃに示すように、作業車両１００の位置が目標経路Ｐから左側にシフトしている場合には、制御装置１８０は、作業車両１００の走行方向が右寄りに傾き、経路Ｐに近付くように操舵角を変更する。この場合も、操舵角に加えて速度も併せて変更してもよい。操舵角の変化量は、例えば位置偏差Δｘの大きさに応じて調整され得る。
　図９Ｄに示すように、作業車両１００の位置は目標経路Ｐから大きく外れていないが、向きが目標経路Ｐの方向とは異なる場合は、制御装置１８０は、方位偏差Δθが小さくなるように操舵角を変更する。この場合も、操舵角に加えて速度も併せて変更してもよい。操舵角の大きさは、例えば位置偏差Δｘおよび方位偏差Δθのそれぞれの大きさに応じて調整され得る。例えば、位置偏差Δｘの絶対値が小さいほど方位偏差Δθに応じた操舵角の変化量を大きくしてもよい。位置偏差Δｘの絶対値が大きい場合には、経路Ｐに戻るために操舵角を大きく変化させることになるため、必然的に方位偏差Δθの絶対値が大きくなる。逆に、位置偏差Δｘの絶対値が小さい場合には、方位偏差Δθをゼロに近づけることが必要である。このため、操舵角を決定するための方位偏差Δθの重み（すなわち制御ゲイン）を相対的に大きくすることが妥当である。
　作業車両１００の操舵制御および速度制御には、ＰＩＤ制御またはＭＰＣ制御（モデル予測制御）などの制御技術が適用され得る。これらの制御技術を適用することにより、作業車両１００を目標経路Ｐに近付ける制御を滑らかにすることができる。
　なお、走行中に１つ以上の障害物センサ１３０によって障害物が検出された場合には、制御装置１８０は、例えば、作業車両１００を停止させる。このとき、ブザー２２０に警告音を発出させたり、警告信号を端末装置４００に送信してもよい。障害物の回避が可能な場合、制御装置１８０は、障害物を回避可能な局所的な経路を生成し、その経路に沿って作業車両１００が走行するように駆動装置２４０を制御してもよい。
　本実施形態における作業車両１００は、圃場内だけでなく、圃場外でも自動走行が可能である。圃場外において、制御装置１８０は、カメラ１２０またはＬｉＤＡＲセンサ１４０から出力されたデータに基づいて、作業車両１００から比較的離れた位置に存在する物体（例えば、他の車両または歩行者等）を検出することができる。制御装置１８０は、検出された物体を回避するように局所的経路を生成し、局所的経路に沿って速度制御および操舵制御を行うことにより、圃場外の道における自動走行を実現できる。
　このように、本実施形態における作業車両１００は、無人で圃場内および圃場外を自動で走行できる。図１０は、複数の作業車両１００が圃場７０の内部および圃場７０の外側の道７６を自動走行している状況の例を模式的に示す図である。記憶装置１７０には、複数の圃場およびその周辺の道を含む領域の環境地図および目標経路が記録される。環境地図および目標経路は、管理装置６００またはＥＣＵ１８５によって生成され得る。作業車両１００が道路上を走行する場合、作業車両１００は、作業機３００を上昇させた状態で、カメラ１２０およびＬｉＤＡＲセンサ１４０などのセンシング装置を用いて周囲をセンシングしながら、目標経路に沿って走行する。走行中、制御装置１８０は、局所的経路を逐次生成し、局所的経路に沿って作業車両１００を走行させる。これにより、障害物を回避しながら自動走行することができる。走行中に、状況に応じて目標経路が変更されてもよい。
　［２－２．局所的経路計画］
　作業車両１００が圃場外を走行しているとき、大域的経路上またはその付近に、歩行者または他の車両などの障害物が存在することがある。作業車両１００が障害物に衝突することを回避するために、制御装置１８０におけるＥＣＵ１８５は、作業車両１００の走行中、障害物を回避可能な局所的経路を逐次生成する。ＥＣＵ１８５は、作業車両１００が走行しているとき、作業車両１００が備えるセンシング装置（障害物センサ１３０、ＬｉＤＡＲセンサ１４０、およびカメラ１２０等）によって取得されたセンシングデータに基づいて、局所的経路を生成する。局所的経路は、第２経路３０Ｂの一部に沿った複数のウェイポイントによって規定される。ＥＣＵ１８５は、センシングデータに基づいて、作業車両１００の進路上またはその付近に障害物が存在するか否かを判断する。そのような障害物が存在する場合、ＥＣＵ１８５は、障害物を避けるように複数のウェイポイントを設定して局所的経路を生成する。障害物が存在しない場合、ＥＣＵ１８５は、第２経路３０Ｂにほぼ平行に局所的経路を生成する。生成された局所的経路を示す情報は、自動運転制御用のＥＣＵ１８４に送られる。ＥＣＵ１８４は、局所的経路に沿って作業車両１００が走行するように、ＥＣＵ１８１およびＥＣＵ１８２を制御する。これにより、作業車両１００は、障害物を回避しながら走行することができる。なお、作業車両１００が走行する道路に信号機が存在する場合、作業車両１００は、例えばカメラ１２０が撮影した画像に基づいて信号機を認識し、赤信号で停止し、青信号で発進する、といった動作を行ってもよい。
　図１１は、障害物が存在する環境で生成される大域的経路および局所的経路の一例を示す図である。図１１において、大域的経路３０が点線矢印で例示され、走行中に逐次生成される局所的経路３２が実線矢印で例示されている。大域的経路３０は、複数のウェイポイント３０ｐによって規定される。局所的経路３２は、ウェイポイント３０ｐよりも短い間隔で設定された複数のウェイポイント３２ｐによって規定される。各ウェイポイントは、例えば、位置および向きの情報を有する。管理装置６００は、複数のウェイポイント３０ｐを、道７６の交差点を含む複数の箇所に設定することによって大域的経路３０を生成する。ウェイポイント３０ｐの間隔は、比較的長く、例えば数メートルから数十メートル程度であってもよい。ＥＣＵ１８５は、作業車両１００の走行中、センシング装置から出力されたセンシングデータに基づいて、複数のウェイポイント３２ｐを設定することにより、局所的経路３２を生成する。局所的経路３２におけるウェイポイント３２ｐの間隔は、大域的経路３０におけるウェイポイント３０ｐの間隔よりも短い。ウェイポイント３２ｐの間隔は、例えば、数十センチメートル（ｃｍ）から数メートル（ｍ）程度であり得る。局所的経路３２は、作業車両１００の位置を起点とする比較的狭い範囲（例えば数メートル程度の範囲）内に生成される。図１１には、作業車両１００が圃場７０の間の道７６に沿って走行し、交差点で左折する間に生成される一連の局所的経路３２が例示されている。ＥＣＵ１８５は、作業車両１００の移動中、ＥＣＵ１８４によって推定された作業車両１００の位置から、例えば数メートル先の地点までの局所的経路を生成する動作を繰り返す。作業車両１００は、逐次生成される局所的経路に沿って走行する。
　図１１に示す例では、作業車両１００の前方に障害物４０（例えば人）が存在する。図１１には、作業車両１００に搭載されたカメラ１２０、障害物センサ１３０、またはＬｉＤＡＲセンサ１４０などのセンシング装置によってセンシングされる範囲の一例が扇形で例示されている。このような状況において、ＥＣＵ１８５は、センシングデータに基づいて検出された障害物４０を回避するように、局所的経路３２を生成する。ＥＣＵ１８５は、例えば、センシングデータと、作業車両１００の幅（インプルメントが装着されている場合はインプルメントの幅も含む）とに基づいて、作業車両１００が障害物４０に衝突する可能性があるかを判断する。作業車両１００が障害物４０に衝突する可能性がある場合、ＥＣＵ１８５は、その障害物４０を避けるように複数のウェイポイント３２ｐを設定して局所的経路３２を生成する。なお、ＥＣＵ１８５は、障害物４０の有無だけでなく、路面の状態（例えば、ぬかるみ、陥没等）をセンシングデータに基づいて認識し、走行が困難な箇所が検出された場合、そのような箇所を回避するように局所的経路３２を生成してもよい。作業車両１００は、局所的経路３２に沿って走行する。局所的経路３２をどのように設定しても障害物４０を回避できない場合、制御装置１８０は、作業車両１００を停止させてもよい。このとき、制御装置１８０は、端末装置４００に警告信号を送信して監視者に注意喚起を行ってもよい。停止後、障害物４０が移動して衝突のおそれがなくなったことを認識した場合、制御装置１８０は、作業車両１００の走行を再開してもよい。
　図１２は、本実施形態における経路計画および走行制御の動作を示すフローチャートである。図１２に示すステップＳ１４１からＳ１４６の動作を実行することにより、経路計画を行い、作業車両１００の自動走行を制御することができる。
　図１２に示す例において、管理装置６００は、まず、記憶装置６５０から地図および作業計画を取得する（ステップＳ１４１）。次に、管理装置６００は、地図および作業計画に基づいて、前述の方法により、作業車両１００の大域的経路設計を行う（ステップＳ１４２）。大域的経路設計は、作業車両１００の走行を開始する前の任意のタイミングで行われ得る。大域的経路設計は、作業車両１００の走行開始の直前に行われてもよいし、走行開始の前日以前に行われてもよい。また、大域的経路は、ユーザが端末装置４００を用いて入力した情報（例えば、出発地点、目的地点、経由地点等）に基づいて生成されてもよい。前述のように、管理装置６００は、圃場に向かう経路、または圃場から他の場所（例えば作業車両１００の保管場所または待機場所）に向かう経路を生成するとき、地図上の各道の属性情報に基づいて、農道を優先する経路、特定の地物に沿った道を優先する経路、および衛星信号を正常に受信できる道を優先する経路の少なくとも１つを作業車両１００の経路として生成する。管理装置６００は、生成した大域的経路を示すデータを作業車両１００に送信する。その後、管理装置６００は、所定のタイミングで、作業車両１００に走行の指示を出す。これを受けて、作業車両１００の制御装置１８０は、作業車両１００の走行を開始するように駆動装置２４０を制御する（ステップＳ１４３）。これにより、作業車両１００は走行を開始する。走行開始のタイミングは、例えば、作業計画が示す各作業日における最初の農作業の開始予定時刻までに作業車両１００が圃場に到達できる適切なタイミングに設定され得る。制御装置１８０のＥＣＵ１８５は、作業車両１００の走行中、前述の方法により、障害物との衝突を回避するための局所的経路設計を行う（ステップＳ１４４）。障害物が検出されなかった場合、ＥＣＵ１８５は、大域的経路にほぼ平行に局所的経路を生成する。障害物が検出された場合、ＥＣＵ１８５は、障害物を回避可能な局所的経路を生成する。続いて、ＥＣＵ１８４は、作業車両１００の走行を終了させるか否かを判定する（ステップＳ１４５）。例えば、障害物を回避できる局所的経路を生成できなかった場合、または、作業車両１００が目的地点に到着した場合、ＥＣＵ１８４は、作業車両１００を停止させる（ステップＳ１４６）。障害物が検出されなかった場合、または障害物を回避可能な局所的経路が生成できた場合は、ステップＳ１４３に戻り、ＥＣＵ１８４は、生成された局所的経路に沿って作業車両１００を走行させる。以後、ステップＳ１４５において走行を終了すると判断されるまで、ステップＳ１４３からＳ１４５の動作が繰り返される。
　以上の動作により、作業車両１００は、障害物に衝突することなく、生成された経路に沿って自動で走行することができる。
　図１２の例において、大域的経路は、一度生成された後、目的地に到達するまで変更されない。このような例に限らず、作業車両１００の走行中に大域的経路が修正されてもよい。例えば、ＥＣＵ１８５は、作業車両１００の走行中に、カメラ１２０またはＬｉＤＡＲセンサ１４０などのセンシング装置によって取得されたセンシングデータに基づいて、作業車両１００が走行している道の状態、作業車両１００の周辺の草木の状態、および天候の状態の少なくとも１つを認識し、認識した状態が所定の条件を満たす場合に、大域的経路を変更してもよい。作業車両１００が大域的経路に沿って走行しているとき、一部の道の通行が困難である場合がある。例えば、豪雨によって道がぬかるんでいたり、路面が陥没していたり、事故その他の原因で通行できなくなっていたりすることがある。あるいは、農道の周辺の草木が想定よりも伸びていたり、建造物が新たに建設されていたりして、ＧＮＳＳ衛星からの衛星信号が受信しにくくなっていることがある。そのような状況を考慮して、ＥＣＵ１８５は、作業車両１００の走行中に取得されたセンシングデータに基づいて、通行が困難な道を検出し、そのような道を回避するように経路を変更してもよい。また、ＥＣＵ１８５は、経路を変更した場合、変更後の経路を記憶装置１７０に記憶させ、管理装置６００に変更後の経路の情報を送信してもよい。その場合、管理装置６００は、次回、同じ圃場への経路生成時に、変更後の経路を採用してもよい。これにより、走行環境の変化に応じた柔軟な経路計画が可能になる。
　［２－３．障害物の検出および走行制御］
　図１１および図１２を参照しながら上述した例では、検出された障害物を回避するように作業車両１００の経路を変更する方法について説明した。以下では、作業車両１００が、障害物の可能性がある物体を検出したとき、検出された物体を回避するか否かを決定し、自動運転による走行を制御する方法を説明する。本実施形態による作業車両１００は、作業車両１００にインプルメント（作業機）３００が連結されている状態で自動運転を行っている間に物体を検出したとき、物体の作業車両１００への影響度およびインプルメント３００への影響度に基づいて、検出された物体を回避するか否かを決定し、自動運転による走行を制御することができる。ここでは、作業車両１００はトラクタ等の農業機械であり、インプルメント３００は農作業を行う機械である。
　本実施形態による、自動運転を行う作業車両１００は、作業車両１００の周辺の環境をセンシングしてセンサデータを出力する１つ以上のセンサ（センシング装置）と、センサデータに基づいて作業車両１００の自動運転を制御する制御装置１８０と、インプルメントを連結するための連結装置１０８とを備える。制御装置１８０は、インプルメント３００が作業車両１００に連結されている状態で作業車両１００が自動運転を行うとき、以下の（ｉ）～（ｉｉｉ）を実行する。（ｉ）センサデータに基づいて、物体の検出および分類を実行する。（ｉｉ）検出および分類された物体が作業車両１００に接触した場合の影響の大きさを示す第１影響度と、検出および分類された物体がインプルメント３００に接触した場合の影響の大きさを示す第２影響度とを、物体の分類結果に応じて決定する。（ｉｉｉ）第１影響度および第２影響度の少なくとも一方に応じて、物体との接触を回避する動作、および物体との接触を回避する動作を行わずに作業車両１００の自動運転を継続する動作のいずれか一方を実行する。検出された物体との接触を回避する動作、および検出された物体との回避する動作を行わずに作業車両１００の自動運転を継続する動作のいずれか一方を実行することを、「障害物回避動作を実行する」ということがある。
　本実施形態による作業車両１００は、以下のようにあらわすこともできる。作業車両１００は、自動走行中にセンサデータに基づいて障害物回避動作を以下のように実行する。作業車両１００は、センサデータに基づいて検出した物体の分類結果と、物体が作業車両１００および作業車両１００に連結されたインプルメント３００のそれぞれに接触した場合における、物体の分類結果に応じた影響度（すなわち、第１影響度および第２影響度）と、に基づいて、障害物回避動作を制御する。
　制御装置１８０に含まれる複数のＥＣＵが協働して障害物回避動作を実行する処理を実行し得る。制御装置１８０は、例示するＥＣＵ１８１～１８６に加えて、障害物回避動作を実行する処理の一部または全部を行うためのＥＣＵをさらに有してもよい。
　図１３を参照しながら、作業車両１００が障害物回避動作を実行する手順の一例を説明する。図１３は、作業車両１００が障害物回避動作を実行する手順の一例を示すフローチャートであり、インプルメント３００が作業車両１００に連結されている状態で作業車両１００が自動運転を行うときに実行される手順である。
　ステップＳ１４１において、制御装置１８０は、センサデータに基づいて、物体の検出および分類を実行する。
　ここでは、作業車両１００が有する１つ以上のセンサ（センシング装置）からセンサデータが出力される。作業車両１００は、作業車両１００が有する１つ以上のセンサ（センシング装置）で、周辺の環境をセンシングしながら自動運転を行う。例えば図２の例では、作業車両１００が有するセンシング装置は、複数のカメラ１２０と、ＬｉＤＡＲセンサ１４０と、複数の障害物センサ１３０とを含む。これに限られず、作業車両１００のセンシング装置は、カメラ１２０、障害物センサ１３０、およびＬｉＤＡＲセンサ１４０の少なくとも１つを含み得る。制御装置１８０は、作業車両１００が有するセンシング装置の少なくとも１つが取得したセンサデータ、例えば、カメラ１２０が取得した画像データ、障害物センサ１３０またはＬｉＤＡＲセンサ１４０から出力されたデータ（例えば点群データ）等に基づいて、物体の検出および分類を実行する。物体の検出は、作業車両１００が周辺の環境をセンシングしながら自動運転を行っている間、絶えず行われてもよいし、予め設定された所定の時間間隔で行われてもよい。物体の検出および分類は、同じセンシング装置から取得されたセンサデータに基づいて行われてもよいし、異なるセンシング装置から取得されたセンサデータに基づいて行われてもよい。物体の検出および分類は同時に行われてもよいし、物体が検出された後に、検出された物体の分類（すなわち、検出された物体の種別の識別）が行われてもよい。制御装置１８０は、例えば、カメラ１２０が取得した物体の画像データに基づいて、検出された物体の種別を識別して分類を実行する。例えば、制御装置１８０は、人工知能の深層学習によって構築された学習済みモデルを用いて物体の分類を行う。学習済みモデルは、様々な物体の画像データを、人工知能による学習を実行するコンピュータに格納して、当該コンピュータによって、学習済みモデルを構築することができる。また、制御装置１８０は、パターンマッチングによって、物体を特定し、特定した物体の分類を示すデータベースから得ることによって、物体の分類を実行してもよい。
　制御装置１８０がセンサデータに基づいて検出する物体は、障害物（すなわち、作業車両１００の走行にとって障害となる物体）の可能性がある物体を含み、例えば、地上にあって移動または静止する物体、および、特定の状態にある地面の一部を含む。「特定の状態にある地面の一部」の例としては、走行の障害となる凹凸（くぼみ、陥没、穴、路面のひび割れ等を含む）、ぬかるみ、水たまり、等が挙げられる。
　図１４Ａおよび図１４Ｂは、作業車両１００が有するＬｉＤＡＲセンサ１４０およびカメラ１２０がセンシング可能な領域の例を模式的に示す図である。図１４Ａおよび図１４Ｂに示す例では、作業車両１００は、作業車両１００の前部、後部、左側および右側に設けられた４つのＬｉＤＡＲセンサ１４０（１４０ａ、１４０ｂ、１４０ｃおよび１４０ｄ）および４つのカメラ１２０（１２０ａ、１２０ｂ、１２０ｃおよび１２０ｄ）を有し、これらによって周辺の環境をセンシングすることができる。図１４Ａおよび図１４Ｂにおいては、ＬｉＤＡＲセンサ１４０およびカメラ１２０でセンシングされる範囲の一例がグレーの扇形または三角形で示されている。
　ＬｉＤＡＲセンサ１４０は、レーザビームのパルス（以下「レーザパルス」と略記する。）を、出射方向を変えながら次々と出射し、出射時刻と各レーザパルスの反射光を取得した時刻との時間差から各反射点の位置までの距離を計測することができる（ＴｏＦ（Time of Flight）方式）。あるいは、ＬｉＤＡＲセンサ１４０は、ＦＭＣＷ（Frequency Modulated Continuous Wave）技術を利用して測距を行うセンサであってもよい。ＦＭＣＷ技術を利用したＬｉＤＡＲセンサは、周波数が線形的に変調されたレーザ光を出射し、出射光と反射光との干渉光を検出することによって得られるビート信号の周波数に基づいて反射点までの距離および速度を求めることができる。「反射点」は、作業車両１００の周辺の環境に位置する物体の表面上の点であり得る。
　ＬｉＤＡＲセンサ１４０は、任意の方法により、ＬｉＤＡＲセンサ１４０から物体までの距離を計測し得る。ＬｉＤＡＲセンサ１４０の計測方法としては、例えば機械回転方式、ＭＥＭＳ方式、フェーズドアレイ方式がある。これらの計測方法は、それぞれレーザパルスを出射する方法（スキャンの方法）が異なっている。例えば、機械回転方式のＬｉＤＡＲセンサは、レーザパルスの出射およびレーザパルスの反射光の検出を行う筒状のヘッドを回転させて、回転軸の周囲３６０度全方位の周辺環境をスキャンする。ＭＥＭＳ方式のＬｉＤＡＲセンサは、ＭＥＭＳミラーを用いてレーザパルスの出射方向を揺動させ、揺動軸を中心とした所定の角度範囲内の周辺環境をスキャンする。フェーズドアレイ方式のＬｉＤＡＲセンサは、光の位相を制御して光の出射方向を揺動させ、揺動軸を中心とした所定の角度範囲内の周辺環境をスキャンする。
　ステップＳ１４２において、制御装置１８０は、ステップＳ１４２における物体の分類結果に応じて、検出および分類された物体が作業車両１００に接触した場合に、作業車両１００に与える影響の大きさを示す第１影響度と、検出および分類された物体がインプルメント３００に接触した場合に、インプルメント３００に与える影響の大きさを示す第２影響度とを決定する。
　第１影響度および第２影響度は、それぞれ独立に、例えば、影響の大きさを示す複数の段階（レベル）で表されてもよい（例えば、小、中および大の３段階）し、連続的な数値で表されてもよい。制御装置１８０は、第１影響度および第２影響度の値（スコア）を所定の評価式（または評価関数）を用いて算出してもよい。制御装置１８０は、テーブルを参照して第１影響度および第２影響度を決定してもよい。例えば、物体の分類（種別）ごとの第１影響度および第２影響度のそれぞれの値（またはレベル）を含むテーブルが作業車両１００の記憶装置１７０に記憶されており、制御装置１８０は、テーブルと、物体の分類結果とに基づいて、第１影響度および第２影響度を決定してもよい。
　図１５に、物体の分類ごとの第１影響度および第２影響度のそれぞれを含むテーブルの例を示す。図１５のテーブルでは、第１影響度および第２影響度を、小、中、および大の３段階で示している。記憶装置１７０に記憶されるテーブルには、小、中、および大の３段階に対応する数値が含まれていてもよい。制御装置１８０は、テーブルと、物体の分類結果とに加えて、物体のサイズにも基づいて、第１影響度および第２影響度を決定してもよい。例えば、図１５のテーブルでは、水たまり、くぼみ、穴、石については、そのサイズによって異なる第１影響度が設定されている。同じ種別の物体であっても、そのサイズや位置によって、作業車両１００またはインプルメント３００に接触した場合の影響の大きさは異なり得る。
　制御装置１８０は、第１影響度および第２影響度の決定にあたって、検出された物体が作業車両１００に接触するか否か、および検出された物体がインプルメント３００に接触するか否かを判定してもよい。具体的な判定方法は、図１７Ａおよび図１７Ｂを参照して後述する。また、検出された物体が作業車両１００に接触するか否か、および検出された物体がインプルメント３００に接触するか否かを判定する具体的な方法は、特許文献２に記載の方法を適用してもよい。特許文献２の開示内容のすべてを参照により本明細書に援用する。
　ステップＳ１４３において、制御装置１８０は、第１影響度および／または第２影響度に応じて、物体との接触を回避する動作を実行するか否かを決定する。
　制御装置１８０は、例えば、第１影響度および第２影響度を予め定められた基準値と比較して、物体との接触を回避する動作を実行するか否かを決定する。例えば、制御装置１８０は、第１影響度が第１基準値よりも小さく、かつ第２影響度が第２基準値よりも小さい場合、物体との接触を回避する動作を行わずに作業車両１００の自動運転を継続し、第１影響度が第１基準値以上、または、第２影響度が第２基準値以上である場合、物体との接触を回避する動作を実行する。すなわち、制御装置１８０は、第１影響度が第１基準値よりも小さく、かつ第２影響度が第２基準値よりも小さい場合、その物体との接触を許容して作業車両１００の自動運転を継続させる。
　例えば、図１５のテーブルの例のように、第１影響度および第２影響度が、小、中、および大の３段階で表されている場合において、第１基準値および第２基準値が例えば「中」であるとする。この場合、第１影響度および第２影響度の両方が「小」である場合、物体との接触を回避する動作を行わずに作業車両１００の自動運転を継続し、第１影響度および第２影響度のいずれかが「中」または「大」である場合、物体との接触を回避する動作を実行する。
　第１基準値および第２基準値は予め定められていてもよいし、ユーザが設定してもよい。なお、第１基準値および第２基準値は同じであってもよいし、異なっていてもよい。物体が作業車両１００に接触した場合に作業車両１００に与える影響の大きさについて許容される範囲と、物体がインプルメント３００に接触したときにインプルメント３００に与える影響の大きさについて許容される範囲とは、異なり得る。
　ステップＳ１４３における決定に基づいて、制御装置１８０は、物体との接触を回避する動作を実行する（ステップＳ１４４）、または、物体との接触を回避する動作を行わずに作業車両１００の自動運転を継続する動作を実行する（ステップＳ１４５）。
　制御装置１８０は、ステップＳ１４４に進んだ場合、すなわち、物体との接触を回避する動作を実行する場合は、例えば、図１１および図１２を参照して説明した方法で、物体との接触を回避するように作業車両１００の目標経路を変更する。制御装置１８０は、検出された物体が移動する物体（人、動物、他の車両等）であるとき、作業車両１００を所定時間停止させ、所定時間経過後に周辺の環境をセンシングし、センサデータに基づいて物体が検出されない場合、作業車両１００の走行を再開させてもよい。所定時間経過後も物体が検出された場合は、制御装置１８０は、例えば、図１１および図１２を参照して説明した方法で、物体を回避するように作業車両１００の目標経路を変更する。制御装置１８０は、ステップＳ１４４に進んだ場合（すなわち、物体との接触を回避する動作を実行する場合）、作業車両１００の走行を停止させてもよい。制御装置１８０は、作業車両１００の走行を停止させたとき、外部の装置に信号を送信してもよい。
　制御装置１８０は、ステップＳ１４５に進んだ場合、すなわち、物体との接触を回避する動作を行わずに作業車両１００の自動運転を継続する動作を実行する場合は、物体との接触を許容して、作業車両１００の目標経路を変更せずに、作業車両１００の自動運転を継続させる。このとき、作業車両１００の速度を必要に応じて変更してもよい（例えば速度を低下させてもよい）。
　制御装置１８０は、動作終了の指令が出されるまで（ステップＳ１４６）、ステップＳ１４１からＳ１４５の工程を繰り返す。
　作業車両１００は、上記の手順で障害物回避動作を実行する。
　特許文献２の作業車両は、走行する道路の状態（道路の凹凸や道路上に存在する構造物を含む）と、作業車両に連結されたインプルメントの状態とによって、自動走行の制御が行われる。特許文献２の作業車両は、道路の凹凸や道路上に存在する構造物が検出されたとき、道路の凹凸または構造物と接触せずに走行可能か否かを判定し、走行できないと判定されたときは、自動運転を停止する。
　これに対して、本実施形態による作業車両１００は、上述したように、障害物の可能性がある物体が検出されたとき、物体が作業車両１００に接触した場合およびインプルメント３００に接触した場合の影響の大きさを、第１影響度および第２影響度として決定し、第１影響度および第２影響度がいずれも許容できる程度に小さい場合は、その物体との接触を許容して、作業車両１００の目標経路を変更することなく自動運転を継続することができる。作業車両１００は、特許文献２の作業車両に比べて、自動運転による走行を効率的に行うことができる。
　図１６を参照して、作業車両１００が障害物回避動作を実行する手順の他の例を説明する。図１６は、作業車両１００が障害物回避動作を実行する手順の他の一例を示すフローチャートである。図１３のフローチャートと共通するまたは対応する工程については、詳細な説明を省略することがある。
　ステップＳ１６１において、制御装置１８０は、センサデータに基づいて、作業車両１００の周辺の環境に存在する物体を検出する。
　ステップＳ１６２において、制御装置１８０は、ステップＳ１６１で検出された物体が、作業車両１００の目標経路上または目標経路の近傍に位置するか否かを判定する。ステップＳ１６２において、検出された物体が、作業車両１００の目標経路上または目標経路の近傍に位置するかと判定された場合は、ステップＳ１６３に進む。
　ステップＳ１６３において、制御装置１８０は、検出された物体の位置、大きさ（サイズ）、種別に関する情報を取得する。
　ステップＳ１６４において、制御装置１８０は、検出された物体が作業車両１００に接触するか否か、および検出された物体がインプルメント３００に接触するか否かを判定（推定）する。制御装置１８０は、例えば、検出された物体の位置、作業車両１００のサイズ、およびインプルメント３００のサイズに基づいて、検出された物体が作業車両１００に接触するか否か、および検出された物体がインプルメント３００に接触するか否かを判定する。具体的な判定方法は、後述する図１７Ａおよび図１７Ｂを参照しながら説明する。
　制御装置１８０は、ステップＳ１６５において、検出された物体が作業車両１００およびインプルメント３００の少なくとも一方に接触すると判定した場合、ステップＳ１６６に進む。
　ステップＳ１６６において、制御装置１８０は、第１影響度および第２影響度の少なくとも一方を、物体の分類結果に応じて決定する。
　例えば、制御装置１８０は、ステップＳ１６５において、検出された物体が作業車両１００およびインプルメント３００の両方に接触すると判定した場合、第１影響度および第２影響度の両方を、物体の分類結果に応じて決定する。あるいは、制御装置１８０は、ステップＳ１６５において、検出された物体が作業車両１００およびインプルメント３００のいずれか一方にのみ接触すると判定した場合、第１影響度および第２影響度のうちの対応する一方のみを、物体の分類結果に応じて決定する。
　ステップＳ１６７において、制御装置１８０は、ステップＳ１６６で決定された第１影響度および／または第２影響度を、予め定められた基準値（第１基準値、第２基準値）と比較して、物体との接触を回避する動作を実行するか否かを決定する。
　例えば、制御装置１８０は、ステップＳ１６６で第１影響度および第２影響度の両方が決定された場合、第１影響度が第１基準値よりも小さく、かつ第２影響度が第２基準値よりも小さい場合、物体との接触を回避する動作を行わずに作業車両１００の自動運転を継続し、第１影響度が第１基準値以上、または、第２影響度が第２基準値以上である場合、物体との接触を回避する動作を実行する。あるいは、制御装置１８０は、ステップＳ１６６で第１影響度および第２影響度のいずれか一方のみが決定された場合、決定された第１影響度または第２影響度が、第１基準値または第２基準値よりも小さい場合、物体との接触を回避する動作を行わずに作業車両１００の自動運転を継続し、決定された第１影響度または第２影響度が、第１基準値または第２基準値以上である場合、物体との接触を回避する動作を実行する。
　ステップＳ１６７における決定に基づいて、制御装置１８０は、物体との接触を回避する動作を実行する（ステップＳ１６８）、または、物体との接触を回避する動作を行わずに作業車両１００の自動運転を継続する動作を実行する（ステップＳ１６９）。
　制御装置１８０は、動作終了の指令が出されるまで（ステップＳ１７０）、ステップＳ１６１からＳ１７０の工程を繰り返す。
　例示したフローチャートは適宜改変され得る。例えば、検出された物体が移動する物体（人、動物等）である場合は、制御装置１８０は、物体の移動速度を推定して、物体が作業車両１００およびインプルメント３００と接触するか否かを判定してもよい。
　図１７Ａおよび図１７Ｂを参照して、制御装置１８０が、検出された物体が作業車両１００に接触するか否か、および検出された物体がインプルメント３００に接触するか否かを判定する方法を説明する。図１７Ａおよび図１７Ｂは、作業車両１００、および作業車両１００に連結された作業機３００を模式的に示す上面図である。
　検出された物体が地上にある物体（例えば、石、荷物、作物など）の場合、制御装置１８０は、物体の位置（例えば、作業車両１００およびインプルメント３００の幅方向における、物体の位置）、作業車両１００の幅（車体幅）Ｗ２０、およびインプルメント３００の幅Ｗ３０とに基づいて、検出された物体が作業車両１００に接触するか否か、および検出された物体がインプルメント３００に接触するか否かを判定する。
　図１７Ａに示す物体Ｏｂ１～Ｏｂ４を例に挙げて説明する。制御装置１８０は、物体Ｏｂ１のように、作業車両１００の幅Ｗ２０およびインプルメント３００の幅Ｗ３０の外側に位置する物体は、作業車両１００およびインプルメント３００に接触しないと判定する。制御装置１８０は、物体Ｏｂ２のように、作業車両１００の幅Ｗ２０の外側に位置する物体は、作業車両１００に接触しないと判定する。制御装置１８０は、物体Ｏｂ２のように、インプルメント３００の幅Ｗ３０の内側に物体が位置する場合は、インプルメント３００の地面からの高さＨ２２（図２参照）と、物体Ｏｂ２の高さとにさらに基づいて、インプルメント３００と接触するか否かを判定する。物体Ｏｂ２の高さがインプルメント３００の高さＨ２２よりも十分低い場合は、制御装置１８０は、物体Ｏｂ２は、インプルメント３００と接触しないと判定する。制御装置１８０は、物体Ｏｂ３およびＯｂ４のように、作業車両１００の幅Ｗ２０およびインプルメント３００の幅Ｗ３０の内側に位置する物体については、作業車両１００の車輪１０４（前輪１０４Ｆおよび後輪１０４Ｒ）と接触するか否かを判定する。物体Ｏｂ３のように、車輪１０４と干渉しない位置にあり、かつ、物体Ｏｂ３の高さが作業車両１００の地面からの高さＨ１２（図２参照）およびインプルメント３００の地面からの高さＨ２２よりも十分に小さい場合は、制御装置１８０は、物体Ｏｂ３は、作業車両１００およびインプルメント３００と接触しないと判定する。物体Ｏｂ４のように、車輪１０４と干渉する位置にある場合は、制御装置１８０は、物体Ｏｂ４は、作業車両１００と接触すると判定する。
　検出された物体が地面にある凹部（例えば、穴、水たまり、水路など）の場合、制御装置１８０は、凹部の位置（例えば、作業車両１００およびインプルメント３００の幅方向における、凹部の位置）、作業車両１００の幅（車体幅）Ｗ２０、およびインプルメント３００の幅Ｗ３０とに基づいて、検出された物体が作業車両１００に接触するか否か、および検出された物体がインプルメント３００に接触するか否かを判定する。制御装置１８０は、凹部の位置と、作業車両１００の車輪１０４の位置とに基づいて、検出された物体が作業車両１００に接触するか否か、および検出された物体がインプルメント３００に接触するか否かを判定してもよい。
　図１７Ｂに示す凹部Ｏｎ１～Ｏｎ４を例に挙げて説明する。制御装置１８０は、凹部Ｏｎ１のように、作業車両１００の幅Ｗ２０およびインプルメント３００の幅Ｗ３０の外側に位置する場合は、作業車両１００およびインプルメント３００に接触しないと判定する。制御装置１８０は、凹部Ｏｎ２のように、作業車両１００の幅Ｗ２０の外側に位置し、インプルメント３００の幅Ｗ３０の内側に位置する場合は、作業車両１００およびインプルメント３００に接触しないと判定する。制御装置１８０は、凹部Ｏｎ３およびＯｎ４のように、作業車両１００の幅Ｗ２０およびインプルメント３００の幅Ｗ３０の内側に位置する凹部については、作業車両１００の車輪１０４（前輪１０４Ｆおよび後輪１０４Ｒ）と接触するか否かを判定する。制御装置１８０は、凹部Ｏｎ３のように、車輪１０４と干渉しない位置にある場合は、作業車両１００およびインプルメント３００と接触しないと判定する。制御装置１８０は、物体Ｏｂ４のように、車輪１０４と干渉する位置にある場合は、凹部Ｏｎ４の幅や深さ、車輪１０４の大きさ、インプルメント３００の地面からの高さＨ２２、作業車両１００の地面からの高さＨ１２などに基づいて、作業車両１００およびインプルメント３００と接触するか否かを判定する。なお、制御装置１８０は、凹部Ｏｎ１～凹部Ｏｎ４のそれぞれが、作業車両１００の車輪１０４（前輪１０４Ｆおよび後輪１０４Ｒ）に接触しない場合、作業車両１００に接触しないと判断してもよい。
　制御装置１８０は、検出された物体が作業車両１００に接触するか否か、および検出された物体がインプルメント３００に接触するか否かを判定するにあたって、インプルメント３００の長さＬ１Ｘ、連結装置１０８の前後方向の長さＬ２Ｘ、インプルメント３００の左右方向のオフセット長さの情報などをさらに取得し、用いてもよい。図１７Ａおよび図１７Ｂの例では、インプルメント３００の左右方向のオフセット長さはゼロとするが、これに限られない。
　ここで説明した例では、制御装置１８０は、作業車両１００が有する１つ以上のセンシング装置から出力されたセンサデータに基づいて、作業車両１００の自動運転を制御する。ただし、作業車両１００は、例えば作業車両１００とは異なる農業機械、またはドローン（無人航空機、Unmanned Arial Vehicle：ＵＡＶ）などの他の移動体が有する１つ以上のセンシング装置で、周辺の環境をセンシングしながら自動運転を行ってもよい。制御装置１８０は、例えば作業車両１００とは異なる農業機械、またはドローンなどの他の移動体が有するセンシング装置が取得したセンサデータを用いて、作業車両１００の自動運転を制御してもよい。
　また、本実施形態による作業車両１００の制御装置１８０が実行する処理の一部または全部は、他の装置によって実行されてもよい。そのような他の装置は、本実施形態による制御システムの制御装置として機能し、例えば、管理装置６００（プロセッサ６６０）、端末装置４００（プロセッサ４６０）および操作端末２００のいずれかであってもよい。例えば、制御装置１８０が実行する処理の一部が、管理装置６００のプロセッサ６６０によって実行される場合、制御装置１８０と管理装置６００との組み合わせが制御システムの制御装置として機能する。
　本実施形態による制御システムは、自動運転を行う作業車両のための制御システムであって、作業車両１００の周辺の環境をセンシングしてセンサデータを出力する１つ以上のセンサと、センサデータに基づいて作業車両１００の自動運転を制御する制御装置とを備える。制御装置は、インプルメント３００が作業車両１００に連結されている状態で作業車両１００が自動運転を行うとき、以下の（ｉ）～（ｉｉｉ）を実行する。（ｉ）センサデータに基づいて、物体の検出および分類を実行する。（ｉｉ）検出および分類された物体が作業車両１００に接触した場合の影響の大きさを示す第１影響度と、検出および分類された物体がインプルメント３００に接触した場合の影響の大きさを示す第２影響度とを、物体の分類結果に応じて決定する。（ｉｉｉ）第１影響度および第２影響度の少なくとも一方に応じて、物体との接触を回避する動作、および物体との接触を回避する動作を行わずに作業車両１００の自動運転を継続する動作のいずれか一方を実行する。
　本実施形態による制御方法は、自動運転を行う作業車両１００の制御方法であって、
（Ｉ）作業車両１００が備える１つ以上のセンサから出力されたセンサデータに基づいて、物体の検出および分類を実行すること、
（ＩＩ）検出および分類された物体が作業車両１００に接触した場合の影響の大きさを示す第１影響度と、検出および分類された物体が作業車両１００に連結されたインプルメント３００に接触した場合の影響の大きさを示す第２影響度とを、物体の分類結果に応じて決定すること、および
（ＩＩＩ）第１影響度および第２影響度の少なくとも一方に応じて、物体との接触を回避する動作、および物体との接触を回避する動作を行わずに作業車両１００の自動運転を継続する動作のいずれか一方を実行すること、
を含む。
　以上のように、本開示は、以下の項目に記載の作業車両、制御方法および制御システムを含む。
　［項目１］
　自動運転を行う作業車両であって、
　前記作業車両の周辺の環境をセンシングしてセンサデータを出力する１つ以上のセンサと、
　前記センサデータに基づいて前記作業車両の前記自動運転を制御する制御装置と、
　インプルメントを連結するための連結装置と、
を備え、
　前記制御装置は、前記インプルメントが前記作業車両に連結されている状態で前記自動運転を行うとき、
　　前記センサデータに基づいて、物体の検出および分類を実行し、
　　前記物体が前記作業車両に接触した場合の影響の大きさを示す第１影響度、および前記物体が前記インプルメントに接触した場合の影響の大きさを示す第２影響度を、前記物体の分類結果に応じて決定し、
　　前記第１影響度および前記第２影響度の少なくとも一方に応じて、前記物体との接触を回避する動作、および前記回避する動作を行わずに前記自動運転を継続する動作のいずれか一方を実行する、
　作業車両。
　［項目２］
　前記制御装置は、
　前記第１影響度が第１基準値よりも小さく、かつ前記第２影響度が第２基準値よりも小さい場合、前記回避する動作を行わずに前記自動運転を継続し、
　前記第１影響度が前記第１基準値以上、または前記第２影響度が前記第２基準値以上である場合、前記物体との接触を回避する動作を実行する、
項目１に記載の作業車両。
　［項目３］
　前記制御装置は、
　検出された前記物体の位置、前記作業車両のサイズ、および前記インプルメントのサイズに基づいて、前記物体が前記作業車両に接触するか否か、および前記物体が前記インプルメントに接触するか否かを判定し、
　前記物体が前記作業車両および前記インプルメントの少なくとも一方に接触すると判定した場合、前記第１影響度および前記第２影響度の少なくとも一方に応じて、前記物体との接触を回避する動作、および前記回避する動作を行わずに前記自動運転を継続する動作のいずれか一方を実行する、
項目１または２に記載の作業車両。
　［項目４］
　前記制御装置は、前記物体が前記作業車両および前記インプルメントの少なくとも一方に接触すると判定した場合、前記第１影響度および前記第２影響度の少なくとも一方を、前記物体の分類結果に応じて決定する、項目３に記載の作業車両。
　［項目５］
　前記制御装置は、前記物体が前記作業車両および前記インプルメントの両方に接触すると判定した場合、前記第１影響度および前記第２影響度の両方を、前記物体の分類結果に応じて決定する、項目４に記載の作業車両。
　［項目６］
　前記制御装置は、前記物体が前記作業車両および前記インプルメントの一方に接触すると判定した場合、前記第１影響度および前記第２影響度のうちの対応する一方を、前記物体の分類結果に応じて決定する、項目４に記載の作業車両。
　［項目７］
　物体の分類ごとの前記第１影響度および前記第２影響度のそれぞれの値を含むテーブルを記憶する記憶装置をさらに備え、
　前記制御装置は、前記テーブルと、前記物体の分類結果とに基づいて、前記第１影響度および前記第２影響度を決定する、
項目１から６のいずれか１項に記載の作業車両。
　［項目８］
　前記作業車両は農業機械であり、
　前記インプルメントは農作業を行う機械である、
項目１から７のいずれか１項に記載の作業車両。
　［項目９］
　自動運転を行う作業車両の制御方法であって、
　前記作業車両が備える１つ以上のセンサから出力されたセンサデータに基づいて、物体の検出および分類を実行すること、
　前記物体が前記作業車両に接触した場合の影響の大きさを示す第１影響度、および前記物体が前記作業車両に連結されたインプルメントに接触した場合の影響の大きさを示す第２影響度を、前記物体の分類結果に応じて決定すること、および
　前記第１影響度および前記第２影響度の少なくとも一方に応じて、前記物体との接触を回避する動作、および前記回避する動作を行わずに前記自動運転を継続する動作のいずれか一方を実行すること、
を含む制御方法。
　［項目１０］
　自動走行中にセンサデータに基づいて障害物回避動作を実行する作業車両であって、
　前記センサデータに基づいて検出した物体の分類結果と、物体が前記作業車両および前記作業車両に連結されたインプルメントのそれぞれに接触した場合における、前記物体の分類結果に応じた影響度と、に基づいて、前記障害物回避動作を制御する、作業車両。
　［項目１１］
　自動運転を行う作業車両のための制御システムであって、
　前記作業車両の周辺の環境をセンシングしてセンサデータを出力する１つ以上のセンサと、
　前記センサデータに基づいて前記作業車両の前記自動運転を制御する制御装置と、
を備え、
　前記制御装置は、インプルメントが前記作業車両に連結されている状態で前記作業車両が前記自動運転を行うとき、
　　前記センサデータに基づいて、物体の検出および分類を実行し、
　　前記物体が前記作業車両に接触した場合の影響の大きさを示す第１影響度、および前記物体が前記インプルメントに接触した場合の影響の大きさを示す第２影響度を、前記物体の分類結果に応じて決定し、
　　前記第１影響度および前記第２影響度の少なくとも一方に応じて、前記物体との接触を回避する動作、および前記回避する動作を行わずに前記自動運転を継続する動作のいずれか一方を実行する、
　制御システム。
　本開示の技術は、例えばトラクタ、収穫機、田植機、乗用管理機、野菜移植機、草刈機、播種機、施肥機、または農業用ロボットなどの作業車両、作業車両の自動運転による走行を制御する方法、および、自動運転を行う作業車両のための制御システムに適用することができる。
　４０・・・障害物、５０・・・ＧＮＳＳ衛星、６０・・・基準局、７０・・・圃場、７２・・・作業領域、７４・・・枕地、７６・・・道、８０・・・ネットワーク、１００・・・作業車両、１０１・・・車両本体、１０２・・・原動機（エンジン）、１０３・・・変速装置（トランスミッション）、１０４・・・車輪、１０５・・・キャビン、１０６・・・操舵装置、１０７・・・運転席、１０８・・・連結装置、１１０・・・測位装置（ＧＮＳＳユニット）、１１１・・・ＧＮＳＳ受信機、１１２・・・ＲＴＫ受信機、１１５・・・慣性計測装置（ＩＭＵ）、１１６・・・処理回路、１２０・・・カメラ、１３０・・・障害物センサ、１４０・・・ＬｉＤＡＲセンサ、１５０・・・センサ群、１５２・・・ステアリングホイールセンサ、１５４・・・切れ角センサ、１５６・・・車軸センサ、１６０・・・制御システム、１７０・・・記憶装置、１８０・・・制御装置、１８１～１８６・・・ＥＣＵ、１９０・・・通信装置、２００・・・操作端末、２１０・・・操作スイッチ群、２２０・・・ブザー、２４０・・・駆動装置、３００・・・作業機（インプルメント）、３４０・・・駆動装置、３８０・・・制御装置、３９０・・・通信装置、４００・・・端末装置、４２０・・・入力装置、４３０・・・表示装置、４５０・・・記憶装置、４６０・・・プロセッサ、４７０・・・ＲＯＭ、４８０・・・ＲＡＭ、４９０・・・通信装置、６００・・・管理装置、６５０・・・記憶装置、６６０・・・プロセッサ（処理装置）、６７０・・・ＲＯＭ、６８０・・・ＲＡＭ、６９０・・・通信装置

Claims (11)

  1. 　自動運転を行う作業車両であって、
    　前記作業車両の周辺の環境をセンシングしてセンサデータを出力する１つ以上のセンサと、
    　前記センサデータに基づいて前記作業車両の前記自動運転を制御する制御装置と、
    　インプルメントを連結するための連結装置と、
    を備え、
    　前記制御装置は、前記インプルメントが前記作業車両に連結されている状態で前記自動運転を行うとき、
    　　前記センサデータに基づいて、物体の検出および分類を実行し、
    　　前記物体が前記作業車両に接触した場合の影響の大きさを示す第１影響度、および前記物体が前記インプルメントに接触した場合の影響の大きさを示す第２影響度を、前記物体の分類結果に応じて決定し、
    　　前記第１影響度および前記第２影響度の少なくとも一方に応じて、前記物体との接触を回避する動作、および前記回避する動作を行わずに前記自動運転を継続する動作のいずれか一方を実行する、
    　作業車両。
  2. 　前記制御装置は、
    　前記第１影響度が第１基準値よりも小さく、かつ前記第２影響度が第２基準値よりも小さい場合、前記回避する動作を行わずに前記自動運転を継続し、
    　前記第１影響度が前記第１基準値以上、または前記第２影響度が前記第２基準値以上である場合、前記物体との接触を回避する動作を実行する、
    請求項１に記載の作業車両。
  3. 　前記制御装置は、
    　検出された前記物体の位置、前記作業車両のサイズ、および前記インプルメントのサイズに基づいて、前記物体が前記作業車両に接触するか否か、および前記物体が前記インプルメントに接触するか否かを判定し、
    　前記物体が前記作業車両および前記インプルメントの少なくとも一方に接触すると判定した場合、前記第１影響度および前記第２影響度の少なくとも一方に応じて、前記物体との接触を回避する動作、および前記回避する動作を行わずに前記自動運転を継続する動作のいずれか一方を実行する、
    請求項１または２に記載の作業車両。
  4. 　前記制御装置は、前記物体が前記作業車両および前記インプルメントの少なくとも一方に接触すると判定した場合、前記第１影響度および前記第２影響度の少なくとも一方を、前記物体の分類結果に応じて決定する、請求項３に記載の作業車両。
  5. 　前記制御装置は、前記物体が前記作業車両および前記インプルメントの両方に接触すると判定した場合、前記第１影響度および前記第２影響度の両方を、前記物体の分類結果に応じて決定する、請求項４に記載の作業車両。
  6. 　前記制御装置は、前記物体が前記作業車両および前記インプルメントの一方に接触すると判定した場合、前記第１影響度および前記第２影響度のうちの対応する一方を、前記物体の分類結果に応じて決定する、請求項４に記載の作業車両。
  7. 　物体の分類ごとの前記第１影響度および前記第２影響度のそれぞれの値を含むテーブルを記憶する記憶装置をさらに備え、
    　前記制御装置は、前記テーブルと、前記物体の分類結果とに基づいて、前記第１影響度および前記第２影響度を決定する、
    請求項１から６のいずれか１項に記載の作業車両。
  8. 　前記作業車両は農業機械であり、
    　前記インプルメントは農作業を行う機械である、
    請求項１から７のいずれか１項に記載の作業車両。
  9. 　自動運転を行う作業車両の制御方法であって、
    　前記作業車両が備える１つ以上のセンサから出力されたセンサデータに基づいて、物体の検出および分類を実行すること、
    　前記物体が前記作業車両に接触した場合の影響の大きさを示す第１影響度、および前記物体が前記作業車両に連結されたインプルメントに接触した場合の影響の大きさを示す第２影響度を、前記物体の分類結果に応じて決定すること、および
    　前記第１影響度および前記第２影響度の少なくとも一方に応じて、前記物体との接触を回避する動作、および前記回避する動作を行わずに前記自動運転を継続する動作のいずれか一方を実行すること、
    を含む制御方法。
  10. 　自動走行中にセンサデータに基づいて障害物回避動作を実行する作業車両であって、
    　前記センサデータに基づいて検出した物体の分類結果と、物体が前記作業車両および前記作業車両に連結されたインプルメントのそれぞれに接触した場合における、前記物体の分類結果に応じた影響度と、に基づいて、前記障害物回避動作を制御する、作業車両。
  11. 　自動運転を行う作業車両のための制御システムであって、
    　前記作業車両の周辺の環境をセンシングしてセンサデータを出力する１つ以上のセンサと、
    　前記センサデータに基づいて前記作業車両の前記自動運転を制御する制御装置と、
    を備え、
    　前記制御装置は、インプルメントが前記作業車両に連結されている状態で前記作業車両が前記自動運転を行うとき、
    　　前記センサデータに基づいて、物体の検出および分類を実行し、
    　　前記物体が前記作業車両に接触した場合の影響の大きさを示す第１影響度、および前記物体が前記インプルメントに接触した場合の影響の大きさを示す第２影響度を、前記物体の分類結果に応じて決定し、
    　　前記第１影響度および前記第２影響度の少なくとも一方に応じて、前記物体との接触を回避する動作、および前記回避する動作を行わずに前記自動運転を継続する動作のいずれか一方を実行する、
    　制御システム。
PCT/JP2023/019973 2022-06-29 2023-05-29 作業車両、制御方法および制御システム WO2024004486A1 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2022-104117 2022-06-29
JP2022104117 2022-06-29

Publications (1)

Publication Number Publication Date
WO2024004486A1 true WO2024004486A1 (ja) 2024-01-04

Family

ID=89382753

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2023/019973 WO2024004486A1 (ja) 2022-06-29 2023-05-29 作業車両、制御方法および制御システム

Country Status (1)

Country Link
WO (1) WO2024004486A1 (ja)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017228155A (ja) * 2016-06-23 2017-12-28 株式会社クボタ 走行支援システム及び作業車
JP2019101931A (ja) * 2017-12-06 2019-06-24 ヤンマー株式会社 走行経路設定装置
CN112492956A (zh) * 2020-11-26 2021-03-16 江苏沃得植保机械有限公司 一种割草机及其自动驾驶方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017228155A (ja) * 2016-06-23 2017-12-28 株式会社クボタ 走行支援システム及び作業車
JP2019101931A (ja) * 2017-12-06 2019-06-24 ヤンマー株式会社 走行経路設定装置
CN112492956A (zh) * 2020-11-26 2021-03-16 江苏沃得植保机械有限公司 一种割草机及其自动驾驶方法

Similar Documents

Publication Publication Date Title
US20240338037A1 (en) Path planning system and path planning method for agricultural machine performing self-traveling
US20240341216A1 (en) Travel control system for agricultural machine capable of performing remotely-manipulated traveling
WO2023007836A1 (ja) 農業支援システムおよび農業支援方法
WO2024004486A1 (ja) 作業車両、制御方法および制御システム
WO2023248909A1 (ja) 走行制御システム、農業機械および走行制御方法
WO2024004463A1 (ja) 走行制御システム、走行制御方法およびコンピュータプログラム
WO2023127556A1 (ja) 農業機械、農業機械に用いるセンシングシステムおよびセンシング方法
WO2023127557A1 (ja) 農業機械、農業機械に用いるセンシングシステムおよびセンシング方法
WO2023218688A1 (ja) 地図作成システムおよび経路計画システム
WO2023119996A1 (ja) 障害物検出システム、農業機械および障害物検出方法
WO2023238827A1 (ja) 農業管理システム
WO2023238724A1 (ja) 農業機械の自動走行のための経路生成システムおよび経路生成方法
US20240317238A1 (en) Agricultural road identification system, control system, and agricultural machine
WO2023112515A1 (ja) 地図生成システムおよび地図生成方法
WO2023234255A1 (ja) センシングシステム、農業機械、およびセンシング装置
WO2023095856A1 (ja) 自動運転を行う農業機械のための経路計画システム
JP2024003645A (ja) 経路生成システム、農業機械および経路生成方法
WO2023243369A1 (ja) 映像表示システムおよび作業車両
US20240341215A1 (en) Agricultural machine, sensing system, sensing method, remote operation system, and control method
US20240345603A1 (en) Travel control system for agricultural machine capable of performing remotely-manipulated traveling
JP7584654B2 (ja) 農業機械のための管理システム
WO2024004575A1 (ja) 作業車両、および作業車両の制御方法
WO2024004881A1 (ja) 制御システム、制御方法および運搬車
WO2023243514A1 (ja) 作業車両、および作業車両の制御方法
WO2023007835A1 (ja) 管理システム、および農業機械の圃場へのアクセスを管理するための方法