US20240077876A1 - Route setting method, autonomous traveling method, route setting device, autonomous traveling system, and storage medium - Google Patents

Route setting method, autonomous traveling method, route setting device, autonomous traveling system, and storage medium Download PDF

Info

Publication number
US20240077876A1
US20240077876A1 US18/268,958 US202118268958A US2024077876A1 US 20240077876 A1 US20240077876 A1 US 20240077876A1 US 202118268958 A US202118268958 A US 202118268958A US 2024077876 A1 US2024077876 A1 US 2024077876A1
Authority
US
United States
Prior art keywords
route
work
region
work vehicle
departure
Prior art date
Legal status (The legal status 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 status listed.)
Pending
Application number
US18/268,958
Inventor
Takuya Iwase
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Yanmar Holdings Co Ltd
Original Assignee
Yanmar Holdings Co Ltd
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 Yanmar Holdings Co Ltd filed Critical Yanmar Holdings Co Ltd
Publication of US20240077876A1 publication Critical patent/US20240077876A1/en
Pending legal-status Critical Current

Links

Images

Classifications

    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01BSOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B69/00Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0219Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01BSOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B69/00Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
    • A01B69/007Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow
    • A01B69/008Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow automatic
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/60Intended control result
    • G05D1/617Safety or protection, e.g. defining protection zones around obstacles or avoiding hazards
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2105/00Specific applications of the controlled vehicles
    • G05D2105/15Specific applications of the controlled vehicles for harvesting, sowing or mowing in agriculture or forestry
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2107/00Specific environments of the controlled vehicles
    • G05D2107/20Land use
    • G05D2107/21Farming, e.g. fields, pastures or barns
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2109/00Types of controlled vehicles
    • G05D2109/10Land vehicles
    • G05D2201/0201

