WO2022149389A1 - 自動走行システム及び自動走行方法 - Google Patents

自動走行システム及び自動走行方法 Download PDF

Info

Publication number
WO2022149389A1
WO2022149389A1 PCT/JP2021/044753 JP2021044753W WO2022149389A1 WO 2022149389 A1 WO2022149389 A1 WO 2022149389A1 JP 2021044753 W JP2021044753 W JP 2021044753W WO 2022149389 A1 WO2022149389 A1 WO 2022149389A1
Authority
WO
WIPO (PCT)
Prior art keywords
boundary line
turning
traveling
travel
route
Prior art date
Application number
PCT/JP2021/044753
Other languages
English (en)
French (fr)
Inventor
森本孝紀
山口幸太郎
吉村史也
Original Assignee
株式会社クボタ
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 株式会社クボタ filed Critical 株式会社クボタ
Priority to EP21917610.4A priority Critical patent/EP4275466A1/en
Priority to US18/270,247 priority patent/US20240099176A1/en
Publication of WO2022149389A1 publication Critical patent/WO2022149389A1/ja

Links

Images

Classifications

    • A—HUMAN NECESSITIES
    • A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01B—SOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B69/00—Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
    • A01B69/007—Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow
    • A01B69/008—Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow automatic
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/20—Control system inputs
    • G05D1/22—Command input arrangements
    • G05D1/229—Command input data, e.g. waypoints
    • G05D1/2295—Command input data, e.g. waypoints defining restricted zones, e.g. no-flight zones or geofences
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/20—Control system inputs
    • G05D1/24—Arrangements for determining position or orientation
    • G05D1/247—Arrangements for determining position or orientation using signals provided by artificial sources external to the vehicle, e.g. navigation beacons
    • G05D1/248—Arrangements for determining position or orientation using signals provided by artificial sources external to the vehicle, e.g. navigation beacons generated by satellites, e.g. GPS
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/60—Intended control result
    • G05D1/648—Performing a task within a working area or space, e.g. cleaning
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2105/00—Specific applications of the controlled vehicles
    • G05D2105/15—Specific applications of the controlled vehicles for harvesting, sowing or mowing in agriculture or forestry
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2107/00—Specific environments of the controlled vehicles
    • G05D2107/20—Land use
    • G05D2107/21—Farming, e.g. fields, pastures or barns
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2109/00—Types of controlled vehicles
    • G05D2109/10—Land vehicles