Definitions

  • the present invention relates to a route setting method, an autonomous traveling method, a route setting device, an autonomous traveling system, and a storage medium.
  • Patent Literature 1 JPH09-154315 A discloses a control device for which a position for replenishment of materials or discharge of the harvest is set in advance in a field, and by which a work vehicle that is working within the field is moved to the set position on the basis of an instruction by a worker.
  • Patent Literature 2 JP 2019-174890 A discloses an automatic traveling system which causes a work vehicle that is working within a field to move to a preset evacuation region on the basis of an instruction by a worker.
  • a travelable region for the work vehicle is not set according to the type of work.
  • the travelable region differs according to type of work being performed in the field. For example, in work for performing seeding, the work vehicle should not travel through an already-worked region. Also, in work for performing harvesting, the work vehicle should not travel through an unworked region.
  • one of the objectives of the present disclosure is to provide a route setting device which sets a travelable region according to the type of work.
  • the other objectives can be understood from the following description and the description of embodiments.
  • a route setting method for achieving the above objective includes receiving an instruction for a work vehicle moving in a field along a preset work route, and acquiring the position of the work vehicle. Also, the route setting method includes generating a departure route for the work vehicle to depart from a work region in which the work vehicle performs work in the field, on the basis of the instruction and a work machine used for the work in the field as the work vehicle moves within the field.
  • An autonomous traveling method includes the route setting method described above and causing a work vehicle to move along a departure route or a work route automatically.
  • a route setting device for achieving the above objective is provided with a situation ascertainment unit and a departure route setting unit.
  • the situation ascertainment unit receives an instruction for a work vehicle moving in a field along a preset work route, and acquires the position of the work vehicle.
  • the departure route setting unit generates, on the basis of the instruction and a work machine used for work in the field as the work vehicle moves within the field, a departure route for the work vehicle to depart from a work region in which the work vehicle performs the work in the field.
  • An autonomous traveling system includes the route setting device described above and a work vehicle that moves along a departure route or a work route automatically.
  • a non-transitory tangible storage medium stores a route setting program.
  • the route setting program causes a computation device to execute receiving an instruction for a work vehicle moving in a field along a preset work route, and acquiring the position of the work vehicle. Also, the route setting program causes the computation device to execute generating a departure route for the work vehicle to depart from a work region in which the work vehicle performs work in the field, on the basis of the instruction and a work machine used for the work in the field as the work vehicle moves within the field.
  • a travel vehicle can travel through a region corresponding to the type of work.
  • FIG. 1 is a schematic view of a field of one embodiment.
  • FIG. 2 is a configuration diagram of an autonomous traveling system of one embodiment.
  • FIG. 3 is a functional block diagram of an autonomous traveling system of one embodiment.
  • FIG. 4 is a flowchart illustrating processing executed by a route setting program of one embodiment.
  • FIG. 5 A is a diagram for illustrating a region segment of one embodiment.
  • FIG. 5 B is a diagram for illustrating a region segment of one embodiment.
  • FIG. 6 is a diagram for illustrating a departure position and a departure direction of one embodiment.
  • FIG. 7 A is a flowchart illustrating processing of generating a departure route of one embodiment.
  • FIG. 7 B is a flowchart illustrating processing of generating a departure route of one embodiment.
  • FIG. 8 A is a diagram for illustrating processing of generating a first route of one embodiment.
  • FIG. 8 B is a diagram for illustrating processing of generating a first route of one embodiment.
  • FIG. 9 is a diagram for illustrating processing of generating a departure route of one embodiment.
  • FIG. 10 is a diagram for illustrating processing of generating a departure route of one embodiment.
  • FIG. 11 is a diagram for illustrating processing of generating a departure route of one embodiment.
  • FIG. 12 is a diagram for illustrating processing of generating a departure route of one embodiment.
  • a field 10 in which work, such as plowing, leveling, fertilizing, harvesting, and the like, is performed using a work vehicle 130 includes a central work region 11 and a headland 12 , which surrounds the work region 11 , as illustrated in FIG. 1 .
  • the work region 11 represents a region in which work is performed to cultivate crops.
  • the headland 12 is provided to allow the work vehicle 130 to turn, for example.
  • the work vehicle 130 includes a vehicle that tows a work machine, such as a tractor, and a vehicle formed integrally with a work machine, such as a combine harvester.
  • the work vehicle 130 moves within the field 10 , thereby performing work using the work machine in the field 10 .
  • the work vehicle 130 departs from the work region 11 and moves to a departure position 13 in order to have materials such as seedlings replenished.
  • a traveling region in which the work vehicle 130 can travel varies according to the type of work. For example, when performing planting, the work vehicle 130 may not be allowed to enter an already-planted region. Also, when performing harvesting, the work vehicle 130 may not be allowed to enter an unharvested region. For this reason, the autonomous traveling system 100 according to the present embodiment generates a route to the departure position 13 according to the model of the work machine used for the work.
  • the autonomous traveling system 100 is provided with a terminal 110 and the work vehicle 130 , as illustrated in FIG. 2 .
  • the terminal 110 generates a route along which the work vehicle 130 moves within a field.
  • the terminal 110 is provided with an input/output device 111 , a communication device 112 , a storage device 113 , and a computation device 114 .
  • Examples of the terminal 110 are a computer, a tablet, and a mobile phone.
  • the input/output device 111 information used by the computation device 114 to execute processing is input.
  • the input/output device 111 outputs a result of the processing executed by the computation device 114 .
  • the input/output device 111 includes various kinds of input devices and output devices, and examples of the input/output device 111 are a keyboard, a mouse, a microphone, a display, a speaker, and a touch panel.
  • the communication device 112 communicates with a communication device 131 of the work vehicle 130 .
  • the communication device 112 transfers each piece of information acquired from the work vehicle 130 to the computation device 114 . Signals generated by the computation device 114 are also transferred to the communication device 131 of the work vehicle 130 .
  • the communication device 112 includes, for example, a transceiver for a wireless local area network (LAN) and various interfaces such as a network interface card (NIC) and a universal serial bus (USB).
  • LAN local area network
  • NIC network interface card
  • USB universal serial bus
  • the storage device 113 stores various kinds of data for setting a route of the work vehicle 130 , e.g., a route setting program 200 .
  • the storage device 113 is used as a non-transitory tangible storage medium to store the route setting program 200 .
  • the route setting program 200 may be provided as a computer program product recorded on a computer-readable storage medium 1 , or may be provided as a computer program product that can be downloaded from a server.
  • the computation device 114 reads the route setting program 200 from the storage device 113 and executes the route setting program 200 , thereby performing various kinds of data processing for setting a route of the work vehicle 130 .
  • the computation device 114 executes the route setting program 200 , thereby realizing a work route setting unit 210 , a situation ascertainment unit 220 , a departure position setting unit 230 , and a departure route setting unit 240 , as illustrated in FIG. 3 .
  • the computation device 114 includes a central processing unit (CPU) and the like.
  • the work route setting unit 210 generates a work route along which the work vehicle 130 moves when work is performed in the field 10 .
  • the situation ascertainment unit 220 acquires the positions of the work vehicle 130 in the field 10 at respective times and ascertains the situation of the work within the field.
  • the departure position setting unit 230 sets the departure position 13 where the work vehicle 130 , which has departed from the work region 11 toward the headland 12 , is to stop in replenishment of materials and the like.
  • the departure route setting unit 240 generates a departure route to be taken when the work vehicle 130 moves to the departure position 13 .
  • the work vehicle 130 is provided with the communication device 131 , a positioning device 132 , and a control device 133 .
  • the communication device 131 communicates with the communication device 112 of the terminal 110 .
  • the communication device 131 transfers each piece of information acquired from the computation device 114 of the terminal 110 to the control device 133 .
  • Signals generated by the control device 133 are also transferred to the communication device 112 of the terminal 110 .
  • the communication device 131 includes, for example, a transceiver for a wireless local area network (LAN) and various interfaces such as a network interface card (NIC) and a universal serial bus (USB).
  • LAN local area network
  • NIC network interface card
  • USB universal serial bus
  • the positioning device 132 measures the position of the work vehicle 130 .
  • the positioning device 132 is a receiver of, for example, a global navigation satellite system (GNSS), and measures the positions of the work vehicle 130 at respective times by receiving signals from an artificial satellite or a terrestrial base station. Positional information indicating the time when and the position at which the measurement has been made is transmitted to the control device 133 .
  • GNSS global navigation satellite system
  • the control device 133 controls each unit of the work vehicle 130 and realizes a vehicle control unit 260 illustrated in FIG. 3 .
  • the vehicle control unit 260 acquires the positional information of the work vehicle 130 from the positioning device 132 , and performs an operation of the work vehicle 130 , such as acceleration, steering, and braking, thereby causing the work vehicle 130 to move along a route acquired from the terminal 110 .
  • the vehicle control unit 260 controls an operation of a work machine and performs work within the field 10 .
  • the control device 133 includes a computation device such as a central processing unit (CPU).
  • step S 110 the work route setting unit 210 which is realized by the computation device 114 of the terminal 110 generates, in the vehicle control unit 260 of the work vehicle 130 , a work start signal indicating a work route and a start of the work.
  • the vehicle control unit 260 controls the work vehicle 130 such that the work vehicle 130 moves automatically along the work route indicated by the work start signal.
  • the vehicle control unit 260 controls the operation of the work machine on the basis of the work start signal. Note that the work route is set before starting the work and is stored in the storage device 113 of the terminal 110 .
  • step S 120 the situation ascertainment unit 220 acquires positional information from the vehicle control unit 260 of the work vehicle 130 , and decides on an already-worked region and an unworked region on the basis of the acquired positional information. Specifically, the vehicle control unit 260 transmits the positional information measured by the positioning device 132 to the situation ascertainment unit 220 . The situation ascertainment unit 220 acquires the positions of the work vehicle 130 at respective times from the acquired positional information, and decides on a region in which the work has been finished on the basis of the acquired positions of the work vehicle 130 .
  • the situation ascertainment unit 220 decides that the periphery of the acquired positions of the work vehicle 130 , i.e., a range included in a predetermined distance from the acquired positions, for example, is to be applied as the already-worked region in which the work has been finished. Therefore, the situation ascertainment unit 220 decides that a region, which is from a start position to the position of the work vehicle 130 in the work route, is to be applied as a region in which the work has been finished. Also, the situation ascertainment unit 220 decides that a region, which is from the position of the work vehicle 130 to an end position in the work route, is to be applied as a region in which the work is yet to be finished.
  • step S 130 the situation ascertainment unit 220 determines whether a departure operation for causing the work vehicle 130 to be departed to the departure position 13 has been input to the input/output device 111 of the terminal 110 .
  • the situation ascertainment unit 220 displays a departure button on the input/output device 111 of the terminal 110 to receive the departure operation made by the user.
  • the situation ascertainment unit 220 determines that the departure operation has been input. If the situation ascertainment unit 220 determines that no departure operation has been input, processing is returned to the processing of step S 120 to repeat this processing. If the situation ascertainment unit 220 determines that the departure operation has been input, the processing proceeds to step S 140 .
  • the departure route setting unit 240 decides on a traveling region 300 in which the work vehicle 130 is to travel on the basis of the work machine. Specifically, the departure route setting unit 240 selects one region segment from among multiple region segments, e.g., three region segments, on the basis of the work machine, more specifically, the type or model of the work machine, for example.
  • the region segment represents a travelable region decided according to the work, and is associated with the type or model of the work machine used for the work.
  • the departure route setting unit 240 decides on the traveling region 300 on the basis of the selected region segment.
  • the type or model of the work machine may be input by the user from the input/output device 111 of the terminal 110 in advance or obtained from the vehicle control unit 260 of the work vehicle 130 .
  • the departure route setting unit 240 sets, on the basis of the type or model of the work machine being used, the unworked region to be prohibited from being traveled, and selects a region segment in which the already-worked region and the headland 12 are set as a travelable region.
  • the departure route setting unit 240 sets the unworked region as a traveling prohibited region 310 where traveling of the work vehicle 130 is prohibited, as illustrated in FIG. 5 A .
  • the already-worked region i.e., a region surrounding a track 140 on which the work vehicle 130 has moved, for example, and the headland 12 are set as the traveling region 300 in which the work vehicle 130 can travel.
  • the departure route setting unit 240 sets, on the basis of the type or model of the work machine being used, the already-worked region to be prohibited from being traveled, and selects a region segment in which the unworked region and the headland 12 are set as a travelable region.
  • the departure route setting unit 240 sets the already-worked region as the traveling prohibited region 310 where traveling of the work vehicle 130 is prohibited, as illustrated in FIG. 5 B .
  • the unworked region and the headland 12 are set as the traveling region 300 in which the work vehicle 130 can travel.
  • the departure route setting unit 240 selects, on the basis of the type or model of the work machine being used, a region segment in which the whole of the field 10 is set as a travelable region.
  • the departure route setting unit 240 sets the entire field 10 as the traveling region 300 in which the work vehicle 130 can travel.
  • the departure route setting unit 240 may generate a shortest route from the position of the work vehicle 130 to the departure position 13 as the departure route.
  • step S 150 the departure position setting unit 230 selects the departure position 13 and a departure direction 350 , which represents a traveling direction taken at the time of stopping at the departure position 13 , in response to the user input.
  • the user selects the departure position 13 on a map of the field 10 displayed on the input/output device 111 of the terminal 110 , as illustrated in FIG. 6 .
  • the departure position setting unit 230 sets the selected departure position 13 as the position for departure.
  • the user selects the departure direction 350 representing the traveling direction taken at the time when the work vehicle 130 stops at the departure position 13 .
  • the departure position setting unit 230 sets the selected departure direction 350 as the traveling direction taken at the time when the work vehicle 130 reaches the departure position 13 .
  • step S 160 the departure route setting unit 240 generates a departure route from the work vehicle 130 of the current location to the departure position 13 .
  • the departure route is generated such that the entire route is included in the traveling region 300 . A method of generating the departure route will be described later.
  • step S 170 the departure route setting unit 240 generates, in the vehicle control unit 260 of the work vehicle 130 , a departure start signal indicating the departure route.
  • the vehicle control unit 260 controls the work vehicle 130 such that the work vehicle 130 moves automatically along the departure route indicated by the departure start signal.
  • the situation ascertainment unit 220 acquires the positional information from the vehicle control unit 260 of the work vehicle 130 . Specifically, the vehicle control unit 260 transmits the positional information measured by the positioning device 132 to the situation ascertainment unit 220 . The situation ascertainment unit 220 acquires the positions of the work vehicle 130 at respective times from the acquired positional information.
  • step S 180 the situation ascertainment unit 220 ascertains that the work vehicle 130 has reached the departure position 13 and has stopped.
  • the processing is ended.
  • the computation device 114 when the work vehicle 130 departs toward the headland 12 , the computation device 114 generates the departure route according to the type or model of the work machine.
  • the vehicle control unit 260 causes the work vehicle 130 to move along the generated departure route. In this way, according to an autonomous traveling method, the work vehicle 130 can depart from the work region.
  • the computation device 114 of the terminal 110 executes the processing illustrated in FIGS. 7 A and 7 B , and generates the departure route.
  • the departure route setting unit 240 realized by the computation device 114 of the terminal 110 generates, in step S 205 , a first route 400 on the basis of the position of the work vehicle 130 .
  • the departure route setting unit 240 generates, on the basis of the region segment selected in step S 140 of FIG. 4 and the position of the work vehicle 130 , the first route 400 parallel to the traveling direction of the work vehicle 130 with the current position of the work vehicle 130 being a starting point.
  • the departure route setting unit 240 sets, as illustrated in FIG. 8 A , a line segment extending a predetermined distance, e.g., one meter, in the traveling direction, with the current position of the work vehicle 130 being a starting point, as the first route 400 .
  • the first route 400 indicates that the work vehicle 130 is to move forward along the first route 400 .
  • the departure route setting unit 240 sets, as illustrated in FIG. 8 A .
  • the first route 400 indicates that the work vehicle 130 is to move backward along the first route 400 .
  • step S 210 illustrated in FIG. 7 A the departure route setting unit 240 generates a second route 410 on the basis of the departure position 13 .
  • the departure route setting unit 240 sets, as illustrated in FIG. 9 , a line segment extending a predetermined distance, e.g., one meter, in the opposite direction of the departure direction 350 , with the departure position 13 being an end point, as the second route 410 .
  • the second route 410 indicates that the work vehicle 130 is to proceed in the departure direction 350 along the set line segment.
  • step S 215 illustrated in FIG. 7 A the departure route setting unit 240 determines whether a second starting point 411 of the second route 410 is adjacent to the work region 11 included in the traveling region 300 . Specifically, the departure route setting unit 240 determines whether the work vehicle 130 can move directly from the work region 11 to the second starting point 411 of the second route 410 . For example, as illustrated in FIG. 9 , when the work region 11 adjacent to the second starting point 411 of the second route 410 corresponds to the traveling prohibited region 310 , the departure route setting unit 240 determines that the work vehicle 130 cannot move directly from the work region 11 to the second starting point 411 of the second route 410 , and executes the processing of step S 220 .
  • the departure route setting unit 240 determines that the work vehicle 130 can move directly from the work region 11 to the second starting point 411 of the second route 410 , and executes the processing of step S 225 .
  • the departure route setting unit 240 extends the second route 410 from the second starting point 411 of the second route 410 along the headland 12 until the route is adjacent to the work region 11 included in the traveling region 300 .
  • the departure route setting unit 240 generates an extended route 412 along the headland 12 from the starting point of the second route 410 , as illustrated in FIG. 9 .
  • the extended route 412 is extended from an end point of the extended route 412 to a position at which an extension starting point 413 of the extended route 412 is adjacent to the work region 11 included in the traveling region 300 . Therefore, the extension starting point 413 of the extended route 412 is set at a position where the work vehicle 130 can move directly from the work region 11 .
  • the departure route setting unit 240 performs the subsequent processing assuming that a route obtained by adding the extended route 412 to the second route 410 is the second route 410 .
  • step S 225 the departure route setting unit 240 generates a first circle 420 tangent to the second route 410 , thereby generating a route through which the work vehicle 130 enters the second route 410 .
  • the departure route setting unit 240 generates the first circle 420 tangent to the second route 410 , or more specifically, the extended route 412 in this case, with the starting point of the second route 410 , or more specifically, the extension starting point 413 of the extended route 412 obtained by extending the second route 410 in this case, being the point of tangency.
  • the first circle 420 is generated so as to be tangent to a straight line extending in the traveling direction of the work vehicle 130 at the extension starting point 413 of the extended route 412 .
  • the work vehicle 130 moves clockwise along the circumference of the first circle 420 such that the traveling direction is changed to the right along the circumference of the first circle 420 .
  • the work vehicle 130 moves along the extended route 412 .
  • the first circle 420 has a minimum turning radius indicating the minimum radius at which the work vehicle 130 can turn.
  • step S 230 illustrated in FIG. 7 B the departure route setting unit 240 determines whether an angle formed between a first tangent line 430 , which passes a first end point 401 of the first route 400 and is tangent to the first circle 420 , and the first route 400 is less than a threshold value. Specifically, the departure route setting unit 240 generates the first tangent line 430 that passes the first end point 401 of the first route 400 and is tangent to the first circle 420 , as illustrated in FIG. 9 . Next, as illustrated in FIG. 10 , a first angle 450 formed between the first route 400 and the first tangent line 430 is calculated.
  • the departure route setting unit 240 compares the calculated first angle 450 with the threshold value, and executes the processing of step S 235 when the first angle 450 is smaller than the threshold value.
  • the departure route setting unit 240 executes the processing of step S 240 when the first angle 450 is greater than or equal to the threshold value.
  • the threshold value is determined on the basis of an angle at which the turning radius can be ignored when the work vehicle 130 is to change the traveling direction. For example, when the turning radius of the work vehicle 130 can be ignored if the angle for changing the traveling direction of the work vehicle 130 is 45 degrees or less, the threshold value is 135 degrees.
  • step S 235 the departure route setting unit 240 generates a second circle 440 with the first end point 401 of the first route 400 being the point of tangency such that the work vehicle 130 makes a turn toward the first circle 420 .
  • the departure route setting unit 240 generates the second circle 440 tangent to the first route 400 , with the first end point 401 of the first route 400 being the point of tangency.
  • the second circle 440 is generated so as to be tangent to a straight line including the first route 400 .
  • the work vehicle 130 moves clockwise along the circumference of the second circle 440 such that the traveling direction is changed to the right along the circumference of the second circle 440 . By doing so, the traveling direction of the work vehicle 130 is oriented toward the first circle 420 .
  • the second circle 440 has a minimum turning radius indicating the minimum radius at which the work vehicle 130 can turn.
  • step S 240 the departure route setting unit 240 generates a second tangent line 460 which is tangent to the first circle 420 and the second circle 440 .
  • the second tangent line 460 indicates a route along which the work vehicle 130 moves from the second circle 440 to the first circle 420 .
  • the circumference of the second circle 440 represents a route along which the work vehicle 130 moves clockwise. Therefore, the departure route setting unit 240 generates the second tangent line 460 such that the second circle 440 is located to the right of the work vehicle 130 when the work vehicle 130 moves along the second tangent line 460 .
  • the circumference of the first circle 420 also represents a route along which the work vehicle 130 moves clockwise.
  • the departure route setting unit 240 generates the second tangent line 460 such that the first circle 420 is located to the right of the work vehicle 130 when the work vehicle 130 moves along the second tangent line 460 .
  • the second tangent line 460 is generated according to the direction in which the work vehicle 130 turns as the work vehicle 130 moves over the circumference of the first circle 420 and the circumference of the second circle 440 .
  • step S 245 the departure route setting unit 240 generates a departure route 500 which connects each of the circles and the line segments that have been generated.
  • the departure route setting unit 240 sets a route connecting the first route 400 , the circumference of the second circle 440 , the second tangent line 460 , the circumference of the first circle 420 , the extended route 412 , and the second route 410 , as the departure route 500 .
  • an arc formed by connecting the point of tangency with the first route 400 (i.e., the first end point 401 ), which is assumed as the starting point, and the point of tangency with the second tangent line 460 , which is assumed as the end point, in a clockwise manner is set as a part of the departure route 500 illustrated in FIG. 12 .
  • the second tangent line 460 illustrated in FIG. 11 a line segment in which the point of tangency with the second circle 440 corresponds to the starting point and the point of tangency with the first circle 420 corresponds to the end point is set as a part of the departure route 500 .
  • an arc formed by connecting the point of tangency with the second tangent line 460 , which is assumed as the starting point, and the point of tangency with the extended route 412 (i.e., the extension starting point 413 ), which is assumed as the end point, in a clockwise manner is set as a part of the departure route 500 .
  • the departure route setting unit 240 generates the route connecting the first route 400 , the arc of the second circle 440 that is set as the route, the line segment of the second tangent line 460 that is set as the route, the arc of the first circle 420 that is set as the route, the extended route 412 , and the second route 410 as the departure route 500 illustrated in FIG. 12 .
  • the departure route setting unit 240 does not generate the second circle 440 .
  • the departure route setting unit 240 generates a route connecting, for example, the first route 400 , the first tangent line 430 , the circumference of the first circle 420 , the extended route 412 , and the second route 410 , which have been generated, as the departure route 500 .
  • the departure route setting unit 240 does not generate the extended route 412 .
  • the departure route setting unit 240 generates a route connecting, for example, the first route 400 , the circumference of the second circle 440 , the second tangent line 460 , the circumference of the first circle 420 , and the second route 410 , which have been generated, as the departure route 500 .
  • step S 250 the departure route setting unit 240 determines whether the generated departure route 500 passes through the traveling prohibited region 310 .
  • the departure route setting unit 240 executes step S 255 in order to change the departure route 500 .
  • the departure route setting unit 240 decides that the generated departure route 500 is to be applied as the route for the work vehicle 130 to depart to the departure position 13 , and ends the generation of the departure route 500 .
  • the departure route setting unit 240 changes the route, which is included in the traveling prohibited region 310 , of the generated departure route 500 to a route along a boundary between the traveling prohibited region 310 and the traveling region 300 . Specifically, when the work vehicle 130 is to move along the generated departure route 500 , the departure route setting unit 240 extracts a position where the work vehicle 130 enters the traveling prohibited region 310 as the starting point, and extracts a position where the work vehicle 130 enters the traveling region 300 from the traveling prohibited region 310 as the end point. The departure route setting unit 240 generates a detour route so that the route is detoured from the extracted starting point to the extracted end point by connecting those points along the boundary between the traveling prohibited region 310 and the traveling region 300 .
  • the departure route setting unit 240 changes the route, which is included in the traveling prohibited region 310 , of the departure route 500 to the generated detour route. Consequently, the departure route 500 which does not pass through the traveling prohibited region 310 is generated.
  • the departure route setting unit 240 decides that the newly generated departure route 500 is to be applied as the route for the work vehicle 130 to depart to the departure position 13 , and ends the generation of the departure route 500 .
  • the autonomous traveling system 100 when the work vehicle 130 departs from the work region 11 , the autonomous traveling system 100 generates a route to the departure position 13 according to the type or model of the work machine, and can cause the work vehicle 130 to move along the generated route. Also, as the departure direction 350 is set, the autonomous traveling system 100 can stop the work vehicle 130 at the departure position 13 in such a way that the work vehicle 130 is oriented in a direction specified by the user, i.e., a direction in which it is easy for the user to get in and out of the work vehicle 130 , for example.
  • the configurations described in the embodiment are merely an example and can be modified to an extent that does not interfere with the function to be aimed.
  • the present embodiment discloses an example in which the situation ascertainment unit 220 causes the work vehicle 130 to depart from the work region 11 on the basis of an input of the departure operation.
  • the situation ascertainment unit 220 may cause the work vehicle 130 to depart from the work region 11 on the basis of a predetermined instruction.
  • the situation ascertainment unit 220 may cause the work vehicle 130 to depart on the basis of a replenishment instruction indicating that materials mounted on the work vehicle 130 , such as seedlings, fertilizers, and pesticides, are to be replenished.
  • the situation ascertainment unit 220 acquires the amount of materials being mounted from the work vehicle 130 .
  • the situation ascertainment unit 220 determines that the replenishment instruction for replenishment of the materials has been input.
  • the situation ascertainment unit 220 may determine that the replenishment instruction has been input.
  • the situation ascertainment unit 220 may cause the work vehicle 130 to depart from the work region 11 on the basis of a discharge instruction indicating that the harvested crops are to be discharged. For example, the situation ascertainment unit 220 acquires the amount of crops being accumulated from the work vehicle 130 . When the acquired amount of crops is greater than a threshold value, the situation ascertainment unit 220 determines that the discharge instruction for discharge of the crops has been input. Also, as the user inputs an operation for replenishment of the materials, the situation ascertainment unit 220 may determine that the discharge instruction has been input.
  • the present embodiment discloses an example in which the situation ascertainment unit 220 determines an already-worked region when the work vehicle 130 is moving along the work route.
  • the present embodiment is not limited to this example. It is sufficient if the situation ascertainment unit 220 can distinguish between the already-worked region and the unworked region when a departure operation is input.
  • the situation ascertainment unit 220 may distinguish between the already-worked region and the unworked region on the basis of the position of the work vehicle 130 when the departure operation is input.
  • the situation ascertainment unit 220 decides that a region, which is from a start position to the position of the work vehicle 130 in the work route, is to be applied as the already-worked region.
  • the situation ascertainment unit 220 decides that a region, which is from the position of the work vehicle 130 to an end position in the work route, is to be applied as the unworked region.
  • the present embodiment discloses an example in which the departure route setting unit 240 selects one region segment from among three region segments, on the basis of the type or model of the work machine.
  • the departure route setting unit 240 may select one region segment from among at least two region segments.
  • the region segment may be set in advance by the user.
  • the user may set a region segment in which a predetermined region within the field 10 is assumed as the traveling prohibited region 310 , and such a region segment may be associated with the type or model of the work machine.
  • the set region segment is stored in the storage device 113 .
  • the positioning device 132 may be selected arbitrarily on condition that the positioning device 132 can measure the position of the work vehicle 130 .
  • the positioning device 132 may measure the position of the work vehicle 130 by acquiring the speed, the traveling direction, and the like, of the work vehicle 130 and calculating a moving route of the work vehicle 130 .
  • the terminal 110 may be realized by a plurality of terminals 110 , and the terminal 110 may be a route setting device provided with the situation ascertainment unit 220 and the departure route setting unit 240 . Moreover, the terminal 110 may be an autonomous traveling system provided with the vehicle control unit 260 .

Landscapes

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

Abstract

A route setting device includes a situation ascertainment unit and a departure route setting unit. The situation ascertainment unit receives an instruction for a work vehicle moving through a field along a preset work route, and acquires the location of the work vehicle. On the basis of the instruction and the work machinery used for work in the field by the work vehicle moving within the field, the departure route setting unit generates a departure route for departing from a work region where work is being done by the work vehicle in the field.

Description

    TECHNICAL FIELD
  • The present invention relates to a route setting method, an autonomous traveling method, a route setting device, an autonomous traveling system, and a storage medium.
  • BACKGROUND ART
  • Recently, studies have been conducted on autonomous traveling systems which perform farmwork as a result of the autonomous traveling systems automatically moving within a field.
  • Patent Literature 1 (JPH09-154315 A) discloses a control device for which a position for replenishment of materials or discharge of the harvest is set in advance in a field, and by which a work vehicle that is working within the field is moved to the set position on the basis of an instruction by a worker.
  • Patent Literature 2 (JP 2019-174890 A) discloses an automatic traveling system which causes a work vehicle that is working within a field to move to a preset evacuation region on the basis of an instruction by a worker.
  • CITATION LIST Patent Literature
    • Patent Literature 1: JPH09-154315 A
    • Patent Literature 2: JP 2019-174890 A
    DISCLOSURE OF INVENTION
  • In the technologies described in Patent Literatures 1 and 2, when the work vehicle is to move to the replenishment position or the evacuation region, a travelable region for the work vehicle is not set according to the type of work. However, the travelable region differs according to type of work being performed in the field. For example, in work for performing seeding, the work vehicle should not travel through an already-worked region. Also, in work for performing harvesting, the work vehicle should not travel through an unworked region.
  • In view of the above circumstances, one of the objectives of the present disclosure is to provide a route setting device which sets a travelable region according to the type of work. The other objectives can be understood from the following description and the description of embodiments.
  • A route setting method according to one embodiment for achieving the above objective includes receiving an instruction for a work vehicle moving in a field along a preset work route, and acquiring the position of the work vehicle. Also, the route setting method includes generating a departure route for the work vehicle to depart from a work region in which the work vehicle performs work in the field, on the basis of the instruction and a work machine used for the work in the field as the work vehicle moves within the field.
  • An autonomous traveling method according to one embodiment for achieving the above objective includes the route setting method described above and causing a work vehicle to move along a departure route or a work route automatically.
  • A route setting device according to one embodiment for achieving the above objective is provided with a situation ascertainment unit and a departure route setting unit. The situation ascertainment unit receives an instruction for a work vehicle moving in a field along a preset work route, and acquires the position of the work vehicle. The departure route setting unit generates, on the basis of the instruction and a work machine used for work in the field as the work vehicle moves within the field, a departure route for the work vehicle to depart from a work region in which the work vehicle performs the work in the field.
  • An autonomous traveling system according to one embodiment for achieving the above objective includes the route setting device described above and a work vehicle that moves along a departure route or a work route automatically.
  • A non-transitory tangible storage medium according to one embodiment for achieving the above objective stores a route setting program. The route setting program causes a computation device to execute receiving an instruction for a work vehicle moving in a field along a preset work route, and acquiring the position of the work vehicle. Also, the route setting program causes the computation device to execute generating a departure route for the work vehicle to depart from a work region in which the work vehicle performs work in the field, on the basis of the instruction and a work machine used for the work in the field as the work vehicle moves within the field.
  • According to the above embodiments, a travel vehicle can travel through a region corresponding to the type of work.
  • BRIEF DESCRIPTION OF DRAWINGS
  • FIG. 1 is a schematic view of a field of one embodiment.
  • FIG. 2 is a configuration diagram of an autonomous traveling system of one embodiment.
  • FIG. 3 is a functional block diagram of an autonomous traveling system of one embodiment.
  • FIG. 4 is a flowchart illustrating processing executed by a route setting program of one embodiment.
  • FIG. 5A is a diagram for illustrating a region segment of one embodiment.
  • FIG. 5B is a diagram for illustrating a region segment of one embodiment.
  • FIG. 6 is a diagram for illustrating a departure position and a departure direction of one embodiment.
  • FIG. 7A is a flowchart illustrating processing of generating a departure route of one embodiment.
  • FIG. 7B is a flowchart illustrating processing of generating a departure route of one embodiment.
  • FIG. 8A is a diagram for illustrating processing of generating a first route of one embodiment.
  • FIG. 8B is a diagram for illustrating processing of generating a first route of one embodiment.
  • FIG. 9 is a diagram for illustrating processing of generating a departure route of one embodiment.
  • FIG. 10 is a diagram for illustrating processing of generating a departure route of one embodiment.
  • FIG. 11 is a diagram for illustrating processing of generating a departure route of one embodiment.
  • FIG. 12 is a diagram for illustrating processing of generating a departure route of one embodiment.
  • DESCRIPTION OF EMBODIMENTS Embodiments
  • An autonomous traveling system 100 according to the present embodiment of the present invention will be described with reference to the drawings. In the present embodiment, a field 10 in which work, such as plowing, leveling, fertilizing, harvesting, and the like, is performed using a work vehicle 130 includes a central work region 11 and a headland 12, which surrounds the work region 11, as illustrated in FIG. 1 . The work region 11 represents a region in which work is performed to cultivate crops. The headland 12 is provided to allow the work vehicle 130 to turn, for example. The work vehicle 130 includes a vehicle that tows a work machine, such as a tractor, and a vehicle formed integrally with a work machine, such as a combine harvester. The work vehicle 130 moves within the field 10, thereby performing work using the work machine in the field 10. When the work vehicle 130 is performing work in the field 10, the work vehicle 130 departs from the work region 11 and moves to a departure position 13 in order to have materials such as seedlings replenished. At this time, a traveling region in which the work vehicle 130 can travel varies according to the type of work. For example, when performing planting, the work vehicle 130 may not be allowed to enter an already-planted region. Also, when performing harvesting, the work vehicle 130 may not be allowed to enter an unharvested region. For this reason, the autonomous traveling system 100 according to the present embodiment generates a route to the departure position 13 according to the model of the work machine used for the work.
  • Configuration of Autonomous Traveling System
  • The autonomous traveling system 100 is provided with a terminal 110 and the work vehicle 130, as illustrated in FIG. 2 . The terminal 110 generates a route along which the work vehicle 130 moves within a field.
  • A configuration of the terminal 110 will be described. The terminal 110 is provided with an input/output device 111, a communication device 112, a storage device 113, and a computation device 114. Examples of the terminal 110 are a computer, a tablet, and a mobile phone. In the input/output device 111, information used by the computation device 114 to execute processing is input. In addition, the input/output device 111 outputs a result of the processing executed by the computation device 114. The input/output device 111 includes various kinds of input devices and output devices, and examples of the input/output device 111 are a keyboard, a mouse, a microphone, a display, a speaker, and a touch panel.
  • The communication device 112 communicates with a communication device 131 of the work vehicle 130. The communication device 112 transfers each piece of information acquired from the work vehicle 130 to the computation device 114. Signals generated by the computation device 114 are also transferred to the communication device 131 of the work vehicle 130. The communication device 112 includes, for example, a transceiver for a wireless local area network (LAN) and various interfaces such as a network interface card (NIC) and a universal serial bus (USB).
  • The storage device 113 stores various kinds of data for setting a route of the work vehicle 130, e.g., a route setting program 200. The storage device 113 is used as a non-transitory tangible storage medium to store the route setting program 200. The route setting program 200 may be provided as a computer program product recorded on a computer-readable storage medium 1, or may be provided as a computer program product that can be downloaded from a server.
  • The computation device 114 reads the route setting program 200 from the storage device 113 and executes the route setting program 200, thereby performing various kinds of data processing for setting a route of the work vehicle 130. The computation device 114 executes the route setting program 200, thereby realizing a work route setting unit 210, a situation ascertainment unit 220, a departure position setting unit 230, and a departure route setting unit 240, as illustrated in FIG. 3 . For example, the computation device 114 includes a central processing unit (CPU) and the like.
  • The work route setting unit 210 generates a work route along which the work vehicle 130 moves when work is performed in the field 10. The situation ascertainment unit 220 acquires the positions of the work vehicle 130 in the field 10 at respective times and ascertains the situation of the work within the field. The departure position setting unit 230 sets the departure position 13 where the work vehicle 130, which has departed from the work region 11 toward the headland 12, is to stop in replenishment of materials and the like. The departure route setting unit 240 generates a departure route to be taken when the work vehicle 130 moves to the departure position 13.
  • Next, a configuration of the work vehicle 130 will be described. As illustrated in FIG. 2 , the work vehicle 130 is provided with the communication device 131, a positioning device 132, and a control device 133. The communication device 131 communicates with the communication device 112 of the terminal 110. The communication device 131 transfers each piece of information acquired from the computation device 114 of the terminal 110 to the control device 133. Signals generated by the control device 133 are also transferred to the communication device 112 of the terminal 110. The communication device 131 includes, for example, a transceiver for a wireless local area network (LAN) and various interfaces such as a network interface card (NIC) and a universal serial bus (USB).
  • The positioning device 132 measures the position of the work vehicle 130. The positioning device 132 is a receiver of, for example, a global navigation satellite system (GNSS), and measures the positions of the work vehicle 130 at respective times by receiving signals from an artificial satellite or a terrestrial base station. Positional information indicating the time when and the position at which the measurement has been made is transmitted to the control device 133.
  • The control device 133 controls each unit of the work vehicle 130 and realizes a vehicle control unit 260 illustrated in FIG. 3 . The vehicle control unit 260 acquires the positional information of the work vehicle 130 from the positioning device 132, and performs an operation of the work vehicle 130, such as acceleration, steering, and braking, thereby causing the work vehicle 130 to move along a route acquired from the terminal 110. Also, the vehicle control unit 260 controls an operation of a work machine and performs work within the field 10. For example, the control device 133 includes a computation device such as a central processing unit (CPU).
  • Action of Autonomous Traveling System
  • When the work vehicle 130 moves to a position at which work in the field 10 is to be started, and a user, i.e., the owner or a producer of the field 10, for example, inputs to the terminal 110 an operation for starting the work, the terminal 110 executes processing illustrated in FIG. 4 corresponding to a route setting method. In step S110, the work route setting unit 210 which is realized by the computation device 114 of the terminal 110 generates, in the vehicle control unit 260 of the work vehicle 130, a work start signal indicating a work route and a start of the work. When the vehicle control unit 260 receives the work start signal, the vehicle control unit 260 controls the work vehicle 130 such that the work vehicle 130 moves automatically along the work route indicated by the work start signal. Also, the vehicle control unit 260 controls the operation of the work machine on the basis of the work start signal. Note that the work route is set before starting the work and is stored in the storage device 113 of the terminal 110.
  • In step S120, the situation ascertainment unit 220 acquires positional information from the vehicle control unit 260 of the work vehicle 130, and decides on an already-worked region and an unworked region on the basis of the acquired positional information. Specifically, the vehicle control unit 260 transmits the positional information measured by the positioning device 132 to the situation ascertainment unit 220. The situation ascertainment unit 220 acquires the positions of the work vehicle 130 at respective times from the acquired positional information, and decides on a region in which the work has been finished on the basis of the acquired positions of the work vehicle 130. For example, the situation ascertainment unit 220 decides that the periphery of the acquired positions of the work vehicle 130, i.e., a range included in a predetermined distance from the acquired positions, for example, is to be applied as the already-worked region in which the work has been finished. Therefore, the situation ascertainment unit 220 decides that a region, which is from a start position to the position of the work vehicle 130 in the work route, is to be applied as a region in which the work has been finished. Also, the situation ascertainment unit 220 decides that a region, which is from the position of the work vehicle 130 to an end position in the work route, is to be applied as a region in which the work is yet to be finished.
  • In step S130, the situation ascertainment unit 220 determines whether a departure operation for causing the work vehicle 130 to be departed to the departure position 13 has been input to the input/output device 111 of the terminal 110. For example, the situation ascertainment unit 220 displays a departure button on the input/output device 111 of the terminal 110 to receive the departure operation made by the user. When the user selects the departure button on the input/output device 111 of the terminal 110, the situation ascertainment unit 220 determines that the departure operation has been input. If the situation ascertainment unit 220 determines that no departure operation has been input, processing is returned to the processing of step S120 to repeat this processing. If the situation ascertainment unit 220 determines that the departure operation has been input, the processing proceeds to step S140.
  • In step S140, the departure route setting unit 240 decides on a traveling region 300 in which the work vehicle 130 is to travel on the basis of the work machine. Specifically, the departure route setting unit 240 selects one region segment from among multiple region segments, e.g., three region segments, on the basis of the work machine, more specifically, the type or model of the work machine, for example. The region segment represents a travelable region decided according to the work, and is associated with the type or model of the work machine used for the work. The departure route setting unit 240 decides on the traveling region 300 on the basis of the selected region segment. The type or model of the work machine may be input by the user from the input/output device 111 of the terminal 110 in advance or obtained from the vehicle control unit 260 of the work vehicle 130.
  • For example, it is assumed that a work machine for work, such as cultivation work or harvesting work in which the work vehicle 130 should not travel through a region where work has not been performed, is being used. In this case, the departure route setting unit 240 sets, on the basis of the type or model of the work machine being used, the unworked region to be prohibited from being traveled, and selects a region segment in which the already-worked region and the headland 12 are set as a travelable region. Thus, on the basis of the selected region segment, the departure route setting unit 240 sets the unworked region as a traveling prohibited region 310 where traveling of the work vehicle 130 is prohibited, as illustrated in FIG. 5A. Further, the already-worked region, i.e., a region surrounding a track 140 on which the work vehicle 130 has moved, for example, and the headland 12 are set as the traveling region 300 in which the work vehicle 130 can travel.
  • Further, it is assumed that a work machine for work, such as planting, in which the work vehicle 130 should not travel through the already-worked region is being used. In this case, the departure route setting unit 240 sets, on the basis of the type or model of the work machine being used, the already-worked region to be prohibited from being traveled, and selects a region segment in which the unworked region and the headland 12 are set as a travelable region. Thus, on the basis of the selected region segment, the departure route setting unit 240 sets the already-worked region as the traveling prohibited region 310 where traveling of the work vehicle 130 is prohibited, as illustrated in FIG. 5B. Furthermore, the unworked region and the headland 12 are set as the traveling region 300 in which the work vehicle 130 can travel.
  • Moreover, it is assumed that a work machine for work, such as pesticide spraying, in which the work vehicle 130 can travel through both the already-worked region and the unworked region is being used. In this case, the departure route setting unit 240 selects, on the basis of the type or model of the work machine being used, a region segment in which the whole of the field 10 is set as a travelable region. Thus, on the basis of the selected region segment, the departure route setting unit 240 sets the entire field 10 as the traveling region 300 in which the work vehicle 130 can travel. In this case, the departure route setting unit 240 may generate a shortest route from the position of the work vehicle 130 to the departure position 13 as the departure route.
  • In step S150, the departure position setting unit 230 selects the departure position 13 and a departure direction 350, which represents a traveling direction taken at the time of stopping at the departure position 13, in response to the user input. For example, the user selects the departure position 13 on a map of the field 10 displayed on the input/output device 111 of the terminal 110, as illustrated in FIG. 6 . The departure position setting unit 230 sets the selected departure position 13 as the position for departure. Further, the user selects the departure direction 350 representing the traveling direction taken at the time when the work vehicle 130 stops at the departure position 13. The departure position setting unit 230 sets the selected departure direction 350 as the traveling direction taken at the time when the work vehicle 130 reaches the departure position 13.
  • In step S160, the departure route setting unit 240 generates a departure route from the work vehicle 130 of the current location to the departure position 13. The departure route is generated such that the entire route is included in the traveling region 300. A method of generating the departure route will be described later.
  • In step S170, the departure route setting unit 240 generates, in the vehicle control unit 260 of the work vehicle 130, a departure start signal indicating the departure route. When the vehicle control unit 260 receives the departure start signal, the vehicle control unit 260 controls the work vehicle 130 such that the work vehicle 130 moves automatically along the departure route indicated by the departure start signal.
  • Further, the situation ascertainment unit 220 acquires the positional information from the vehicle control unit 260 of the work vehicle 130. Specifically, the vehicle control unit 260 transmits the positional information measured by the positioning device 132 to the situation ascertainment unit 220. The situation ascertainment unit 220 acquires the positions of the work vehicle 130 at respective times from the acquired positional information.
  • In step S180, the situation ascertainment unit 220 ascertains that the work vehicle 130 has reached the departure position 13 and has stopped. When the situation ascertainment unit 220 ascertains that the work vehicle 130 has stopped, the processing is ended.
  • In this way, when the work vehicle 130 departs toward the headland 12, the computation device 114 generates the departure route according to the type or model of the work machine. The vehicle control unit 260 causes the work vehicle 130 to move along the generated departure route. In this way, according to an autonomous traveling method, the work vehicle 130 can depart from the work region.
  • Method of Generating Departure Route
  • Next, a method of generating a departure route will be described. The computation device 114 of the terminal 110 executes the processing illustrated in FIGS. 7A and 7B, and generates the departure route. The departure route setting unit 240 realized by the computation device 114 of the terminal 110 generates, in step S205, a first route 400 on the basis of the position of the work vehicle 130. Specifically, the departure route setting unit 240 generates, on the basis of the region segment selected in step S140 of FIG. 4 and the position of the work vehicle 130, the first route 400 parallel to the traveling direction of the work vehicle 130 with the current position of the work vehicle 130 being a starting point.
  • For example, when a region segment in which the unworked region is set to be travelable is selected, the departure route setting unit 240 sets, as illustrated in FIG. 8A, a line segment extending a predetermined distance, e.g., one meter, in the traveling direction, with the current position of the work vehicle 130 being a starting point, as the first route 400. In this case, the first route 400 indicates that the work vehicle 130 is to move forward along the first route 400. Further, when a region segment in which the unworked region is set to be prohibited from being traveled is selected, the departure route setting unit 240 sets, as illustrated in FIG. 8B, a line segment extending a predetermined distance, e.g., one meter, backward, which is the opposite direction of the traveling direction, with the current position of the work vehicle 130 being a starting point, as the first route 400. In this case, the first route 400 indicates that the work vehicle 130 is to move backward along the first route 400.
  • In step S210 illustrated in FIG. 7A, the departure route setting unit 240 generates a second route 410 on the basis of the departure position 13. Specifically, the departure route setting unit 240 sets, as illustrated in FIG. 9 , a line segment extending a predetermined distance, e.g., one meter, in the opposite direction of the departure direction 350, with the departure position 13 being an end point, as the second route 410. The second route 410 indicates that the work vehicle 130 is to proceed in the departure direction 350 along the set line segment.
  • In step S215 illustrated in FIG. 7A, the departure route setting unit 240 determines whether a second starting point 411 of the second route 410 is adjacent to the work region 11 included in the traveling region 300. Specifically, the departure route setting unit 240 determines whether the work vehicle 130 can move directly from the work region 11 to the second starting point 411 of the second route 410. For example, as illustrated in FIG. 9 , when the work region 11 adjacent to the second starting point 411 of the second route 410 corresponds to the traveling prohibited region 310, the departure route setting unit 240 determines that the work vehicle 130 cannot move directly from the work region 11 to the second starting point 411 of the second route 410, and executes the processing of step S220. When the work region 11 adjacent to the second starting point 411 of the second route 410 corresponds to the traveling region 300, the departure route setting unit 240 determines that the work vehicle 130 can move directly from the work region 11 to the second starting point 411 of the second route 410, and executes the processing of step S225.
  • In step S220, the departure route setting unit 240 extends the second route 410 from the second starting point 411 of the second route 410 along the headland 12 until the route is adjacent to the work region 11 included in the traveling region 300. For example, the departure route setting unit 240 generates an extended route 412 along the headland 12 from the starting point of the second route 410, as illustrated in FIG. 9 . The extended route 412 is extended from an end point of the extended route 412 to a position at which an extension starting point 413 of the extended route 412 is adjacent to the work region 11 included in the traveling region 300. Therefore, the extension starting point 413 of the extended route 412 is set at a position where the work vehicle 130 can move directly from the work region 11. The departure route setting unit 240 performs the subsequent processing assuming that a route obtained by adding the extended route 412 to the second route 410 is the second route 410.
  • In step S225, the departure route setting unit 240 generates a first circle 420 tangent to the second route 410, thereby generating a route through which the work vehicle 130 enters the second route 410. As illustrated in FIG. 9 , the departure route setting unit 240 generates the first circle 420 tangent to the second route 410, or more specifically, the extended route 412 in this case, with the starting point of the second route 410, or more specifically, the extension starting point 413 of the extended route 412 obtained by extending the second route 410 in this case, being the point of tangency. More particularly, the first circle 420 is generated so as to be tangent to a straight line extending in the traveling direction of the work vehicle 130 at the extension starting point 413 of the extended route 412. In the example of FIG. 9 , the work vehicle 130 moves clockwise along the circumference of the first circle 420 such that the traveling direction is changed to the right along the circumference of the first circle 420. By doing so, the work vehicle 130 moves along the extended route 412. Here, the first circle 420 has a minimum turning radius indicating the minimum radius at which the work vehicle 130 can turn.
  • In step S230 illustrated in FIG. 7B, the departure route setting unit 240 determines whether an angle formed between a first tangent line 430, which passes a first end point 401 of the first route 400 and is tangent to the first circle 420, and the first route 400 is less than a threshold value. Specifically, the departure route setting unit 240 generates the first tangent line 430 that passes the first end point 401 of the first route 400 and is tangent to the first circle 420, as illustrated in FIG. 9 . Next, as illustrated in FIG. 10 , a first angle 450 formed between the first route 400 and the first tangent line 430 is calculated. The departure route setting unit 240 compares the calculated first angle 450 with the threshold value, and executes the processing of step S235 when the first angle 450 is smaller than the threshold value. The departure route setting unit 240 executes the processing of step S240 when the first angle 450 is greater than or equal to the threshold value. The threshold value is determined on the basis of an angle at which the turning radius can be ignored when the work vehicle 130 is to change the traveling direction. For example, when the turning radius of the work vehicle 130 can be ignored if the angle for changing the traveling direction of the work vehicle 130 is 45 degrees or less, the threshold value is 135 degrees.
  • In step S235, the departure route setting unit 240 generates a second circle 440 with the first end point 401 of the first route 400 being the point of tangency such that the work vehicle 130 makes a turn toward the first circle 420. As illustrated in FIG. 11 , the departure route setting unit 240 generates the second circle 440 tangent to the first route 400, with the first end point 401 of the first route 400 being the point of tangency. More particularly, the second circle 440 is generated so as to be tangent to a straight line including the first route 400. In the example of FIG. 9 , the work vehicle 130 moves clockwise along the circumference of the second circle 440 such that the traveling direction is changed to the right along the circumference of the second circle 440. By doing so, the traveling direction of the work vehicle 130 is oriented toward the first circle 420. Here, the second circle 440 has a minimum turning radius indicating the minimum radius at which the work vehicle 130 can turn.
  • In step S240, the departure route setting unit 240 generates a second tangent line 460 which is tangent to the first circle 420 and the second circle 440. As illustrated in FIG. 11, the second tangent line 460 indicates a route along which the work vehicle 130 moves from the second circle 440 to the first circle 420. The circumference of the second circle 440 represents a route along which the work vehicle 130 moves clockwise. Therefore, the departure route setting unit 240 generates the second tangent line 460 such that the second circle 440 is located to the right of the work vehicle 130 when the work vehicle 130 moves along the second tangent line 460. The circumference of the first circle 420 also represents a route along which the work vehicle 130 moves clockwise. Therefore, the departure route setting unit 240 generates the second tangent line 460 such that the first circle 420 is located to the right of the work vehicle 130 when the work vehicle 130 moves along the second tangent line 460. As can be seen, the second tangent line 460 is generated according to the direction in which the work vehicle 130 turns as the work vehicle 130 moves over the circumference of the first circle 420 and the circumference of the second circle 440.
  • In step S245, the departure route setting unit 240 generates a departure route 500 which connects each of the circles and the line segments that have been generated. In the example illustrated in FIG. 12 , the departure route setting unit 240 sets a route connecting the first route 400, the circumference of the second circle 440, the second tangent line 460, the circumference of the first circle 420, the extended route 412, and the second route 410, as the departure route 500. Specifically, of the circumference of the second circle 440 illustrated in FIG. 11 , an arc formed by connecting the point of tangency with the first route 400 (i.e., the first end point 401), which is assumed as the starting point, and the point of tangency with the second tangent line 460, which is assumed as the end point, in a clockwise manner is set as a part of the departure route 500 illustrated in FIG. 12 . In the second tangent line 460 illustrated in FIG. 11 , a line segment in which the point of tangency with the second circle 440 corresponds to the starting point and the point of tangency with the first circle 420 corresponds to the end point is set as a part of the departure route 500. Of the circumference of the first circle 420, an arc formed by connecting the point of tangency with the second tangent line 460, which is assumed as the starting point, and the point of tangency with the extended route 412 (i.e., the extension starting point 413), which is assumed as the end point, in a clockwise manner is set as a part of the departure route 500. As described above, the departure route setting unit 240 generates the route connecting the first route 400, the arc of the second circle 440 that is set as the route, the line segment of the second tangent line 460 that is set as the route, the arc of the first circle 420 that is set as the route, the extended route 412, and the second route 410 as the departure route 500 illustrated in FIG. 12 .
  • If it is determined as “NO” in step S230, or more specifically, if the first angle 450 formed between the first tangent line 430 and the first route 400 is greater than or equal to the threshold value, the departure route setting unit 240 does not generate the second circle 440. Thus, the departure route setting unit 240 generates a route connecting, for example, the first route 400, the first tangent line 430, the circumference of the first circle 420, the extended route 412, and the second route 410, which have been generated, as the departure route 500.
  • Further, if it is determined as “YES” in step S215, or more specifically, if the work vehicle 130 can move directly from the work region 11 to the second starting point 411 of the second route 410, the departure route setting unit 240 does not generate the extended route 412. Thus, the departure route setting unit 240 generates a route connecting, for example, the first route 400, the circumference of the second circle 440, the second tangent line 460, the circumference of the first circle 420, and the second route 410, which have been generated, as the departure route 500.
  • In step S250, the departure route setting unit 240 determines whether the generated departure route 500 passes through the traveling prohibited region 310. When the departure route 500 passes through the traveling prohibited region 310, the departure route setting unit 240 executes step S255 in order to change the departure route 500. When the departure route 500 does not pass through the traveling prohibited region 310, the departure route setting unit 240 decides that the generated departure route 500 is to be applied as the route for the work vehicle 130 to depart to the departure position 13, and ends the generation of the departure route 500.
  • In step S255, the departure route setting unit 240 changes the route, which is included in the traveling prohibited region 310, of the generated departure route 500 to a route along a boundary between the traveling prohibited region 310 and the traveling region 300. Specifically, when the work vehicle 130 is to move along the generated departure route 500, the departure route setting unit 240 extracts a position where the work vehicle 130 enters the traveling prohibited region 310 as the starting point, and extracts a position where the work vehicle 130 enters the traveling region 300 from the traveling prohibited region 310 as the end point. The departure route setting unit 240 generates a detour route so that the route is detoured from the extracted starting point to the extracted end point by connecting those points along the boundary between the traveling prohibited region 310 and the traveling region 300. The departure route setting unit 240 changes the route, which is included in the traveling prohibited region 310, of the departure route 500 to the generated detour route. Consequently, the departure route 500 which does not pass through the traveling prohibited region 310 is generated. The departure route setting unit 240 decides that the newly generated departure route 500 is to be applied as the route for the work vehicle 130 to depart to the departure position 13, and ends the generation of the departure route 500.
  • As described above, when the work vehicle 130 departs from the work region 11, the autonomous traveling system 100 generates a route to the departure position 13 according to the type or model of the work machine, and can cause the work vehicle 130 to move along the generated route. Also, as the departure direction 350 is set, the autonomous traveling system 100 can stop the work vehicle 130 at the departure position 13 in such a way that the work vehicle 130 is oriented in a direction specified by the user, i.e., a direction in which it is easy for the user to get in and out of the work vehicle 130, for example.
  • Modified Examples
  • The configurations described in the embodiment are merely an example and can be modified to an extent that does not interfere with the function to be aimed. The present embodiment discloses an example in which the situation ascertainment unit 220 causes the work vehicle 130 to depart from the work region 11 on the basis of an input of the departure operation. However, the present embodiment is not limited to this example. The situation ascertainment unit 220 may cause the work vehicle 130 to depart from the work region 11 on the basis of a predetermined instruction. For example, the situation ascertainment unit 220 may cause the work vehicle 130 to depart on the basis of a replenishment instruction indicating that materials mounted on the work vehicle 130, such as seedlings, fertilizers, and pesticides, are to be replenished. In this case, the situation ascertainment unit 220 acquires the amount of materials being mounted from the work vehicle 130. When the acquired amount of materials is less than a threshold value, the situation ascertainment unit 220 determines that the replenishment instruction for replenishment of the materials has been input. Also, as the user inputs an operation for replenishment of the materials, the situation ascertainment unit 220 may determine that the replenishment instruction has been input.
  • Further, the situation ascertainment unit 220 may cause the work vehicle 130 to depart from the work region 11 on the basis of a discharge instruction indicating that the harvested crops are to be discharged. For example, the situation ascertainment unit 220 acquires the amount of crops being accumulated from the work vehicle 130. When the acquired amount of crops is greater than a threshold value, the situation ascertainment unit 220 determines that the discharge instruction for discharge of the crops has been input. Also, as the user inputs an operation for replenishment of the materials, the situation ascertainment unit 220 may determine that the discharge instruction has been input.
  • The present embodiment discloses an example in which the situation ascertainment unit 220 determines an already-worked region when the work vehicle 130 is moving along the work route. However, the present embodiment is not limited to this example. It is sufficient if the situation ascertainment unit 220 can distinguish between the already-worked region and the unworked region when a departure operation is input. For example, the situation ascertainment unit 220 may distinguish between the already-worked region and the unworked region on the basis of the position of the work vehicle 130 when the departure operation is input. For example, the situation ascertainment unit 220 decides that a region, which is from a start position to the position of the work vehicle 130 in the work route, is to be applied as the already-worked region. Also, the situation ascertainment unit 220 decides that a region, which is from the position of the work vehicle 130 to an end position in the work route, is to be applied as the unworked region.
  • The present embodiment discloses an example in which the departure route setting unit 240 selects one region segment from among three region segments, on the basis of the type or model of the work machine. However, the present embodiment is not limited to this example. The departure route setting unit 240 may select one region segment from among at least two region segments. For example, the region segment may be set in advance by the user. The user may set a region segment in which a predetermined region within the field 10 is assumed as the traveling prohibited region 310, and such a region segment may be associated with the type or model of the work machine. The set region segment is stored in the storage device 113.
  • The positioning device 132 may be selected arbitrarily on condition that the positioning device 132 can measure the position of the work vehicle 130. For example, the positioning device 132 may measure the position of the work vehicle 130 by acquiring the speed, the traveling direction, and the like, of the work vehicle 130 and calculating a moving route of the work vehicle 130.
  • The embodiments and the modified examples that have been described above are merely an example, and the configurations described in the embodiments and the modified examples may be arbitrarily changed and/or arbitrarily combined to an extent that does not interfere with the function to be aimed. Furthermore, part of the functions that have been described in the embodiments and the modified examples may be omitted on condition that the necessary functions can be realized. For example, the terminal 110 may be realized by a plurality of terminals 110, and the terminal 110 may be a route setting device provided with the situation ascertainment unit 220 and the departure route setting unit 240. Moreover, the terminal 110 may be an autonomous traveling system provided with the vehicle control unit 260.
  • The present application is based upon and claims the benefit of priority from Japanese Patent Application No. 2020-211919, filed Dec. 22, 2020, and the entire disclosure of which is incorporated herein by reference.