Definitions

  • the present invention relates to an automatic traveling system and an automatic traveling method for a vehicle that shifts from a previous traveling route to a next traveling route via turning traveling.
  • Patent Document 1 discloses an automatic steering system for a vehicle having a vehicle position detection function that shifts from a previous traveling path to a next traveling path via a turning traveling.
  • This automatic steering system has a first steering control unit that performs steering control for the first turning drive that leaves the previous traveling path and heads for the next traveling path, and steering for the second turning traveling that enters the next traveling path.
  • a second steering control unit that controls, a third steering control unit that performs steering control for transitional travel between the first turn and the second turn, and a virtual route used as a target route for the second turn.
  • It includes a virtual turning circle calculation unit that calculates a turning circle, and a tangent line calculation unit that calculates a tangent line from a vehicle body reference point in the first turning running to the virtual turning circle as a target route of the transition running. Further, when the calculated angle formed by the tangent line and the traveling direction of the vehicle is within the first predetermined angle, the tangent line calculation unit uses the tangent line as the reference tangent line, and the third steering control unit serves as the reference. Steering control is performed with the tangent as the target route for transitional driving.
  • the transitional run from the first turn run to the second turn run is a straight run with the tangent line from the vehicle body reference point to the virtual turn circle as the target route in the first turn run, and the run along this tangent line is performed.
  • turning control for smoothly entering the next traveling route with the virtual turning circle as the target route becomes possible.
  • an object of the present invention is to keep the automatic steering as much as possible without stopping the automatic steering even if the transition route from the previous travel route to the next travel route contains a prohibition boundary line that prohibits the entry of vehicles. It is to provide an automatic driving system and an automatic driving method capable of shifting to the next traveling route.
  • the automatic traveling system is an automatic traveling system for a vehicle that shifts from a previous traveling route to a next traveling route via turning traveling. Calculated during travel: a prohibited boundary line setting unit that sets a prohibited boundary line that prohibits the entry of the vehicle, and a turning circle setting unit that sets a virtual turning circle as a target route for approach turning traveling that enters the next traveling route.
  • a prohibited boundary line setting unit that sets a prohibited boundary line that prohibits the entry of the vehicle
  • a turning circle setting unit that sets a virtual turning circle as a target route for approach turning traveling that enters the next traveling route.
  • the prohibited boundary line is regarded as an interference boundary line, and the vehicle interferes with this interference boundary line.
  • Interference avoidance running to avoid is performed. That is, in the tangent-following running, when the tangent line from the vehicle body reference point (for example, the center of the vehicle body) to the virtual turning circle intersects the prohibited boundary line, the traveling following the tangent line interferes with the prohibited boundary line. Interference avoidance running to avoid interference is executed. When the interference with the prohibited boundary line is avoided by this interference avoidance running, the vehicle can shift to the next running path through the tangential follow-up running and the approach turning running.
  • the interference avoidance travel control unit has a special direction change mode for executing space-saving turning travel using turn-back turning or left-right speed difference turning.
  • the prohibited boundaries such as ridges and fences are generally shaped by a combination of approximately straight lines, especially in the case of farms. Therefore, by traveling along the prohibited boundary line for a while at a distance from the prohibited boundary line regarded as the interference boundary line, it is possible to reach a position where the prohibited boundary line does not become the interference boundary line. For this reason, in a preferred embodiment, the interference avoidance travel control unit sets an interference avoidance route along the interference boundary line so that the vehicle can travel at a distance from the interference boundary line.
  • the tangent line from the vehicle body reference point to the virtual turning circle does not intersect the prohibited boundary line, so it is possible to follow the tangent line based on this tangent line. become.
  • the automatic travel control of the vehicle is taken over by the tangential tracking travel control unit. If there is a new prohibited boundary line in the tangent line or the traveling direction that has become the new transition travel route, a new interference avoidance route is calculated and the interference avoidance travel is repeated. As a result, the vehicle finally reaches the virtual turning circle and can enter the next traveling path.
  • the outline is the prohibited boundary line that the vehicle must not cross the border.
  • Many of the field work vehicles that automatically travel have a function of first calculating the shape of the work site, that is, the prohibited boundary line by orbiting along the outline of the work site. For this reason, in a preferred embodiment, the prohibited boundary line setting unit sets the inner / outer boundary line of the work site as the prohibited boundary line.
  • the prohibited boundary line setting unit sets the boundary line of at least a part of the unworked area by the work vehicle as the prohibited boundary line.
  • the departure turning run which is a turn to leave the previous running path that is the transition source, is a turn that matches the direction of the tangent line from the vehicle body reference point to the virtual turning circle, so it is the minimum within the range where the rough running ground is allowed. It is preferable to use the turning radius. Further, if the angle between the tangential line and the traveling direction of the vehicle becomes small to some extent, the control hunting is suppressed and smooth traveling can be obtained by switching from the turning traveling to the tangential following traveling. For this reason, in a preferred embodiment, the departure turning run leaving the previous traveling path is performed at a preset steering angle, and the tangential following running control unit is performed during the leaving turning running. Is done.
  • the present application is intended not only for an automatic driving system but also for an automatic driving method for a vehicle that shifts from a previous traveling path to the next traveling path via turning traveling.
  • Such an automatic driving method includes a prohibited boundary line setting step for setting a prohibited boundary line for prohibiting the entry of a vehicle and a turning circle setting step for setting a virtual turning circle as a target route for approaching turning driving to enter the next traveling route.
  • the tangent calculation step for calculating the tangent line from the vehicle body reference point calculated during running to the virtual turning circle, the tangent follow-up running control step for controlling the tangent follow-up running with the tangent direction as the target direction, and the above.
  • the transition turning travel control step for controlling the approaching turning traveling of the vehicle with the tangent as the transition target route, and the above-mentioned Interference boundary line detection step that detects the prohibited boundary line existing in the vehicle traveling direction in tangential follow-up travel as an interference boundary line, and interference avoidance that controls interference avoidance driving that prevents the vehicle from interfering with the interference boundary line. It is equipped with a travel control step.
  • This automatic traveling method also has the effect of the above-mentioned automatic traveling system, and the above-mentioned preferred embodiment can be applied.
  • the present application also covers vehicles using the above-mentioned automatic driving system and automatic driving method, programming in which the above-mentioned automatic driving method is computer-programmed, and media for storing the program.
  • FIG. 1 is a side view of a tractor which is an example of a work vehicle equipped with such an automatic traveling system. As shown in FIG. 1, this tractor travels in a field that is a work site while performing ground work.
  • the tractor is provided with a driver's cab 20 in the central portion of the vehicle body 1 supported by the front wheels 11 and the rear wheels 12.
  • the rear part of the vehicle body 1 is equipped with a rotary type tilling device 30 which is a working device via a hydraulic elevating mechanism.
  • the front wheel 11 functions as a steering wheel, and the traveling direction of the tractor is changed by changing the steering angle thereof.
  • the steering angle of the front wheels 11 is changed by the operation of the steering mechanism 13.
  • the steering mechanism 13 includes a steering motor 14 for automatic steering.
  • the front wheels 11 are steered by operating the steering wheel 22 arranged in the driver's cab 20.
  • This tractor is provided with a satellite positioning module 7 as a positioning module in the cabin 21 of the tractor in order to realize the own vehicle position detection function.
  • a satellite antenna for receiving GNSS (global navigation satellite system) signals is attached to the ceiling area of the cabin 21.
  • the satellite positioning module 7 can include an inertial navigation module incorporating a gyro acceleration sensor and a magnetic orientation sensor in order to complement satellite navigation.
  • the inertial navigation module may be provided at a place different from the satellite positioning module 7.
  • a general-purpose data processing terminal 4 is arranged in the driver's cab 20.
  • the data processing terminal 4 is a tablet-type computer provided with a touch panel 40, and can accept various operation inputs by the driver and notify the driver of various information through the touch panel 40.
  • FIG. 2 schematically shows a simplified example of the work running of a tractor working in a field. Since this field is surrounded by ridges, the prohibited boundary line BL that prohibits the entry of tractors is the inner boundary line (inner / outer boundary line) of the ridges.
  • the prohibited boundary line BL which is the inner boundary line of the ridge, is based on the vehicle position calculated from the positioning data acquired by the satellite positioning module 7 when the tractor orbits along the inner boundary line of the ridge. It is obtained from the obtained traveling locus.
  • the tractor travels straight along a linear travel path (indicated by reference numeral SL in FIG. 2) and from one linear travel path (previous travel path) to another. (The route is indicated by the reference numeral TL in FIG. 2) and the turning traveling for shifting to the linear traveling route (next traveling route) of the above are repeated.
  • turning travel is performed so as to sandwich one or more linear traveling paths.
  • the tilling work is performed by lowering the tilling device 30.
  • the tilling device 30 is raised and the tilling work is stopped.
  • FIG. 3 schematically shows a basic example of turning running by automatic steering.
  • a simple turning run that shifts from the linear running path (transition source) indicated by the reference numeral Ls to the linear traveling path (shifting destination) indicated by the reference numeral Ln is shown.
  • the linear travel path that is the migration source is the previous travel path Ls
  • the linear travel path that is the migration destination is the next travel path Ln.
  • Tr1 The traveling locus of this withdrawal turning run is shown by Tr1.
  • the departure turning run leaving the front running path Ls is performed at a preset steering angle, and shifts to the tangential follow-up running in the middle of the leaving turning run.
  • a virtual turning circle VC that is in contact with the next travel path Ln on the previous travel path Ls side of the next travel path Ln is set at a position near the start end of the next travel path Ln or an extension line thereof.
  • a tangent to the virtual turning circle VC is calculated from the vehicle body reference point Pv of the tractor performing the withdrawal turning run.
  • the vehicle body reference point Pv is substantially the center point of the tractor, but can be set at any position.
  • the direction of the line passing through the vehicle body reference point Pv and heading in the traveling direction of the tractor is the traveling direction.
  • the tractor performs tangential follow-up traveling with the calculated tangential direction as the target direction. If the angle formed by the calculated tangent line and the traveling direction is within a predetermined angle during the tangent line follow-up running, the tangent line is set as the reference tangent line RT. When the reference tangent RT is set, the tractor makes an approach turn to enter the next travel path Ln with the reference tangent RT as the transition target route and the virtual turning circle VC as the turning target route.
  • the traveling locus with the reference tangent RT as the transition target route is shown in FIG. 3 as Tr2.
  • this tractor is equipped with the satellite positioning module 7, it is possible to calculate the map coordinates (earth coordinate system, field coordinate system, etc.) of any point of the vehicle body 1, for example, the vehicle body reference point Pv.
  • the distance between the tractor and the prohibited boundary line BL is calculated as shown in FIG.
  • the tractor is represented by a quadrangle of a predetermined size (a quadrangle that surrounds the outline of the quadrangle), and the length of the vertical line drawn from each corner of the quadrangle to the prohibited boundary line BL is the length of each corner of the quadrangle. It is calculated as the distance from to the prohibited boundary line BL.
  • a quadrangle of a predetermined size a quadrangle that surrounds the outline of the quadrangle
  • the length of the vertical line drawn from each corner of the quadrangle to the prohibited boundary line BL is the length of each corner of the quadrangle. It is calculated as the distance from to the prohibited boundary line BL.
  • the shortest distance to the prohibited boundary line BL extending in the horizontal direction is the distance from the left front corner to the prohibited boundary line BL, and the shortest distance to the prohibited boundary line BL extending in the vertical direction is the rear left. It is the distance from the corner to the prohibited boundary line BL.
  • the map coordinates of each corner are calculated from the map coordinates of the vehicle body reference point Pv.
  • the prohibited boundary line BL has a zigzag shape, and a virtual turning circle VC is set near the start point of the next traveling path Ln.
  • the tangent line drawn by the virtual turning circle VC from the vehicle body reference point Pv of the vehicle body 1 that has passed the end point of the front traveling path Ls intersects the prohibited boundary line BL that has entered the convex shape. Therefore, in the situation shown in FIG. 5, the tractor interferes with the prohibited boundary line BL when the transition running as shown in FIG. 3 is performed.
  • the prohibited boundary line BL that interferes with the tractor due to the progress of the tractor is referred to as an interference boundary line (indicated by a thick arrow in FIG. 5), and traveling that avoids interference with this interference boundary line is referred to as interference avoiding traveling. Is called.
  • FIG. 5 shows the locus of the vehicle body 1 in this interference avoidance running.
  • An interference boundary line exists in the direction of the vehicle body 1 toward the virtual turning circle VC past the end point of the front traveling path Ls (# a). Therefore, first, an interference avoidance path AL for avoiding interference with this interference boundary line is set.
  • the special direction change mode is used to save space by using a turn-back turn or a left-right speed difference turn.
  • a turning run is performed (# b).
  • a turning turn is performed as a space-saving turning run.
  • the interference avoidance path AL is set at a position where it can travel at a distance from the interference boundary line.
  • the interference avoidance path AL is a line parallel to the prohibition boundary line BL.
  • the tractor automatically travels on the interference avoidance route AL as the travel target route (# c).
  • the tractor When the tractor runs through the interference avoidance path AL, it turns toward the virtual turning circle VC (# d) and runs tangentially toward the virtual turning circle VC (# e). After that, when the tractor reaches the virtual turning circle VC, the tractor makes a turning traveling with the virtual turning circle VC as the turning target path (# f), and finally shifts to the next traveling path Ln (# g).
  • FIG. 6 shows a functional block diagram showing an automatic traveling control system for a tractor.
  • This control system includes a first control unit composed of a data processing terminal 4, a second control unit 5 that controls various control devices of the vehicle body 1, and a third control unit that mainly controls transition turning. 6 and an input / output signal processing unit 90 are included.
  • the data processing terminal 4, the second control unit 5, the third control unit 6, and the input / output signal processing unit 90 are connected to each other so that data can be transmitted by an in-vehicle LAN, a control signal line, or the like.
  • the data processing terminal 4 may be removed from the tractor and configured to be usable outside the tractor.
  • the input / output signal processing unit 90 that functions as an input / output interface has a function of connecting to a data / signal line, an in-vehicle LAN, a wireless communication line, and a wired communication line.
  • the vehicle traveling equipment group 91, the working equipment group 92, the notification device 93, and the like are connected to the data processing terminal 4 and the second control unit 5 via the input / output signal processing unit 90. Therefore, the input / output signal processing unit 90 is provided with an output signal processing function, an input signal processing function, and a communication function for transmitting data via a data / signal line, a wireless line, or a wired line.
  • the vehicle traveling device group 91 includes a steering motor 14 of the steering mechanism 13, an engine control device, a speed change operation device, and the like.
  • the working equipment group 92 includes a power transmission clutch of the tilling device 30 which is a working device, an elevating cylinder of an elevating mechanism, and the like.
  • the notification device 93 includes an instrument, a buzzer, a lamp, a liquid crystal display, and the like. Further, switches and buttons such as a traveling state detection sensor group 81, a working state detection sensor group 82, and an automatic / manual switching operation tool 83 are also connected to the input / output signal processing unit 90.
  • the positioning data acquired by the satellite positioning module 7 described above is processed by the own vehicle position calculation unit 70, and the position in the map coordinates or the field coordinates of the predetermined position of the tractor is output as the own vehicle position.
  • the data processing terminal 4 includes a touch panel 40, a data communication unit 43, an external shape acquisition management unit 44, a work management unit 45, a prohibited boundary line setting unit 46, and a travel route generation unit 47.
  • the touch panel 40 gives various information to the user and accepts an input operation by the user.
  • the input operation by the user is performed by using an information input operation tool 41 such as a software switch or a hardware switch.
  • the data communication unit 43 acquires work travel information including the position of a field as a work site and the type of work to be performed in the field from an external computer or storage medium.
  • the acquired work travel information is managed by the work management unit 45.
  • the outer shape acquisition management unit 44 determines the outer shape of the field based on the running locus obtained by the tractor entering the field traveling around the inner boundary line of the ridge. In addition, the outer shape acquisition management unit 44 can also divert the outer shape of the field obtained by the field work or the like performed in advance.
  • the prohibited boundary line setting unit 46 sets the prohibited boundary line BL that prohibits the entry of the tractor based on the field outline information managed by the outer shape acquisition management unit 44. If there are steel towers, water facilities, etc. inside the field, the prohibited boundary line setting unit 46 also sets these boundary lines as the prohibited boundary line BL. Further, the prohibition boundary line setting unit 46 can also set the boundary line of at least a part of the unworked area by the tractor as the prohibition boundary line BL.
  • the travel route generation unit 47 refers to field information such as the outer shape of the field, executes a preset travel route generation program, and generates a travel route and a virtual turning circle VC.
  • the travel route generation unit 47 can also receive and manage an externally generated travel route.
  • the second control unit 5 includes a travel control unit 51, a work control unit 52, and a steering control unit 53 as basic control function units for the tractor to automatically perform work travel.
  • the travel control unit 51 has a manual travel control mode and an automatic travel control mode.
  • the travel control unit 51 gives a control signal to the vehicle travel equipment group 91 based on the operation of the accelerator pedal and the shift lever by the driver.
  • the traveling control unit 51 drives the vehicle body 1 at the engine speed and the vehicle speed defined by the automatic driving parameters.
  • the automatic / manual switching operation tool 83 is used for mode switching between the manual driving control mode and the automatic driving control mode, but the mode may be automatically switched according to the working driving state of the tractor.
  • the work control unit 52 also has an automatic work control mode and a manual work control mode.
  • the manual work control mode When the manual work control mode is selected, the work control unit 52 gives a control signal to the work equipment group 92 based on the operation of the operator on the work operation tool.
  • the automatic work control mode When the automatic work control mode is selected, the work control unit 52 gives a signal to the work equipment group 92 based on the automatic work parameter, maintains the posture of the tiller 30 defined by the automatic work parameter, and causes the tiller 30 to maintain the posture. Go up and down.
  • the steering control unit 53 outputs an operation control signal to the steering motor 14 based on the steering command output from the third control unit 6.
  • the third control unit 6 sets the target route set by the travel route setting unit 61, the vehicle position sent from the vehicle position calculation unit 70, and the travel direction calculated from the temporal vehicle position. Based on this, a steering command for making the tractor follow the target path is generated and given to the steering control unit 53.
  • the third control unit 6 performs automatic traveling control for shifting from the previous traveling path Ls to the next traveling path Ln via the turning traveling as described with reference to FIGS. 2 and 5. Therefore, the third control unit 6 includes a travel path setting unit 61, a turning circle setting unit 62, a tangent line calculation unit 63, a tangent tracking travel control unit 64, a transition turning travel control unit 65, an interference boundary line detection unit 66, and interference avoidance.
  • a traveling control unit 67 is provided.
  • the travel route setting unit 61 sets the travel route generated or managed by the travel route generation unit 47 as a target route as a target for automatic driving.
  • the turning circle setting unit 62 sets the virtual turning circle VC as the target path of the approach turning traveling to enter the next traveling route Ln before shifting from the previous traveling path Ls to the next traveling path Ln via the turning traveling.
  • the tangent line calculation unit 63 calculates the tangent line from the vehicle body reference point Pv calculated during traveling to the virtual turning circle VC. Specifically, the tangent line calculation unit 63 calculates a tangent line from the vehicle body reference point Pv to the virtual turning circle VC at a predetermined time interval or a predetermined mileage interval, and the tangent line and the traveling direction (traveling direction line) of the vehicle body 1 are calculated. Calculate the deviation angle between the two. Further, the tangent calculation unit 63 sets the tangent as the reference tangent RT (see FIG. 3) when the deviation angle is within a preset predetermined angle (for example, 30 degrees). The tangential follow-up travel control unit 64 controls tangential follow-up travel with the tangential direction as the target direction.
  • the transition turning running control unit 65 controls the running of the vehicle body 1 with the tangent line as the transition target route.
  • the transition turning traveling control unit 65 controls the traveling of the vehicle body 1 using the virtual turning circle VC as the turning target path.
  • the interference boundary line detection unit 66 is the prohibited boundary line existing in the vehicle traveling direction in the traveling toward the virtual turning circle VC after the traveling of the front traveling path Ls is completed, or in the tangential following traveling by the tangent following traveling control unit 64. Is detected as an interference boundary line.
  • the interference avoidance travel control unit 67 controls interference avoidance travel that prevents the tractor from interfering (crossing the border) with the prohibited boundary line BL regarded as the interference boundary line by the interference boundary line detection unit 66.
  • the interference avoidance travel control unit 67 calculates and sets the interference avoidance route AL as the target route for the interference avoidance travel.
  • the interference avoidance route AL is a route through which the tractor can travel at a distance from the interference boundary line, and has the same or substantially the same length as the interference boundary line.
  • the tractor orbits the outer circumference of the field surrounded by ridges, etc. in order to acquire the outer shape of the field (# 1).
  • the outer shape data of the field is calculated from the traveling locus of the vehicle body 1 obtained by the lap traveling (# 2).
  • the prohibited boundary line BL is calculated based on the calculated external shape data (# 3).
  • the linear traveling route as shown in FIG. 2 and the traveling order thereof are calculated (# 4).
  • the virtual turning circle VC may be set near the start point of the linear traveling path, or the virtual turning circle VC may be set so that the linear traveling path becomes the next traveling path Ln. It may be done at the same stage.
  • the tractor moves to the starting point of the initially set target route (straight-line traveling route) (# 5). Automatic driving is started (# 6), and the tractor travels straight until the tractor reaches the end point of the target route (# 7).
  • the tractor reaches the end point of the target route (# 8Yes branch)
  • it is checked whether there is a linear travel route (next travel route Ln) to be traveled next (# 9), and the linear travel route to be traveled next is determined. If there is (# 9Yes branch), the transition turning running process (see FIG. 8) for shifting to the next running path using turning running is started (# 10).
  • the linear travel route that has been traveled up to now is the previous travel route Ls
  • the linear travel route that is traveled next is the next travel route Ln. If there is no linear traveling route to be traveled next (# 9No branch), the automatic traveling in this field ends (# 11).
  • a virtual turning circle VC set near the start point of the next running path Ln is calculated (# 20) (see # a1 in FIG. 10).
  • the route line segment obtained by line-dividing the virtual turning circle VC is used as the target route, so the route line segment is also calculated based on the calculated virtual turning circle VC. Will be done (# 21).
  • the tractor makes a departure turning run at a predetermined steering angle, for example, a minimum turning radius, and a tangent line from the vehicle body reference point Pv to the virtual turning circle VC is calculated (# 22) (see # a2 in FIG. 10).
  • Tangent follow-up running is performed in which the direction of the vehicle body 1 is aligned with the calculated tangential direction (# 23).
  • Judgment Prohibition Boundary line interference determination is performed (# 24).
  • the tractor does not interfere with the prohibited boundary line BL (# 25 "none" branch)
  • ⁇ is within the predetermined angle difference: ⁇ t (. # 26). If the angle: ⁇ is not within the predetermined angle difference: ⁇ t (# 26No branch), the process returns to step # 22 and the tangential follow-up running is continued. If the angle: ⁇ is within the predetermined angle difference: ⁇ t (# 26Yes branch), the tangent line at that time is determined to be the reference tangent line RT, and the position data indicating the tangent line is calculated (# 27). Further, the position data of the contact point of the tangent line is also calculated (# 28).
  • the interference avoidance process is performed (# 50).
  • the interference avoidance path AL parallel to the portion of the prohibited boundary line BL regarded as the interference boundary line and at intervals at which the tractor can travel is set (#). 51) (See # a2 in FIG. 10).
  • a special direction change such as a turning turn for performing the interference avoidance processing is necessary (# 52). ).
  • the interference avoidance run it is checked whether the tractor has run through the interference avoidance route AL (# 60).
  • the tangent line from the vehicle body reference point Pv to the virtual turning circle VC is calculated again (# 61) (see # a6 in FIG. 10).
  • tangential follow-up running using the calculated tangent is performed (# 62) (see # a7 in FIG. 11).
  • the prohibited boundary line interference determination for determining whether or not the vehicle body 1 interferes with the prohibited boundary line BL is performed (# 63).
  • the tractor interferes with the prohibited boundary line BL (# 64Yes branch)
  • tangential follow-up running is performed.
  • the processes from steps # 61 to # 65 are continued until the angle: ⁇ formed by the calculated tangent line and the running direction of the tractor is within the predetermined angle difference: ⁇ t.
  • step # 65Yes branch When the angle formed by the calculated tangent line and the traveling direction of the tractor: ⁇ is within the predetermined angle difference: ⁇ t (# 65Yes branch), this process ends and returns to step # 27 in FIG.
  • step # 27 in FIG. 8 As described above, the approach turning run for entering the next running path Ln with the reference tangent RT as the transition target path and the virtual turning circle VC as the turning target path is performed. This is done (see # a8, # a9, # a10, # a11 in FIG. 11).
  • This automatic driving system can drive the tractor so as to avoid traveling again in the already worked area where the work has already been completed.
  • the prohibition boundary line setting unit 46 sets the contour of the work area as the prohibition boundary line BL. Since the work area expands as the work runs, the contour of the work area also changes.
  • the prohibited boundary line setting unit 46 updates the prohibited boundary line BL according to the contour change of the existing work area.
  • the work area is not limited to the area already worked by the same tractor, and the area already worked by another tractor or another agricultural work vehicle can be set as the work area. In particular, when the same field is cooperatively worked by multiple tractors (agricultural work vehicles), the multiple tractors mutually use data communication to notify the area already worked or the travel route on which the work was performed.
  • a monitoring computer that exchanges data with multiple tractors and manages the work of the multiple tractors is provided, and the work area of the plurality of tractors managed by the monitoring computer (the work area of the entire field) is each tractor.
  • a configuration may be adopted so as to be notified to.
  • the travel route setting unit 61 adds a flag of "already work route" to the travel route.
  • the travel route setting unit 61 can manage the unworked route and the already-worked route so as to be distinguishable. Instead of the flag, some identification symbol may be given.
  • the existing work area is calculated based on the existing work route managed in this way and the work width during the work run for the work route, and the existing work area of the entire field is sequentially updated.
  • the already updated work area is shared, so that the re-running of the existing work area can be avoided.
  • FIG. 12 will explain an example of a transition turning run that incorporates an existing work area avoidance run.
  • the field has a convex shape in which the prohibited boundary line BL protrudes in a chevron shape, and the existing work area is indicated by a diagonal line due to the preceding work run, and the convex shape extends to a deep place.
  • the contour of the work area is shown by the dotted contour line BLS.
  • the previous travel path Ls and the next travel route Ln are located with the work area in between.
  • a virtual turning circle VC is set near the start point of the next travel path Ln.
  • the tangent line drawn from the vehicle body reference point Pv to the virtual turning circle VC intersects the contour line BLS of the work area, and the prohibited boundary line BL on the left side exists in the traveling direction of the vehicle body 1.
  • the left side prohibition boundary line BL and the contour line BLS are regarded as interference boundary lines, and an interference avoidance path AL extending along the left side prohibition boundary line BL is set.
  • the vehicle body 1 does not go directly to the virtual turning circle VC, but travels with the interference avoidance route AL as the target route (# b2).
  • an interference avoidance path AL extending along a line segment extending laterally of the contour line BLS of the work area is set (# b3).
  • the vehicle body 1 travels with this interference avoidance route AL as a target route, and when the tangent line drawn from the vehicle body reference point Pv to the virtual turning circle VC travels to a position where it does not intersect the contour line BLS of the work area, the vehicle body 1 is virtual.
  • Start turning toward the turning circle VC (# b4). From this, the tangential follow-up run is performed, and further, the reference tangent RT is used as the transition target route (# b5).
  • the approach turning running for entering the next traveling path Ln is performed with the virtual turning circle VC as the turning target path (# b6).
  • the positional relationship between the prohibited boundary line BL and the vehicle body 1 of the tractor is the map coordinates of the vehicle body 1 calculated from the satellite positioning data of the satellite positioning module 7 in the above-described embodiment. It is determined based on. Alternatively or in conjunction with this, the positional relationship between the prohibited boundary line BL and the vehicle body 1 of the tractor may be determined from the measurement data of the distance measuring device mounted on the vehicle body 1.
  • the tractor equipped with the tilling device 30 as a working device is taken up as a work vehicle, but the tractor equipped with a working device other than the tilling device 30, and further agricultural work such as a combine harvester or a rice transplanter.
  • the present invention can also be applied to machines, construction machines, and the like.
  • the present invention can be applied to an automatic driving technique for a vehicle that shifts from a previous traveling route to a next traveling route via turning traveling.

Landscapes

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

Abstract

前走行経路Ｌｓから旋回走行を介して次走行経路Ｌｎに移行する車両の自動走行システムは、車両の進入を禁止する禁止境界線ＢＬを設定する禁止境界線設定部と、次走行経路Ｌｎに進入する進入旋回走行の目標経路として仮想旋回円ＶＣを設定する旋回円設定部と、走行中に算出される車体基準点から仮想旋回円ＶＣへの接線を目標方位とする接線追従走行と仮想旋回円ＶＣを旋回目標経路とする進入旋回走行を制御する移行旋回走行制御部と、接線追従走行における車両進行方向に存在する禁止境界線ＢＬを干渉境界線として検知する干渉境界線検知部と、干渉境界線と干渉することを回避する走行を制御する干渉回避走行制御部とを備える。

Description

自動走行システム及び自動走行方法
　本発明は、前走行経路から旋回走行を介して次走行経路に移行する車両の自動走行システム、及び自動走行方法に関する。
　特許文献１には、前走行経路から旋回走行を介して次走行経路に移行していく自車位置検出機能付き車両の自動操舵システムが開示されている。この自動操舵システムは、前走行経路を離脱して次走行経路に向かう第１旋回走行のための操舵制御を行う第１操舵制御部と、次走行経路に進入する第２旋回走行のための操舵制御を行う第２操舵制御部と、第１旋回走行と第２旋回走行との間の移行走行のための操舵制御を行う第３操舵制御部と、第２旋回走行の目標経路として用いられる仮想旋回円を算出する仮想旋回円算出部と、第１旋回走行における車体基準点から前記仮想旋回円への接線を、前記移行走行の目標経路として算出する接線算出部とを備えている。さらに、接線算出部は、算出された前記接線と車両の走行方位とのなす角度が、第１所定角以内になった場合、当該接線を基準接線とし、かつ、第３操舵制御部は、基準接線を移行走行のための目標経路として操舵制御を行う。
　この構成では、第１旋回走行から第２旋回走行までの移行走行は、第１旋回走行における車体基準点から仮想旋回円への接線を目標経路とする直進走行となり、この接線に沿った走行が終了すると、仮想旋回円を目標経路としてスムーズに次走行経路に進入するための旋回制御が可能となる。
特開２０１８－１８５６７１号公報
　しかしながら、特許文献１による自動操舵システムでは、前走行経路から旋回走行を介して次走行経路に移行するためのスペースが十分に確保されている場合には、問題なく、前走行経路から次走行経路への移行がスムーズに行われる。しかしながら、その移行経路に、畦や柵などの境界線が入り込んでいる場合、自動走行は不可能となる。
　このような実情から、本発明の目的は、前走行経路から次走行経路への移行経路に、車両の進入を禁止する禁止境界線が入り込んでいても、できるだけ、自動操舵を中止せずに、次走行経路への移行が可能となる自動走行システム、及び自動走行方法を提供することである。
　本発明による自動走行システムは、前走行経路から旋回走行を介して次走行経路に移行する車両の自動走行システムであり、
　前記車両の進入を禁止する禁止境界線を設定する禁止境界線設定部と、前記次走行経路に進入する進入旋回走行の目標経路として仮想旋回円を設定する旋回円設定部と、走行中に算出される車体基準点から前記仮想旋回円への接線を算出する接線算出部と、前記接線の方位を目標方位とする接線追従走行を制御する接線追従走行制御部と、前記接線追従走行において、前記車両の走行方位と前記接線とのなす角度が、所定角以内になった場合、当該接線を移行目標経路とし、前記仮想旋回円を旋回目標経路として、前記車両の前記進入旋回走行を制御する移行旋回走行制御部と、前記接線追従走行における車両進行方向に存在する前記禁止境界線を干渉境界線として検知する干渉境界線検知部と、前記車両が前記干渉境界線と干渉することを回避する干渉回避走行を制御する干渉回避走行制御部とを備える。
　この構成では、接線追従走行における車両進行方向に、車両の進入を禁止する禁止境界線が存在すれば、当該禁止境界線を干渉境界線とみなして、車両がこの干渉境界線と干渉することを回避する干渉回避走行が行われる。つまり、接線追従走行において、車体基準点（例えば車体中心）から仮想旋回円への接線が禁止境界線と交差する場合、当該接線を追従する走行は禁止境界線と干渉することになるので、この干渉を避ける干渉回避走行が実行される。この干渉回避走行により、禁止境界線との干渉が回避されると、接線追従走行と進入旋回走行とを経て、車両は次走行経路に移行することができる。
　前走行経路から旋回走行を介して次走行経路に移行するためのスペースが小さい場合、特に、前走行経路の終点と次走行経路の始点との間に禁止境界線が深く入り込んでいる場合、車両が袋小路に進入したような状況になる。このような状況では、小さなスペースで車体の方位を変更する旋回が要求されるので、例えば、後進を用いた方向転換（切り返し旋回と呼ばれる）や左右速度差を用いた信地旋回などが用いられる。この旋回は、走行距離は短いので、所定の制御プログラムを実行することで、自動で行うことができる。このことから、好適な実施形態では、前記干渉回避走行制御部は、切り返し旋回または左右速度差旋回を用いた省スペース旋回走行を実行するための特殊方向転換モードを有する。
　畦や柵などの禁止境界線は、特に農場などの場合、略直線の組み合わせからなる形状が一般的である。したがって、干渉境界線とみなされた禁止境界線から間隔をあけて、この禁止境界線に沿って、しばらく走行することで、禁止境界線が干渉境界線とはならない位置に達することができる。このことから、好適な実施形態では、前記干渉回避走行制御部は、前記車両が前記干渉境界線から間隔をとって走行可能な干渉回避経路を前記干渉境界線に沿って設定する。
　禁止境界線が干渉境界線とはならない位置まで車両が走行すると、車体基準点から仮想旋回円への接線が当該禁止境界線と交差しなくなるので、この接線に基づく接線追従走行を行うことが可能になる。このことから、好適な実施形態では、前記干渉回避走行制御部による前記干渉回避経路の走行終了後、前記車両の自動走行制御は前記接線追従走行制御部に引き継がれる。新しい移行走行経路となった接線または進行方向に新たな禁止境界線が存在する場合には、新たな干渉回避経路を演算し、干渉回避走行を繰り返す。これにより、車両は、最終的に仮想旋回円に達し、次走行経路に進入することができる。
　この自動走行システムを搭載した車両が、圃場のように畦や固定壁などによって境界付けられた特定の作業地を走行する作業車両の場合、その作業地の内と外との境界線(作業地外形線)が、車両が越境してはいけない禁止境界線となる。自動走行する圃場作業車両の多くは、最初に、作業地外形線に沿って周回走行することで、作業地の形状、つまり禁止境界線を算出する機能を有する。このことから、好適な実施形態では、禁止境界線設定部は、前記作業地の内外境界線を前記禁止境界線として設定する。
　作業車両によっては、既に作業を終えた既作業領域を再度走行することを避けることが要望される。この要望を満たすためには、既作業領域の外形線が禁止境界線と見なされ、既作業領域に進入する走行が禁止されるとよい。このことから、好適な実施形態では、禁止境界線設定部は、前記作業車両による少なくとも一部の未作業領域の境界線を前記禁止境界線として設定する。
　移行元である前走行経路を離脱するための旋回である離脱旋回走行は、車体基準点から仮想旋回円への接線の方位に合わせる旋回であるので、走行地面の荒れが許される範囲で、最小旋回半径を用いることが好ましい。また、接線と車両の走行方位とのなす角度がある程度小さくなれば、旋回走行から接線追従走行に切り換えたほうが、制御ハンチングが抑えられ、スムーズな走行が得られる。このことから、好適な実施形態では、前記前走行経路を離脱する離脱旋回走行は、予め設定された操舵角度で行われ、前記離脱旋回走行の途中で、前記接線追従走行制御部による接線追従走行が行われる。
　本願は、自動走行システムだけでなく、前走行経路から旋回走行を介して次走行経路に移行する車両の自動走行方法も発明の対象としている。そのような自動走行方法は、車両の進入を禁止する禁止境界線を設定する禁止境界線設定ステップと、次走行経路に進入する進入旋回走行の目標経路として仮想旋回円を設定する旋回円設定ステップと、走行中に算出される車体基準点から前記仮想旋回円への接線を算出する接線算出ステップと、前記接線の方位を目標方位とする接線追従走行を制御する接線追従走行制御ステップと、前記接線追従走行において、前記車両の走行方位とのなす角度が、所定角以内になった場合、当該接線を移行目標経路として、前記車両の前記進入旋回走行を制御する移行旋回走行制御ステップと、前記接線追従走行における車両進行方向に存在する前記禁止境界線を干渉境界線として検知する干渉境界線検知ステップと、前記車両が前記干渉境界線と干渉することを回避する干渉回避走行を制御する干渉回避走行制御ステップとを備える。この自動走行方法も、上述した自動走行システムの作用効果を有し、上述の好適実施形態の適用が可能である。
　さらに、本願は、上述の自動走行システム及び自動走行方法を利用した車両や、上述の自動走行方法をコンピュータプログラム化したプログラミングや、そのプログラムを格納するメディアも発明の対象としている。
自動走行システムを搭載したトラクタの側面図である。 トラクタが自動走行する走行経路の一部を示す模式図である。 前走行経路から次走行経路への基本的な旋回走行におけるトラクタの走行経路を示す模式図である。 禁止境界線とトラクタとの位置関係を説明する説明図である。 前走行経路から次走行経路への干渉回避経路を用いた旋回走行におけるトラクタの動きを示す模式図である。 トラクタの自動走行に関する制御系を示す機能ブロック図である。 旋回走行時の概略的な流れの一例を示すフローチャートである。 移行旋回走行処理を示すフローチャートである。 干渉回避処理を示すフローチャートである。 干渉回避経路を用いた旋回走行例におけるトラクタの前半の動きを模式的に示す説明図である。 干渉回避経路を用いた旋回走行例におけるトラクタの後半の動きを模式的に示す説明図である。 干渉回避経路を用いた他の旋回走行例におけるトラクタの動きを模式的に示す説明図である。
　次に、図面を用いて、本発明による自動走行システムの実施形態の１つを説明する。図１は、そのような自動走行システムを搭載した作業車両の一例であるトラクタの側面図である。図１に示されているように、このトラクタは対地作業を行いながら作業地である圃場を走行する。トラクタは、前輪１１と後輪１２とによって支持された車体１の中央部に運転室２０が設けられている。車体１の後部には油圧式の昇降機構を介して作業装置であるロータリ式の耕耘装置３０が装備されている。前輪１１は操向輪として機能し、その操舵角を変更することでトラクタの走行方向が変更される。前輪１１の操舵角は操舵機構１３の動作によって変更される。操舵機構１３には自動操舵のための操舵モータ１４が含まれている。手動走行の際には、前輪１１の操舵は運転室２０に配置されているステアリングホイール２２の操作によって行われる。このトラクタは、自車位置検出機能を実現するために、トラクタのキャビン２１に、測位モジュールとして衛星測位モジュール７を備えている。衛星測位モジュール７の構成要素として、ＧＮＳＳ（global navigation satellite system）信号（ＧＰＳ信号を含む）を受信するための衛星用アンテナがキャビン２１の天井領域に取り付けられている。なお、この衛星測位モジュール７には、衛星航法を補完するために、ジャイロ加速度センサや磁気方位センサを組み込んだ慣性航法モジュールを含めることができる。もちろん、慣性航法モジュールは、衛星測位モジュール７とは別の場所に設けてもよい。この実施形態では、運転室２０に、汎用型のデータ処理端末４が配置されている。このデータ処理端末４は、タッチパネル４０を備えたタブレット型コンピュータであり、タッチパネル４０を通じて、運転者による各種操作入力の受け入れ、及び運転者へ種々の情報を報知することができる。
　図２には、圃場を作業走行するトラクタの作業走行の単純化された例が模式的に示されている。この圃場は、畦によって包囲されているので、トラクタの進入を禁止する禁止境界線ＢＬは、畦の内側境界線（内外境界線）となる。この畦の内側境界線である禁止境界線ＢＬは、トラクタが畦の内側境界線に沿って周回走行する際に、衛星測位モジュール７で取得された測位データから算出される自車位置に基づいて得られる走行軌跡から求められる。
　畦の内側境界線によって規定される圃場の外形が決定されると、この圃場を作業走行するための走行経路が演算される。その際、後で詳説される仮想旋回円も設定可能である。図２で示された例では、トラクタは、直線状走行経路（図２では符号ＳＬで示されている）に沿って走行する直進走行と、１つの直線状走行経路（前走行経路）から他の直線状走行経路(次走行経路)に移行するための旋回走行（その経路は図２では符号ＴＬで示されている）とを繰り返す。一般に、旋回走行は、１つ以上の直線状走行経路を挟むように行われる。直進走行時には、耕耘装置３０を降下させることで耕耘作業が行われる。一般に、旋回走行時には、耕耘装置３０が上昇させられ、耕耘作業が停止される。
　図３に、自動操舵による旋回走行の基本的な例が、模式的に示されている。この例では、符号Ｌｓで示した直線状走行経路（移行元）から符号Ｌｎで示した直線状走行経路（移行先）へ移行する単純旋回走行が示されている。この出願では、移行元となる直線状走行経路が前走行経路Ｌｓとされ、移行先となる直線状走行経路が次走行経路Ｌｎとされる。
　トラクタは前走行経路Ｌｓの終端に達すると、前走行経路Ｌｓを離脱して次走行経路Ｌｎに向かう離脱旋回走行を行う。この離脱旋回走行の走行軌跡がＴｒ１で示されている。
　前走行経路Ｌｓを離脱する離脱旋回走行は、予め設定された操舵角度で行われ、離脱旋回走行の途中で、接線追従走行に移行する。次走行経路Ｌｎの始端またはその延長線上の始端近傍の位置に、次走行経路Ｌｎの前走行経路Ｌｓ側で次走行経路Ｌｎと接する仮想旋回円ＶＣが設定されている。離脱旋回走行を行っているトラクタの車体基準点Ｐｖから仮想旋回円ＶＣへの接線が算出される。ここで、車体基準点Ｐｖは、実質的にはトラクタの中心点であるが、任意の位置に設定可能である。車体基準点Ｐｖを通ってトラクタの進行方向に向かう線の向きが走行方位である。トラクタは、算出された接線の方位を目標方位として、接線追従走行を行う。接線追従走行の途中で、算出された接線と走行方位とのなす角度が所定角以内になれば、当該接線が基準接線ＲＴとして設定される。基準接線ＲＴが設定されると、トラクタは、基準接線ＲＴを移行目標経路とするとともに、仮想旋回円ＶＣを旋回目標経路として、次走行経路Ｌｎに進入するための進入旋回走行を行う。基準接線ＲＴを移行目標経路とした走行軌跡はＴｒ２として図３に示されている。移行目標経路での走行が進み、トラクタの車体基準点Ｐｖが仮想旋回円ＶＣに接近すれば、仮想旋回円ＶＣに沿って走行する最終旋回走行に入る。最終旋回走行の走行軌跡がＴｒ３で示されている。最終旋回走行が進み、トラクタの車体基準点Ｐｖが次走行経路Ｌｎの始端またはその延長線上の始端近傍の位置に接近すれば、トラクタは、最終旋回走行を終了し、次走行経路Ｌｎを目標経路とする直進走行に入る。
　このトラクタは衛星測位モジュール７を装備しているので、車体１の任意の点、例えば車体基準点Ｐｖの地図座標（地球座標系や圃場座標系など）が算出可能である。トラクタと禁止境界線ＢＬとの位置関係を検知するため、図４に示すように、トラクタと禁止境界線ＢＬとの距離が演算される。この例では、トラクタは、所定サイズの四角形（トラクタの輪郭を包囲する四角形）で示されており、その各角部から禁止境界線ＢＬに下ろした垂直線の長さが、四角形の各角部から禁止境界線ＢＬまでの距離として演算される。図４では、横方向に延びた禁止境界線ＢＬまでの最短距離は、左前角部から禁止境界線ＢＬまでの距離であり、縦方向に延びた禁止境界線ＢＬまでの最短距離は、左後角部から禁止境界線ＢＬまでの距離である。各角部の地図座標は、車体基準点Ｐｖの地図座標から算出される。
　次に、前走行経路Ｌｓと次走行経路Ｌｎとの間に禁止境界線ＢＬが入り込んでいる場合での、前走行経路Ｌｓから次走行経路Ｌｎへの移行走行を説明する。図５に示すように、禁止境界線ＢＬがジグザグ形状を有し、次走行経路Ｌｎの始点付近には仮想旋回円ＶＣが設定されている。前走行経路Ｌｓの終点を過ぎた車体１の車体基準点Ｐｖから仮想旋回円ＶＣにひかれた接線は、凸状に入り込んだ禁止境界線ＢＬと交差している。このため、図５に示された状況では、図３で示されたような移行走行をすると、トラクタは禁止境界線ＢＬに干渉する。トラクタの進行により、トラクタと干渉する禁止境界線ＢＬは、干渉境界線（図５では太い矢印で示されている）と称し、この干渉境界線と干渉することを回避する走行は干渉回避走行と称される。
　図５には、この干渉回避走行における車体１の軌跡が示されている。前走行経路Ｌｓの終点を過ぎた車体１の仮想旋回円ＶＣへの方位には、干渉境界線が存在する（＃ａ）。このため、まずこの干渉境界線との干渉を避けるための干渉回避経路ＡＬが設定される。図５の例では、設定された干渉回避経路ＡＬに向かう旋回時に禁止境界線ＢＬを越境する可能性があるので、特殊方向転換モードを用いて、切り返し旋回または左右速度差旋回を用いた省スペース旋回走行が行われる（＃ｂ）。図５では、省スペース旋回走行として、切り返し旋回が行われている。干渉回避経路ＡＬは、干渉境界線から間隔をとって走行可能な位置に設定される。一般的に、干渉回避経路ＡＬは、禁止境界線ＢＬに平行な線である。トラクタは、干渉回避経路ＡＬを走行目標経路として自動走行する（＃ｃ）。
　トラクタは、干渉回避経路ＡＬを走破すると、仮想旋回円ＶＣの方に旋回し（＃ｄ）、仮想旋回円ＶＣに向かって接線追従走行を行う（＃ｅ）。その後、トラクタが仮想旋回円ＶＣに到達すれば、仮想旋回円ＶＣを旋回目標経路として旋回走行し（＃ｆ）、最終的に次走行経路Ｌｎに移行する（＃ｇ）。
　上述した移行旋回走行を自動制御するための制御系を説明する。図６に、トラクタの自動走行制御系を示す機能ブロック図が示されている。この制御系には、データ処理端末４で構成されている第１制御ユニットと、車体１の種々の制御機器を制御する第２制御ユニット５と、主に移行旋回走行を制御する第３制御ユニット６と、入出力信号処理ユニット９０とが含まれている。データ処理端末４と第２制御ユニット５と第３制御ユニット６と入出力信号処理ユニット９０との間は、車載ＬＡＮまたは制御信号線等によってデータ伝送可能に接続されている。データ処理端末４はトラクタから取り外して、トラクタの外部で使用可能に構成にされてもよい。
　入出力インタフェースとして機能する入出力信号処理ユニット９０は、データ・信号ライン、車載ＬＡＮ、無線通信回線、有線通信回線と接続する機能を有する。車両走行機器群９１、作業装置機器群９２、報知デバイス９３、などは、入出力信号処理ユニット９０を介して、データ処理端末４や第２制御ユニット５と接続されている。このため、入出力信号処理ユニット９０は、出力信号処理機能、入力信号処理機能、データ・信号ラインや無線回線や有線回線を介してデータ伝送を行う通信機能、などを備えている。車両走行機器群９１には、操舵機構１３の操舵モータ１４、エンジン制御機器、変速操作機器などが含まれている。作業装置機器群９２には、作業装置である耕耘装置３０の動力伝達クラッチや昇降機構の昇降シリンダなどが含まれている。報知デバイス９３には、計器やブザーやランプや液晶ディスプレイなどが含まれている。さらに、入出力信号処理ユニット９０には、走行状態検出センサ群８１、作業状態検出センサ群８２、自動／手動切替操作具８３などのスイッチやボタンも接続されている。
　上述した衛星測位モジュール７で取得された測位データは、自車位置算出部７０で処理され、このトラクタの所定箇所の地図座標または圃場座標における位置が、自車位置として出力される。
　データ処理端末４は、タッチパネル４０、データ通信部４３、外形取得管理部４４、作業管理部４５、禁止境界線設定部４６、走行経路生成部４７を備えている。タッチパネル４０は、ユーザに種々の情報を与えるとともに、ユーザによる入力操作を受け付ける。ユーザによる入力操作は、ソフトウエアスイッチやハードウエアスイッチなどの情報入力操作具４１を用いて行われる。データ通信部４３は、外部のコンピュータまたは記憶メディアから、作業地である圃場の位置や当該圃場で行う作業種類などを含む作業走行情報を取得する。取得された作業走行情報は、作業管理部４５で管理される。
　外形取得管理部４４は、圃場に進入したトラクタが、畦の内側境界線に沿って周回走行することで得られた走行軌跡に基づいて、圃場の外形を決定する。なお、外形取得管理部４４は、先行して行われた圃場作業等で得られた圃場の外形を流用することも可能である。
　禁止境界線設定部４６は、外形取得管理部４４で管理されている圃場外形情報に基づいて、トラクタの進入を禁止する禁止境界線ＢＬを設定する。なお、禁止境界線設定部４６は、圃場内部に鉄塔や水施設などがある場合、これらの境界線も、禁止境界線ＢＬとして設定する。さらに、禁止境界線設定部４６は、トラクタによる少なくとも一部の未作業領域の境界線を禁止境界線ＢＬとして設定することもできる。
　走行経路生成部４７は、圃場の外形などの圃場情報を参照し、予めインストールされている走行経路生成プログラムを実行させて、走行経路及び仮想旋回円ＶＣを生成する。なお、走行経路生成部４７は、外部で生成された走行経路を受け取って、管理することも可能である。
　第２制御ユニット５は、トラクタが自動作業走行するための基本的な制御機能部として、走行制御部５１、作業制御部５２、操舵制御部５３を備えている。
　走行制御部５１は、手動走行制御モードと自動走行制御モードとを有する。手動走行制御モードが選択されると、走行制御部５１は、運転者によるアクセルペダルや変速レバーに対する操作に基づいて車両走行機器群９１に制御信号を与える。自動走行制御モードが選択されると、走行制御部５１は、自動走行パラメータで規定されたエンジン回転数や車速でもって車体１を走行させる。手動走行制御モードと自動走行制御モードとの間のモード切替には自動／手動切替操作具８３が用いられるが、トラクタの作業走行状態に応じて、自動的にモード切替が行われることもある。
　作業制御部５２も、自動作業制御モードと手動作業制御モードとを有する。手動作業制御モードが選択されると、作業制御部５２は、運転者による作業操作具に対する操作に基づいて作業装置機器群９２に制御信号を与える。自動作業制御モードが選択されると、作業制御部５２は、自動作業パラメータに基づいて作業装置機器群９２に信号を与え、自動作業パラメータで規定された耕耘装置３０の姿勢維持や耕耘装置３０の昇降を行う。
　操舵制御部５３は、第３制御ユニット６から出力された操舵指令に基づいて、操舵モータ１４に動作制御信号を出力する。
　第３制御ユニット６は、走行経路設定部６１によって設定された目標経路と、自車位置算出部７０から送られてくる自車位置及び継時的な自車位置から算出される走行方位とに基づいて、トラクタを目標経路に追従させるための操舵指令を生成し、操舵制御部５３に与える。
　第３制御ユニット６は、図２及び図５を用いて説明したような、前走行経路Ｌｓから旋回走行を介して次走行経路Ｌｎに移行するための自動走行制御を行う。このため、第３制御ユニット６は、走行経路設定部６１、旋回円設定部６２、接線算出部６３、接線追従走行制御部６４、移行旋回走行制御部６５、干渉境界線検知部６６、干渉回避走行制御部６７を備える。
　走行経路設定部６１は、走行経路生成部４７で生成または管理されている走行経路を、自動走行のための目標となる目標経路として設定する。旋回円設定部６２は、前走行経路Ｌｓから旋回走行を介して次走行経路Ｌｎに移行する前に、当該次走行経路Ｌｎに進入する進入旋回走行の目標経路として仮想旋回円ＶＣを設定する。
　接線算出部６３は、走行中に算出される車体基準点Ｐｖから仮想旋回円ＶＣへの接線を算出する。具体的には、接線算出部６３は、所定時間間隔または所定走行距離間隔で、車体基準点Ｐｖから仮想旋回円ＶＣへの接線を算出し、その接線と車体１の走行方位（走行方位線）とがなすずれ角度を算出する。さらに、接線算出部６３は、このずれ角度が、予め設定されている所定角（例えば３０度）以内になった時の、接線を基準接線ＲＴ(図３参照)とする。接線追従走行制御部６４は、接線の方位を目標方位とする接線追従走行を制御する。
　移行旋回走行制御部６５は、接線追従走行制御部６４による接線追従走行において、ずれ角度が所定角以内になった場合、当該接線を移行目標経路とし、車体１の走行を制御する。車体１が仮想旋回円ＶＣに達すると、移行旋回走行制御部６５は、仮想旋回円ＶＣを旋回目標経路として、車体１の走行を制御する。
　干渉境界線検知部６６は、前走行経路Ｌｓの走行が終了して仮想旋回円ＶＣに向かう走行において、または接線追従走行制御部６４による接線追従走行において、車両進行方向に存在する前記禁止境界線を干渉境界線として検知する。
　干渉回避走行制御部６７は、トラクタが干渉境界線検知部６６によって干渉境界線とみなされた禁止境界線ＢＬと干渉（越境）することを回避する干渉回避走行を制御する。干渉回避走行制御部６７は、干渉回避走行ための目標経路として、干渉回避経路ＡＬを算出して、設定する。干渉回避経路ＡＬは、トラクタが干渉境界線から間隔をとって走行できる経路であり、干渉境界線と同じまたはほぼ同じ長さを有する。干渉回避走行制御部６７による干渉回避走行が終了すると、再び、仮想旋回円ＶＣに向かって車体１を操舵する接線追従走行制御が開始される。
　次に、上述した自動走行システムを搭載したトラクタの圃場での挙動の一例を、図７から図９のフローチャートと、図１０及び図１１のトラクタ挙動模式図とを用いて説明する。
　まず、トラクタは、圃場外形を取得するために、畦等で囲まれた圃場の外周を周回走行する（＃１）。周回走行で得られた車体１の走行軌跡から、圃場の外形データが算出される（＃２）。算出された外形データに基づいて、禁止境界線ＢＬが算出される（＃３）。算出された外形データに基づいて、図２で示すような直線状走行経路、及びその走行順が算出される（＃４）。なお、直線状走行経路の算出と同時に、直線状走行経路の始点付近に仮想旋回円ＶＣを設定してもよいし、仮想旋回円ＶＣの設定は、直線状走行経路が次走行経路Ｌｎになった段階で行われてもよい。
　トラクタが最初に設定された目標経路（直線状走行経路）の始点に移動する（＃５）。自動走行が開始され（＃６）、トラクタが目標経路の終点に達するまで、トラクタは直進走行を行う（＃７）。トラクタが目標経路の終点に達すると（＃８Ｙｅｓ分岐）、次に走行すべき直線状走行経路（次走行経路Ｌｎ）があるかチェックされ（＃９）、次に走行すべき直線状走行経路があれば（＃９Ｙｅｓ分岐）、次の走行経路へ旋回走行を用いて移行する移行旋回走行処理（図８参照）に入る（＃１０）。移行旋回走行処理では、今まで走行していた直線状走行経路が前走行経路Ｌｓであり、次に走行する直線状走行経路が次走行経路Ｌｎである。なお、次に走行すべき直線状走行経路がなければ（＃９Ｎｏ分岐）、この圃場での自動走行が終了する（＃１１）。
　図８で示されている移行旋回走行処理では、次走行経路Ｌｎの始点付近に設定される仮想旋回円ＶＣが算出される（＃２０）（図１０の＃ａ１参照）。仮想旋回円ＶＣを目標経路とする旋回走行の場合、仮想旋回円ＶＣを線分化して得られる経路線分を目標経路として用いるので、算出された仮想旋回円ＶＣに基づいて経路線分も算出される（＃２１）。
　トラクタは、所定操向角、例えば最小旋回半径での離脱旋回走行を行うとともに、車体基準点Ｐｖから仮想旋回円ＶＣへの接線が算出される（＃２２）（図１０の＃ａ２参照）。算出された接線の方位に車体１の方位を合わせる接線追従走行が行われる（＃２３）。次に、接線追従走行における車体１の進行方向または接線の延び方向に禁止境界線ＢＬが存在していないかどうか、つまり、そのまま走行を行うと車体１が禁止境界線ＢＬに干渉するかどうかを判定する禁止境界線干渉判定が行われる（＃２４）。トラクタが禁止境界線ＢＬと干渉しない場合（＃２５「無し」分岐）、算出された接線とトラクタの走行方位とがなす角度：θが所定角度差：θｔ以内になっているかどうかチェックされる（＃２６）。角度：θが所定角度差：θｔ以内でなければ（＃２６Ｎｏ分岐）、ステップ＃２２に戻って、接線追従走行が続行される。角度：θが所定角度差：θｔ以内であれば（＃２６Ｙｅｓ分岐）、その時点での接線が基準接線ＲＴと決定され、その接線を示す位置データが算出される（＃２７）。さらに当該接線の接点の位置データも算出される（＃２８）。
　続いて、基準接線ＲＴを目標経路とする自動走行（仮想旋回円ＶＣへの移行走行）が行われる（＃２９）。この移行走行において、トラクタの車体基準点Ｐｖが基準接線ＲＴの接点の直前まで接近すると（＃３０Ｙｅｓ分岐）、移行走行が終了する。目標経路は、仮想旋回円ＶＣの線分となり（＃３１）、最終の旋回走行が行われる（＃３２）。この旋回走行では、目標経路となる経路線分が順次選択され、選択された経路線分を追従するように自動操舵が行われる。旋回走行が進み、トラクタが次走行経路Ｌｎに進入するための自走行経路移行条件（車体１と次走行経路Ｌｎとの方位差、及び車体１と次走行経路Ｌｎとの距離差）が成立すると（＃３３Ｙｅｓ分岐）、次走行経路Ｌｎを目標経路とする走行制御への移行が決定される（＃３４）。これにより、この処理は終了して、図７のステップ＃７にリターンする。
　ステップ＃２４の禁止境界線干渉判定において、トラクタが禁止境界線ＢＬと干渉する場合（＃２５「有り」分岐）、干渉回避処理が行われる（＃５０）。図９で示されている干渉回避処理では、まず、干渉境界線とみなされた禁止境界線ＢＬの部分に平行で、かつトラクタが走行できる間隔をあけた干渉回避経路ＡＬが設定される（＃５１）（図１０の＃ａ２参照）。さらに、干渉回避経路ＡＬを目標経路として走行を開始するための車体１の姿勢を確保するために、干渉回避処理を行うための切り返し旋回などの特殊方向転換が必要かどうか判定される（＃５２）。特殊方向転換が不要な場合（＃５３「否」分岐）、干渉回避経路ＡＬを目標経路とする自動走行が開始される（＃５５）（図１０の＃ａ３、＃ａ４参照）。特殊方向転換が必要な場合（＃５３「要」分岐）、適切な特殊方向転換が行われ（＃５４）、その後に、干渉回避経路ＡＬを目標経路とする自動走行（干渉回避走行）が開始される（＃５５）（図１０の＃ａ５参照）。
　干渉回避走行中は、トラクタが干渉回避経路ＡＬを走破したかどうかチェックされる（＃６０）。トラクタが干渉回避経路ＡＬを走破した場合（＃６０Ｙｅｓ分岐）、再び、車体基準点Ｐｖから仮想旋回円ＶＣへの接線が算出される（＃６１）（図１０の＃ａ６参照）。次いで、算出される接線を用いた接線追従走行が行われる（＃６２）（図１１の＃ａ７参照）。
　この接線追従走行においても、車体１が禁止境界線ＢＬに干渉するかどうかを判定する禁止境界線干渉判定が行われる（＃６３）。トラクタが禁止境界線ＢＬと干渉する場合（＃６４Ｙｅｓ分岐）、ステップ＃５１にジャンプして、再び干渉回避処理が行われる。トラクタが禁止境界線ＢＬと干渉しない限り（＃６４Ｎｏ分岐）、接線追従走行が行われる。この接線追従走行は、算出される接線とトラクタの走行方位とがなす角度：θが所定角度差：θｔ以内になるまで、ステップ＃６１から＃６５までの処理が続けられる。算出される接線とトラクタの走行方位とがなす角度：θが所定角度差：θｔ以内になれば（＃６５Ｙｅｓ分岐）、この処理は終了して、図８のステップ＃２７にリターンする。図８のステップ＃２７にリターンすれば、上述したように、基準接線ＲＴを移行目標経路とするとともに、仮想旋回円ＶＣを旋回目標経路として、次走行経路Ｌｎに進入するための進入旋回走行が行われる（図１１の＃ａ８、＃ａ９、＃ａ１０、＃ａ１１参照）。
　この自動走行システムは、既に作業を終えた既作業領域を再度走行することをできるだけ避けるようにトラクタを走行させることができる。この既作業領域回避走行では、禁止境界線設定部４６が既作業領域の輪郭を禁止境界線ＢＬとして設定する。既作業領域は、作業走行とともに拡大するので、既作業領域の輪郭も変化する。禁止境界線設定部４６は、既作業領域の輪郭変化に応じて禁止境界線ＢＬを更新する。なお、既作業領域は、同一のトラクタによって既に作業された領域に限定されず、別なトラクタまたは別な農作業車によって既に作業された領域を既作業領域とすることも可能である。特に、複数のトラクタ（農作業車）によって同一圃場が協調的に作業される場合には、複数のトラクタは、相互にデータ通信を用いて、既に作業した領域または作業走行を行った走行経路を通知することで、圃場全体の既作業領域を把握することができる。あるいは、複数のトラクタとデータ交換を行い、複数のトラクタの作業を管理する監視コンピュータが備えられ、当該監視コンピュータによって管理された複数のトラクタの既作業領域（圃場全体の既作業領域）が各トラクタに通知されるような構成が採用されてもよい。具体例の１つでは、目標経路として設定された走行経路に沿った作業走行が完了した時点で、走行経路設定部６１が、当該走行経路に「既作業経路」のフラグを付与する。これにより、走行経路設定部６１は、未作業経路と既作業経路とを区別可能に管理することができる。フラグに代えて、何らかの識別記号が与えられてもよい。このように管理された既作業経路と、当該作業経路に対する作業走行時の作業幅とに基づいて、既作業領域が算出され、圃場全体としての既作業領域が逐次更新される。複数台のトラクタによる協調作業では、逐次更新される既作業領域が共有されることで、既作業領域の再走行が回避可能となる。
　図１２を用いて、既作業領域回避走行を取り入れた移行旋回走行の一例を説明する。図１２の例では、圃場は禁止境界線ＢＬが山形に突き出た凸形状となっており、先行する作業走行によって、その既作業領域が斜線で示されており、凸形状は深いところまで延びている。既作業領域の輪郭は点線の輪郭線ＢＬＳで示されている。前走行経路Ｌｓと次走行経路Ｌｎは、既作業領域を挟んで位置している。次走行経路Ｌｎの始点付近に仮想旋回円ＶＣが設定されている。
　前走行経路Ｌｓの終点付近で、車体基準点Ｐｖから仮想旋回円ＶＣに引かれた接線は既作業領域の輪郭線ＢＬＳと交差し、車体１の進行方向には左側の禁止境界線ＢＬが存在している（＃ｂ１）。左側の禁止境界線ＢＬと輪郭線ＢＬＳとが干渉境界線とみなされ、左側の禁止境界線ＢＬに沿って延びる干渉回避経路ＡＬが設定される。これにより、車体１は、直接仮想旋回円ＶＣに向かうのではなく、干渉回避経路ＡＬを目標経路として走行する（＃ｂ２）。車体１が既作業領域を通り抜けると、既作業領域の輪郭線ＢＬＳの横方向に延びた線分に沿って延びる干渉回避経路ＡＬが設定される（＃ｂ３）。車体１は、この干渉回避経路ＡＬを目標経路として走行し、車体基準点Ｐｖから仮想旋回円ＶＣに引かれた接線が既作業領域の輪郭線ＢＬＳと交差しない位置まで走行すると、車体１が仮想旋回円ＶＣに向く旋回走行を開始する（＃ｂ４）。これより、接線追従走行が行われ、さらに、基準接線ＲＴを移行目標経路として走行する（＃ｂ５）。車体１が仮想旋回円ＶＣに到達すると、仮想旋回円ＶＣを旋回目標経路として、次走行経路Ｌｎに進入するための進入旋回走行が行われる（＃ｂ６）。
〔別実施の形態〕
（１）図４で示したような、禁止境界線ＢＬとトラクタの車体１との位置関係は、上述した実施形態では、衛星測位モジュール７の衛星測位データから算出された車体１の地図座標に基づいて定められている。これに代えて、あるいはこれとともに、車体１に装備された距離測定機器の測定データから禁止境界線ＢＬとトラクタの車体１との位置関係が定められてもよい。
（２）図６で示された機能ブロック図における各機能部の区分け、及びデータ処理端末４、第２制御ユニット５、第３制御ユニット６の区分けは、説明を分かりやすくするための一例であり、種々の機能部を統合したり、単一の機能部を複数に分割したりすることは自由である。
（３）上述した実施形態では、作業装置として耕耘装置３０を装備したトラクタが作業車両として取り上げられたが、耕耘装置３０以外の作業装置を装備したトラクタ、さらには、コンバインや田植機などの農作業機や建機などにも本発明は適用可能である。
　なお、上記実施形態（別実施形態を含む、以下同じ）で開示される構成は、矛盾が生じない限り、他の実施形態で開示される構成と組み合わせて適用することが可能であり、また、本明細書において開示された実施形態は例示であって、本発明の実施形態はこれに限定されず、本発明の目的を逸脱しない範囲内で適宜改変することが可能である。
　本発明は、前走行経路から旋回走行を介して次走行経路に移行していく車両の自動走行技術に適用できる。
１　　　：車体
４　　　：データ処理端末
５　　　：第２制御ユニット
６　　　：第３制御ユニット
７　　　：衛星測位モジュール
４４　　：外形取得管理部
４６　　：禁止境界線設定部
４７　　：走行経路生成部
５１　　：走行制御部
５２　　：作業制御部
５３　　：操舵制御部
６１　　：走行経路設定部
６２　　：旋回円設定部
６３　　：接線算出部
６４　　：接線追従走行制御部
６５　　：移行旋回走行制御部
６６　　：干渉境界線検知部
６７　　：干渉回避走行制御部
７０　　：自車位置算出部
ＡＬ　　：干渉回避経路
ＢＬ　　：禁止境界線
ＢＬＳ　：輪郭線
Ｌｎ　　：次走行経路
Ｌｓ　　：前走行経路
Ｐｖ　　：車体基準点
ＲＴ　　：基準接線
ＶＣ　　：仮想旋回円

Claims (8)

  1. 　前走行経路から旋回走行を介して次走行経路に移行する車両の自動走行システムであって、
    　前記車両の進入を禁止する禁止境界線を設定する禁止境界線設定部と、
    　前記次走行経路に進入する進入旋回走行の目標経路として仮想旋回円を設定する旋回円設定部と、
    　走行中に算出される車体基準点から前記仮想旋回円への接線を算出する接線算出部と、
    　前記接線の方位を目標方位とする接線追従走行を制御する接線追従走行制御部と、
    　前記接線追従走行において、前記車両の走行方位と前記接線とのなす角度が、所定角以内になった場合、当該接線を移行目標経路とし、前記仮想旋回円を旋回目標経路として、前記車両の前記進入旋回走行を制御する移行旋回走行制御部と、
    　前記接線追従走行における車両進行方向に存在する前記禁止境界線を干渉境界線として検知する干渉境界線検知部と、
    　前記車両が前記干渉境界線と干渉することを回避する干渉回避走行を制御する干渉回避走行制御部と、を備える自動走行システム。
  2. 　前記干渉回避走行制御部は、切り返し旋回または左右速度差旋回を用いた省スペース旋回走行を実行するための特殊方向転換モードを有する請求項１に記載の自動走行システム。
  3. 　前記干渉回避走行制御部は、前記車両が前記干渉境界線から間隔をとって走行可能な干渉回避経路を前記干渉境界線に沿って設定する請求項１または２に記載の自動走行システム。
  4. 　前記干渉回避走行制御部による前記干渉回避経路の走行終了後、前記車両の自動走行制御は前記接線追従走行制御部に引き継がれる請求項３に記載の自動走行システム。
  5. 　前記車両が、対地作業を行いながら作業地を自動走行する作業車両であり、
    　禁止境界線設定部は、前記作業地の内外境界線を前記禁止境界線として設定する請求項１から４のいずれか一項に記載の自動走行システム。
  6. 　禁止境界線設定部は、前記作業車両による少なくとも一部の未作業領域の境界線を前記禁止境界線として設定する請求項５に記載の自動走行システム。
  7. 　前記前走行経路を離脱する離脱旋回走行は、予め設定された操舵角度で行われ、前記離脱旋回走行の途中で、前記接線追従走行制御部による接線追従走行が行われる請求項１から６のいずれか一項に記載の自動走行システム。
  8. 　前走行経路から旋回走行を介して次走行経路に移行する車両の自動走行方法であって、
    　前記車両の進入を禁止する禁止境界線を設定する禁止境界線設定ステップと、
    　前記次走行経路に進入する進入旋回走行の目標経路として仮想旋回円を設定する旋回円設定ステップと、
    　走行中に算出される車体基準点から前記仮想旋回円への接線を算出する接線算出ステップと、
    　前記接線の方位を目標方位とする接線追従走行を制御する接線追従走行制御ステップと、
    　前記接線追従走行において、前記車両の走行方位と前記接線とのなす角度が、所定角以内になった場合、当該接線を移行目標経路として、前記車両の前記進入旋回走行を制御する移行旋回走行制御ステップと、
    　前記接線追従走行における車両進行方向に存在する前記禁止境界線を干渉境界線として検知する干渉境界線検知ステップと、
    　前記車両が前記干渉境界線と干渉することを回避する干渉回避走行を制御する干渉回避走行制御ステップと、を備える自動走行方法。
PCT/JP2021/044753 2021-01-05 2021-12-06 自動走行システム及び自動走行方法 WO2022149389A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
EP21917610.4A EP4275466A1 (en) 2021-01-05 2021-12-06 Automatic travel system and automatic travel method
US18/270,247 US20240099176A1 (en) 2021-01-05 2021-12-06 Automatic travel system and automatic travel method

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2021000348A JP7511491B2 (ja) 2021-01-05 2021-01-05 自動走行システム及び自動走行方法
JP2021-000348 2021-01-05

Publications (1)

Publication Number Publication Date
WO2022149389A1 true WO2022149389A1 (ja) 2022-07-14

Family

ID=82357363

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2021/044753 WO2022149389A1 (ja) 2021-01-05 2021-12-06 自動走行システム及び自動走行方法

Country Status (4)

Country Link
US (1) US20240099176A1 (ja)
EP (1) EP4275466A1 (ja)
JP (1) JP7511491B2 (ja)
WO (1) WO2022149389A1 (ja)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016002246A1 (ja) * 2014-07-04 2016-01-07 マミヤ・オーピー株式会社 作業機械、作業機械の走行経路生成、走行経路への進入可否判定、走行経路自動選択のためのシステム、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御システム
JP2018185671A (ja) 2017-04-26 2018-11-22 株式会社クボタ 自動操舵システム
JP2019207284A (ja) * 2018-05-28 2019-12-05 ヤンマー株式会社 地図情報生成システム、および作業支援システム
JP2020110158A (ja) * 2016-09-05 2020-07-27 株式会社クボタ 作業車自動走行システム及び走行経路管理装置

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016002246A1 (ja) * 2014-07-04 2016-01-07 マミヤ・オーピー株式会社 作業機械、作業機械の走行経路生成、走行経路への進入可否判定、走行経路自動選択のためのシステム、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御システム
JP2020110158A (ja) * 2016-09-05 2020-07-27 株式会社クボタ 作業車自動走行システム及び走行経路管理装置
JP2018185671A (ja) 2017-04-26 2018-11-22 株式会社クボタ 自動操舵システム
JP2019207284A (ja) * 2018-05-28 2019-12-05 ヤンマー株式会社 地図情報生成システム、および作業支援システム

Also Published As

Publication number Publication date
JP2022105798A (ja) 2022-07-15
EP4275466A1 (en) 2023-11-15
JP7511491B2 (ja) 2024-07-05
US20240099176A1 (en) 2024-03-28

Similar Documents

Publication Publication Date Title
JP6766006B2 (ja) 自動操舵システム
CN108334065B (zh) 行驶路径生成装置及行驶路径生成程序
US11433944B2 (en) Automated hitching system with variable backing paths
JP7072496B2 (ja) 自動走行作業車のための制御装置
JP7206105B2 (ja) 圃場作業車
JP7069285B2 (ja) 圃場作業車
JP7479425B2 (ja) 走行作業機
US11491833B2 (en) System and methods for vehicle alignment control
JP2024053067A (ja) 自動走行システム及び自動走行方法
JP6945353B2 (ja) 自動走行作業車
JP7045979B2 (ja) 走行作業機
WO2022149389A1 (ja) 自動走行システム及び自動走行方法
JP6964735B2 (ja) 自動操舵システム
JPH0522926B2 (ja)
US11968917B2 (en) Working vehicle and working machine having the working vehicle
US20240069557A1 (en) Cultivated land work vehicle and agricultural material replenishment method
WO2020129704A1 (ja) 走行作業機
JP7122956B2 (ja) 走行作業機
JP7068969B2 (ja) 自動走行システム

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 21917610

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 18270247

Country of ref document: US

NENP Non-entry into the national phase

Ref country code: DE

ENP Entry into the national phase

Ref document number: 2021917610

Country of ref document: EP

Effective date: 20230807