Claims (13)

1. A route setting method comprising:
receiving an instruction for a work vehicle moving in a field along a preset work route;
acquiring a position of the work vehicle; and
generating, based on the instruction, the acquired position, and a work machine used for work in the field as the work vehicle moves within the field, a departure route for the work vehicle to depart from a work region in which the work vehicle performs the work in the field.
2. The route setting method according to claim 1, wherein:
generating the departure route includes selecting, based on the work machine, one region segment from among a plurality of region segments, each region segment of the plurality of region segments indicating a traveling region in which the work vehicle is allowed to travel within the field; and
an entire route of the departure route is included in the traveling region.
3. The route setting method according to claim 2, wherein a first region segment of the plurality of region segments includes, in the traveling region, a region in which the work has been finished at a time when the instruction is received.
4. The route setting method according to claim 3, further comprising:
deciding that the region in the preset work route is the first region segment, and
wherein the region is from a start position to a position of the work vehicle at the time when the instruction is received.
5. The route setting method according to claim 2, wherein a second region segment of the plurality of region segments includes, in the traveling region, a region in which the work is yet to be finished at a time when the instruction is received.
6. The route setting method according to claim 5, further comprising:
deciding that the region includes the work that is yet to be finished, and
wherein the region is from a position of the work vehicle at the time when the instruction is received to an end position in the preset work route.
7. The route setting method according to claim 2, wherein a third region segment of the plurality of region segments includes an entire area within the field as the traveling region.
8. The route setting method according to claim 7, wherein generating the departure route includes, based on selection of the third region segment from the plurality of region segments, generating the departure route as a shortest route from a position of the work vehicle at a time when the instruction is received to a departure position at which departure is made from the work region.
9. The route setting method according to claim 1, wherein the generating the departure route includes generating the departure route such that the work vehicle is oriented in a set departure direction at an ending point of the departure route.
10. An autonomous traveling method comprising:
the route setting method according to claim 1; and
causing the work vehicle to automatically move along the departure route or the preset work route automatically.
11. A route setting device comprising:
a situation ascertainment unit configured to:
receive an instruction for a work vehicle moving in a field along a preset work, route; and
acquire a position of the work vehicle; and
a departure route setting unit configured to generate, based on the instruction, the acquired position, and a work machine used for work in the field as the work vehicle moves within the field, a departure route for the work vehicle to depart from a work region in which the work vehicle is configured to perform the work in the field.
12. An autonomous traveling system comprising:
the route setting device according to claim 11; and
the work vehicle configured to automatically move along the departure route or the preset work route.
13. A non-transitory tangible storage medium storing a route setting program that, when executed by a computation device, causes the computation device to:
receive an instruction for a work vehicle moving in a field along a preset, route;
acquire a position of the work vehicle; and
generate, based on the instruction, the acquired position, and a work machine used for work in the field as the work vehicle moves within the field, a departure route for the work vehicle to depart from a work region in which the work is performed in the field.
US18/268,958 2020-12-22 2021-12-03 Route setting method, autonomous traveling method, route setting device, autonomous traveling system, and storage medium Pending US20240077876A1 (en)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2020211919A JP7487093B2 (en) 2020-12-22 2020-12-22 Route setting method, autonomous driving method, route setting device, autonomous driving system, and route setting program
JP2020-211919 2020-12-22
PCT/JP2021/044467 WO2022138071A1 (en) 2020-12-22 2021-12-03 Route setting method, autonomous traveling method, route setting device, autonomous traveling system, and storage medium

Publications (1)

Publication Number Publication Date
US20240077876A1 true US20240077876A1 (en) 2024-03-07

Family

ID=82159554

Family Applications (1)

Application Number Title Priority Date Filing Date
US18/268,958 Pending US20240077876A1 (en) 2020-12-22 2021-12-03 Route setting method, autonomous traveling method, route setting device, autonomous traveling system, and storage medium

Country Status (6)

Country Link
US (1) US20240077876A1 (en)
EP (1) EP4268554A1 (en)
JP (1) JP7487093B2 (en)
KR (1) KR20230122585A (en)
CN (1) CN116615699A (en)
WO (1) WO2022138071A1 (en)

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09154315A (en) 1995-12-12 1997-06-17 Kubota Corp Controller of working vehicle
US11726485B2 (en) 2016-09-05 2023-08-15 Kubota Corporation Autonomous work vehicle travel system, travel route managing device, travel route generating device, and travel route determining device
JP6674877B2 (en) 2016-09-26 2020-04-01 ヤンマー株式会社 Route generation system
KR20200096497A (en) 2017-12-18 2020-08-12 가부시끼 가이샤 구보다 Automatic driving system, automatic driving management program, recording medium recording the automatic driving management program, automatic driving management method, area determining system, area determining program, recording medium recording area determining program, area determining method, combine control system, combine control program , A recording medium recording the combine control program, and a combine control method
CN111386033B (en) 2017-12-18 2023-05-23 株式会社久保田 Combine harvester control system, program, method and storage medium thereof
JP6953343B2 (en) 2018-03-27 2021-10-27 ヤンマーパワーテクノロジー株式会社 Autonomous driving system
JP7353796B2 (en) 2019-05-17 2023-10-02 ヤンマーパワーテクノロジー株式会社 Automated driving system for work vehicles

Also Published As

Publication number Publication date
JP2022098513A (en) 2022-07-04
CN116615699A (en) 2023-08-18
KR20230122585A (en) 2023-08-22
EP4268554A1 (en) 2023-11-01
JP7487093B2 (en) 2024-05-20
WO2022138071A1 (en) 2022-06-30

Similar Documents

Publication Publication Date Title
US9826673B1 (en) Swath acquisition system for an agricultural vehicle
US9740208B2 (en) UAV-based sensing for worksite operations
KR101879247B1 (en) The Working Path Setting Method for Automatic Driving Agricultural Machine
KR20210036973A (en) A recording medium in which an external shape calculation system, an external shape calculation method, an external shape calculation program, and an external shape calculation program are recorded, a packaging map creation system, a packaging map creation program, a recording medium in which a packaging map creation program is recorded, and How to create a pavement map
US9521806B2 (en) Farm work machine, farm work management method, farm work management program, and recording medium recording the farm work management program
EP3444636A1 (en) Differential global positioning system and a positioning method therefor
JP7174484B2 (en) agricultural vehicle
JP2018147163A (en) Running route specifying system
JP7068961B2 (en) External shape calculation system and external shape calculation method
JP2022180405A (en) Work management system and work management method
CN114265409A (en) Track information processing method and device and ground equipment
US20240077876A1 (en) Route setting method, autonomous traveling method, route setting device, autonomous traveling system, and storage medium
CN112824937B (en) Route generation method and device and mower
JP2024016273A (en) Work relevant information managing device and work relevant information managing system
US20240045430A1 (en) Route setting method, autonomous traveling method, route setting device, autonomous traveling system, and storage medium
JP2021023263A (en) Work field identification device
JP2021135060A (en) Positioning processing device and positioning processing program
JP2020154783A (en) Work machine and work machine management system
US20230359200A1 (en) Work Area Management Method, Work Area Management System, And Work Area Management Program
EP4099124A1 (en) Automatic traveling method, automatic traveling system, and automatic traveling program
US11914379B2 (en) Methods and apparatus to generate a path plan
JP2024004592A (en) Work evaluation method, work evaluation system, and work evaluation program
EP4098094A2 (en) Automatic traveling method, automatic traveling system, and automatic traveling program
JP2023024502A (en) Work information management device
US20160018528A1 (en) Low speed heading measurement with buffer

Legal Events

Date Code Title Description
STPP Information on status: patent application and granting procedure in general

Free format text: DOCKETED NEW CASE - READY FOR EXAMINATION