JP6964735B2 - Automatic steering system - Google Patents

Automatic steering system Download PDF

Info

Publication number
JP6964735B2
JP6964735B2 JP2020155283A JP2020155283A JP6964735B2 JP 6964735 B2 JP6964735 B2 JP 6964735B2 JP 2020155283 A JP2020155283 A JP 2020155283A JP 2020155283 A JP2020155283 A JP 2020155283A JP 6964735 B2 JP6964735 B2 JP 6964735B2
Authority
JP
Japan
Prior art keywords
turning
traveling
path
vehicle
steering control
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.)
Active
Application number
JP2020155283A
Other languages
Japanese (ja)
Other versions
JP2021009707A (en
Inventor
敦 新海
和央 阪口
幸太郎 山口
博基 須賀
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.)
Kubota Corp
Original Assignee
Kubota Corp
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
Priority claimed from JP2017087348A external-priority patent/JP6766006B2/en
Application filed by Kubota Corp filed Critical Kubota Corp
Priority to JP2020155283A priority Critical patent/JP6964735B2/en
Publication of JP2021009707A publication Critical patent/JP2021009707A/en
Application granted granted Critical
Publication of JP6964735B2 publication Critical patent/JP6964735B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Description

本発明は、前走行経路から旋回走行を介して次走行経路に移行していく自車位置検出機能付き車両の自動操舵システムに関する。 The present invention relates to 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 turning traveling.

特許文献1には、GPS衛星からの電波を受信するGPS受信装置を備え、算出された自車位置に基づいて、前輪中央位置が目標経路に追従するように農地内を自動走行する農業用作業車が開示されている。この作業車は、直線目標経路に沿って車体を走行させる自動直進制御と、円旋回を目標経路として車体を走行させる自動旋回制御とを備えている。
自動旋回制御では、目標経路としての旋回円の中心と前輪中心部とを結ぶ直線が旋回円と交わる点から引かれた接線ベクトルを基準として、位置偏差と方位偏差が算出される。算出された偏差に基づいて油圧操舵バルブの指令値が算出され、操舵される。これにより、旋回円である旋回目標経路に沿った自動旋回走行が行われる。なお、農地においては、1つの直進目標経路から他の直進目標経路に、180度または90度の旋回目標経路を介して移行する作業走行が頻繁に実施される。
Patent Document 1 is provided with a GPS receiving device that receives radio waves from GPS satellites, and is an agricultural work that automatically travels in the farmland so that the center position of the front wheels follows the target route based on the calculated position of the own vehicle. The car is disclosed. This work vehicle is provided with automatic straight-ahead control for traveling the vehicle body along a straight target path and automatic turning control for traveling the vehicle body with a circular turn as a target path.
In the automatic turning control, the position deviation and the orientation deviation are calculated based on the tangential vector drawn from the point where the straight line connecting the center of the turning circle as the target path and the center of the front wheels intersects the turning circle. The command value of the hydraulic steering valve is calculated based on the calculated deviation, and the steering is performed. As a result, automatic turning travel is performed along the turning target path which is a turning circle. In addition, in the agricultural land, the work running which shifts from one straight-ahead target path to another straight-ahead target path via a 180-degree or 90-degree turning target path is frequently carried out.

特開2002−358122号公報JP-A-2002-358122

特許文献1に開示された、自動走行する農業用作業車では、互いに平行に延びている2つの直進目標経路を旋回目標経路でつなぐことになる。しかしながら、旋回目標経路でつなぐ2つの直進目標経路の間隔が大きくて、2つの直進目標経路の端点を結ぶ旋回円の半径が大きくなる。このため、一方の直線目標経路から他方の直線目標経路に移行するための旋回走行に要求される領域が大きくなるという不都合が生じる。実際の作業では、1つ以上の直進目標経路を挟んで、2つの直進目標経路をつなぐという経路が頻繁に利用される。したがって、2つの直進目標経路の間隔が長い場合でも、効率よく移行できる旋回制御が可能な自動操舵システムが要望されている。 In the automatically traveling agricultural work vehicle disclosed in Patent Document 1, two straight target paths extending in parallel with each other are connected by a turning target path. However, the distance between the two straight target paths connected by the turning target path is large, and the radius of the turning circle connecting the end points of the two straight target paths is large. For this reason, there is a disadvantage that the area required for turning to shift from one straight target path to the other straight target path becomes large. In actual work, a route connecting two straight target routes with one or more straight target routes in between is frequently used. Therefore, there is a demand for an automatic steering system capable of turning control that enables efficient transition even when the distance between the two straight target paths is long.

本発明による、前走行経路から旋回走行を介して次走行経路に移行していく自車位置検出機能付き車両の自動操舵システムは、前記次走行経路に進入する進入旋回走行(第2旋回走行とも称する)のための操舵制御を行う進入操舵制御部(第2操舵制御部とも称する)と、前記進入旋回走行の目標経路として設定された仮想旋回円への車体基準点からの接線を算出する接線算出部と、を備え、前記接線算出部によって算出された前記接線と前記車両の走行方位とのなす角度が、第1所定角以内になった場合、当該接線が、前記車両が前記進入旋回走行に移行するための移行経路となる。 According to the present invention, the automatic steering system of a vehicle with a vehicle position detection function that shifts from a previous traveling path to a next traveling path via a turning traveling is an approach turning traveling (also referred to as a second turning traveling) that enters the next traveling route. The tangent line that calculates the tangent line from the vehicle body reference point to the approach steering control unit (also referred to as the second steering control unit) that performs steering control for (referred to as) and the virtual turning circle set as the target path of the approach turning run. When the angle formed by the tangent line calculated by the tangent line calculation unit and the traveling direction of the vehicle is within the first predetermined angle, the tangent line causes the vehicle to make the approaching turn. It becomes a transition route for transitioning to.

この構成では、車両が移行先である次走行経路に最終的に進入するための目標経路として仮想旋回円が用いられている。仮想旋回円として、次走行経路へ進入するための理想的な旋回円を採用することにより、自動操舵システムは、2つの直進目標経路の間隔が長い場合においても、直進目標経路から直進目標経路へ効率のよく移行できる旋回制御が可能となる。 In this configuration, a virtual turning circle is used as a target route for the vehicle to finally enter the next traveling route, which is the transition destination. By adopting an ideal turning circle for entering the next traveling path as a virtual turning circle, the automatic steering system moves from the straight target path to the straight target path even when the distance between the two straight target paths is long. It enables turning control that enables efficient transition.

さらに車体基準点から仮想旋回円に引かれた接線の向きと走行方位とのずれが少なくなった段階で、当該接線を基準接線とみなされ、この基準接線が進入旋回走行の経路である仮想旋回円への車体の移行経路として用いられるので、車体の進入旋回走行への乗り移りがスムーズとなる。 Furthermore, when the deviation between the direction of the tangent line drawn from the vehicle body reference point to the virtual turning circle and the traveling direction is reduced, the tangent line is regarded as the reference tangent line, and this reference tangent line is the virtual turning route for approach turning. Since it is used as a transition route for the vehicle body to a circle, the vehicle body can smoothly transfer to the approach turning run.

仮想旋回円をそのまま目標経路として用いると、操舵制御のための演算が複雑となる。このため、本発明の好適な実施形態の1つでは、前記仮想旋回円算出部は、前記仮想旋回円を複数の円弧に区分けすることで得られた弦を経路線分とし、かつ、前記第2操舵制御部は、前記第2旋回走行のための目標経路として前記経路線分を順次選択しながら操舵制御を行う。この構成により、第2旋回走行での目標経路も直線となり、操舵制御のための演算が簡単になるだけでなく、直進走行での操舵制御と共通化することができる。 If the virtual turning circle is used as it is as the target path, the calculation for steering control becomes complicated. Therefore, in one of the preferred embodiments of the present invention, the virtual swirl circle calculation unit uses the string obtained by dividing the virtual swirl circle into a plurality of arcs as a path line segment, and the first 2 The steering control unit performs steering control while sequentially selecting the route line segment as the target route for the second turning run. With this configuration, the target path in the second turning run becomes a straight line, and not only the calculation for steering control becomes simple, but also the steering control in straight running can be shared.

本発明の好適な実施形態の1つでは、前記車両の走行方位と前記次走行経路とがなす角度が第2所定角度以内になり、かつ、前記車体基準点と前記次走行経路との間の距離が所定距離以下になった場合、前記次走行経路を目標経路として、操舵制御が行われる。この構成では、仮想旋回円作り出された線分群(好ましくは中心角が20度から45度の弦)から順次取り出されていく線分が第2旋回走行の目標経路となって車両は第2旋回走行を行うが、車両と次走行経路との間の距離ずれ及び方位ずれが少なくなった段階で、次走行経路が、次走行経路への移行のための目標経路となる。これにより、第2旋回走行から次走行経路の走行への移行がスムーズとなる。 In one of the preferred embodiments of the present invention, the angle formed by the traveling direction of the vehicle and the next traveling path is within the second predetermined angle, and the vehicle body reference point and the next traveling path are between the vehicle body reference point and the next traveling path. When the distance becomes less than or equal to a predetermined distance, steering control is performed with the next traveling route as a target route. In this configuration, the line segments sequentially taken out from the line segment group created by the virtual turning circle (preferably the strings having a central angle of 20 to 45 degrees) serve as the target route for the second turning, and the vehicle makes the second turning. The vehicle travels, but when the distance deviation and the directional deviation between the vehicle and the next travel route are reduced, the next travel route becomes the target route for the transition to the next travel route. As a result, the transition from the second turning run to the run on the next run path becomes smooth.

上述したように、移行元である前走行経路を離脱するために離脱操舵制御部(第1操舵制御部)によって行われる離脱旋回走行(第1旋回走行)は、車両が許す任意の旋回半径で行うことができるが、好ましくは、車両の最小旋回半径とすれば、第1旋回走行の走行距離も短いものとなり、好都合である。 As described above, the departure turning run (first turning run) performed by the leaving steering control unit (first steering control unit) in order to leave the previous traveling path, which is the transition source, has an arbitrary turning radius allowed by the vehicle. Although it can be performed, preferably, if the minimum turning radius of the vehicle is set, the mileage of the first turning running is also short, which is convenient.

前走行経路と次走行経路との間隔が短くなり、基準接線の長さが前もって設定された下限値を下回った場合、第1旋回走行から直接第2旋回走行に移行することが可能となり、移行走行が不要になる。このことから、本発明の好適な実施形態の1つでは、前記接線算出部によって算出される最初の接線の長さが下限値を下回った場合、前記第3操舵制御部による操舵制御が省略され、前記第1旋回走行から直接前記第2旋回走行に移行する。 When the distance between the previous travel route and the next travel route becomes shorter and the length of the reference tangent line falls below the preset lower limit, it is possible to directly shift from the first turn run to the second turn run. No need to drive. From this, in one of the preferred embodiments of the present invention, when the length of the first tangent line calculated by the tangent line calculation unit is less than the lower limit value, the steering control by the third steering control unit is omitted. , The first turning run is directly shifted to the second turning running.

車両の走行地面が凸凹であったり、ぬかるんでいたりすると、横スリップなどの不測の車両移動が生じて、車両位置が目標経路から大きくずれることがある。このような場合、車両位置を前進だけでは短時間で目標経路に復帰させることは困難となる。特に、トラクタやコンバインなどの農作業車では、前走行経路の終端で作業を中断し、次走行経路の始端で作業をすぐに再開することが要望される。このため、車両は、次走行経路へ正しい位置で確実に進入しなければならない。したがって、次走行経路への進入前に、車両位置が目標経路から大きくずれた場合には、後進(切り返し旋回走行)を用いて、位置ずれを解消することが好ましい。本発明の好適な実施形態の1つでは、前記進入旋回走行の終了段階で、前記車両が前記次走行経路または前記次走行経路の延長線から制限値を超えて離間した場合、後進を用いた前記車両の前記次走行経路への接近走行が行われた後に、再び前記次走行経路への操舵制御が行われる。 If the running ground of the vehicle is uneven or muddy, unexpected vehicle movement such as lateral slip may occur, and the vehicle position may deviate significantly from the target route. In such a case, it is difficult to return the vehicle position to the target route in a short time only by moving forward. In particular, for agricultural work vehicles such as tractors and combines, it is required that the work be interrupted at the end of the previous traveling route and the work be resumed immediately at the beginning of the next traveling route. Therefore, the vehicle must surely enter the next traveling route at the correct position. Therefore, if the vehicle position deviates significantly from the target route before entering the next travel path, it is preferable to eliminate the misalignment by using reverse movement (turning turn). In one of the preferred embodiments of the present invention, when the vehicle is separated from the next traveling path or the extension line of the next traveling path beyond the limit value at the end stage of the approach turning traveling, the reverse movement is used. After the vehicle has been approached to the next traveling path, steering control to the next traveling path is performed again.

自動操舵システムを搭載したトラクタの側面図である。It is a side view of a tractor equipped with an automatic steering system. トラクタが自動操舵で走行する走行経路の一部を示す模式図である。It is a schematic diagram which shows a part of the traveling path which a tractor travels by automatic steering. 前走行経路から次走行経路への自動操舵旋回走行におけるトラクタの動きを示す模式図である。It is a schematic diagram which shows the movement of the tractor in the automatic steering turning running from the previous running path to the next running path. トラクタの自動操舵走行に関する制御系を示す機能ブロック図である。It is a functional block diagram which shows the control system about the automatic steering running of a tractor. 第1旋回走行から移行走行に移るトラクタの動きを示す模式図である。It is a schematic diagram which shows the movement of the tractor which shifts from a 1st turn run to a transition run. 移行走行から第2旋回走行に移るトラクタの動きを示す模式図である。It is a schematic diagram which shows the movement of the tractor which shifts from a transition run to a second turn run. 第2旋回走行から直進走行に移るトラクタの動きを示す模式図である。It is a schematic diagram which shows the movement of the tractor which shifts from a 2nd turn run to a straight run. 旋回走行時の自動操舵制御の概略的な流れの一例を示すフローチャートである。It is a flowchart which shows an example of the schematic flow of the automatic steering control at the time of a turning run. 後進旋回走行の一例を説明するための模式図である。It is a schematic diagram for demonstrating an example of a reverse turning run.

次に、図面を用いて、本発明による自動操舵システムの実施形態の1つを説明する。図1は、そのような自動操舵システムを搭載した車両の一例であるトラクタの側面図である。図1に示されているように、このトラクタは、前輪11と後輪12とによって支持された車体1の中央部に運転室20が設けられている。車体1の後部には油圧式の昇降機構を介して作業装置としてのロータリ式の耕耘装置30が装備されている。前輪11は操向輪として機能し、その操舵角を変更することでトラクタの走行方向が変更される。前輪11の操舵角は操舵機構13の動作によって変更される。操舵機構13には自動操舵のための操舵モータ14が含まれている。手動走行の際には、前輪11の操舵は運転室20に配置されているステアリングホイール22の操作によって行われる。このトラクタは、自車位置検出機能を実現するために、トラクタのキャビン21に、測位モジュールとして衛星測位モジュール7を備えている。衛星測位モジュール7の構成要素として、GNSS(global navigation satellite system)信号(GPS信号を含む)を受信するための衛星用アンテナがキャビン21の天井領域に取り付けられている。なお、この衛星測位モジュール7には、衛星航法を補完するために、ジャイロ加速度センサや磁気方位センサを組み込んだ慣性航法モジュールを含めることができる。もちろん、慣性航法モジュールは、衛星測位モジュール7とは別の場所に設けてもよい。この実施形態では、運転室20に、汎用型のデータ処理端末4が配置されている。このデータ処理端末4は、タッチパネル40を備えたタブレット型コンピュータであり、タッチパネル40を通じて、運転者による各種操作入力の受け入れ、及び運転者へ種々の情報を報知することができる。 Next, one embodiment of the automatic steering system according to the present invention will be described with reference to the drawings. FIG. 1 is a side view of a tractor, which is an example of a vehicle equipped with such an automatic steering system. As shown in FIG. 1, this tractor is provided with a driver's cab 20 in a central portion of a vehicle body 1 supported by front wheels 11 and rear wheels 12. The rear part of the vehicle body 1 is equipped with a rotary type tilling device 30 as a working device via a hydraulic lifting 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. During manual driving, 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. As a component of the satellite positioning module 7, a satellite antenna for receiving GNSS (global navigation satellite system) signals (including GPS 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. Of course, the inertial navigation module may be provided in a place different from the satellite positioning module 7. In this embodiment, a general-purpose data processing terminal 4 is arranged in the driver's cab 20. The data processing terminal 4 is a tablet 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.

図2には、自動操舵によるトラクタの作業走行の一例が模式的に示されている。ここでは、自動操舵によるトラクタは、直線状走行経路(図2では符号SLで示されている)に沿って走行する直進走行と、1つの直線状走行経路から他の直線状走行経路に移行するための旋回走行経路(図2では符号TLで示されている)に沿って走行する旋回走行とを繰り返す。一般に、旋回走行は、1つ以上の直線状走行経路を挟むように行われる。直進走行時には、耕耘装置30を降下させることで耕耘作業が行われ、旋回走行時には、耕耘装置30が上昇させられ、耕耘作業が停止される。 FIG. 2 schematically shows an example of working running of a tractor by automatic steering. Here, the tractor by automatic steering shifts from one linear traveling path to another linear traveling path while traveling straight along a linear traveling path (indicated by reference numeral SL in FIG. 2). The turning running along the turning running path (indicated by the reference numeral TL in FIG. 2) is repeated. Generally, the turning run is performed so as to sandwich one or more straight running paths. When traveling straight, the tilling device 30 is lowered to perform the tilling work, and when traveling in a turning manner, the tilling device 30 is raised and the tilling operation is stopped.

図3に、旋回走行における自動操舵の一例が、模式的に示されている。この例では、符号Lsで示した直線状走行経路(移行元)から符号Lnで示した直線状走行経路(移行先)へ移行する旋回走行を示している。この出願では、移行元となる直線状走行経路を前走行経路Lsと呼び、移行先となる直線状走行経路を次走行経路Lnと呼ぶ。 FIG. 3 schematically shows an example of automatic steering in turning running. In this example, the turning running that shifts from the linear traveling path (transition source) indicated by the reference numeral Ls to the linear traveling path (transition destination) indicated by the reference numeral Ln is shown. In this application, the linear traveling route that is the transition source is referred to as the previous traveling route Ls, and the linear traveling route that is the transition destination is referred to as the next traveling route Ln.

トラクタは前走行経路Lsの終端に達すると、次走行経路Lnに向かう第1旋回走行を行う。この第1旋回走行の走行軌跡がTr1で示されている。さらに、次走行経路Lnの始端またはその延長線上の始端近傍の位置で、前走行経路Ls側で接する仮想旋回円VCが算出される。第1旋回走行を行っているトラクタの車体基準点Pvから仮想旋回円VCへの接線が算出される。ここで、車体基準点Pvは、実質的にはトラクタの中心点であるが、任意の位置に設定可能である。車体基準点Pvを通ってトラクタの進行方向に向かう線の向きが走行方位RDである。第1旋回走行の途中で、算出された接線と走行方位とのなす角度が第1所定値以内になれば、当該接線が基準接線RTとして設定される。基準接線RTが設定されると、トラクタは、第1旋回走行を終了し、基準接線RTを目標経路とする移行走行に入る。移行走行での走行軌跡はTr2で示されている。移行走行が進み、トラクタの車体基準点Pvが仮想旋回円VCに接近すれば、トラクタは移行走行を終了し、仮想旋回円VCに沿った第2旋回走行に入る。第2旋回走行の走行軌跡がTr3で示されている。第2旋回走行が進み、トラクタの車体基準点Pvが次走行経路Lnの始端またはその延長線上の始端近傍の位置に接近すれば、トラクタは、第2旋回走行を終了し、次走行経路Lnを目標経路とする直進走行に入る。 When the tractor reaches the end of the previous travel path Ls, the tractor makes a first turn toward the next travel path Ln. The running locus of this first turning run is indicated by Tr1. Further, a virtual turning circle VC tangent on the previous traveling path Ls side is calculated at a position near the starting end of the next traveling path Ln or an extension line thereof. The tangent line from the vehicle body reference point Pv of the tractor performing the first turning run to the virtual turning circle VC is calculated. Here, 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 RD. If the angle formed by the calculated tangent line and the traveling direction is within the first predetermined value during the first turning run, the tangent line is set as the reference tangent line RT. When the reference tangent RT is set, the tractor ends the first turning run and enters a transition run with the reference tangent RT as the target route. The running locus in the transition running is indicated by Tr2. When the transition running progresses and the vehicle body reference point Pv of the tractor approaches the virtual turning circle VC, the tractor ends the transition running and enters the second turning running along the virtual turning circle VC. The running locus of the second turning run is indicated by Tr3. When the second turning run progresses and the vehicle body reference point Pv of the tractor approaches the start end of the next running path Ln or a position near the starting end on the extension line thereof, the tractor ends the second turning running and sets the next running path Ln. Enter straight running as the target route.

次に、上述した旋回走行をより具体的かつ詳細に説明する。図4に、トラクタの自動走行制御系を示す機能ブロック図が示されている。この制御系には、データ処理端末4と制御ユニット5と入出力信号処理ユニット6とが含まれている。データ処理端末4と制御ユニット5と入出力信号処理ユニット6との間は、車載LANまたは制御信号線等によってデータ伝送可能に接続されている。データ処理端末4はトラクタから取り外して、トラクタの外部で使用可能に構成してもよい。その際、制御ユニット5とデータ処理端末4との間のデータ伝送は無線通信を用いて行われる。 Next, the above-mentioned turning running will be described in more detail and in detail. FIG. 4 shows a functional block diagram showing an automatic traveling control system for a tractor. This control system includes a data processing terminal 4, a control unit 5, and an input / output signal processing unit 6. The data processing terminal 4, the control unit 5, and the input / output signal processing unit 6 are connected so as to be capable of data transmission 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. At that time, data transmission between the control unit 5 and the data processing terminal 4 is performed using wireless communication.

入出力インタフェースとして機能する入出力信号処理ユニット6は、データ・信号ライン、車載LAN、無線通信回線、有線通信回線と接続する機能を有する。車両走行機器群91、作業装置機器群92、報知デバイス93、などは、入出力信号処理ユニット6を介して、データ処理端末4や制御ユニット5と接続されている。このため、入出力信号処理ユニット6は、出力信号処理機能、入力信号処理機能、データ・信号ライン無線回線や有線回線を介してデータ伝送を行う通信機能、などを備えている。車両走行機器群91には、操舵機構13の操舵モータ14、エンジン制御機器、変速操作機器などが含まれている。作業装置機器群92には、作業装置である耕耘装置30の動力伝達クラッチや昇降機構の昇降シリンダなどが含まれている。報知デバイス93には、計器やブザーやランプや液晶ディスプレイなどが含まれている。さらに、入出力信号処理ユニット6には、走行状態検出センサ群81、作業状態検出センサ群82、自動/手動切替操作具83などのスイッチやボタンも接続されている。 The input / output signal processing unit 6 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 device group 91, the work device device group 92, the notification device 93, and the like are connected to the data processing terminal 4 and the control unit 5 via the input / output signal processing unit 6. Therefore, the input / output signal processing unit 6 is provided with an output signal processing function, an input signal processing function, a communication function for transmitting data via a data / signal line wireless line or a wired line, and the like. 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 running state detection sensor group 81, a work state detection sensor group 82, and an automatic / manual switching operation tool 83 are also connected to the input / output signal processing unit 6.

上述した衛星測位モジュール7からの測位データは、自車位置算出部70で処理され、このトラクタの所定箇所の地図座標または圃場座標における位置が、自車位置として出力される。この自車位置は、制御ユニット5とデータ処理端末4とに送られる。特に、制御ユニット5では、自車位置は、自動操舵制御に用いられる。 The positioning data from 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. This own vehicle position is sent to the control unit 5 and the data processing terminal 4. In particular, in the control unit 5, the position of the own vehicle is used for automatic steering control.

データ処理端末4は、タッチパネル40、データ通信部43、作業走行情報取得部44、作業走行情報記録部45、走行経路生成部46を備えている。タッチパネル40は、ユーザに種々の情報を与えるとともに、ユーザによる入力操作を受け付ける。 The data processing terminal 4 includes a touch panel 40, a data communication unit 43, a work travel information acquisition unit 44, a work travel information recording unit 45, and a travel route generation unit 46. The touch panel 40 gives various information to the user and accepts an input operation by the user.

作業走行情報取得部44は、作業地である圃場の地図位置や形状、当該圃場で行う作業種類などを含む作業走行情報を、データ通信部43を介して外部のコンピュータまたは記憶メディアから取得することができる。作業走行情報記録部45は、取得された作業走行情報をメモリに記録する。なお、圃場の地図位置や形状、当該圃場で行う作業種類は、タッチパネル40を通じて実行される情報入力アシスタント機能を用いて、ユーザが直接入力することも可能である。 The work travel information acquisition unit 44 acquires work travel information including the map position and shape of the field as the work site, the type of work to be performed in the field, and the like from an external computer or storage medium via the data communication unit 43. Can be done. The work travel information recording unit 45 records the acquired work travel information in the memory. The map position and shape of the field and the type of work to be performed in the field can be directly input by the user by using the information input assistant function executed through the touch panel 40.

走行経路生成部46は、作業対象となる圃場の形状などを含む圃場情報を参照し、予めインストールされている走行経路生成プログラムを実行させて、走行経路を生成する。なお、走行経路生成部46は、外部で生成された走行経路をデータ通信部43を介して受け取って、管理することも可能である。 The travel route generation unit 46 refers to field information including the shape of the field to be worked on, executes a pre-installed travel route generation program, and generates a travel route. The travel route generation unit 46 can also receive and manage the travel route generated externally via the data communication unit 43.

制御ユニット5は、トラクタが自動作業走行するための基本的な制御機能部として、走行制御部51、作業制御部52、操舵制御モジュール6A、目標経路設定モジュール6Bを備えている。 The control unit 5 includes a travel control unit 51, a work control unit 52, a steering control module 6A, and a target route setting module 6B as basic control function units for the tractor to perform automatic work travel.

走行制御部51は、手動走行制御モードと自動走行制御モードとを有する。手動走行制御モードが選択されると、走行制御部51は、運転者によるアクセルペダルや変速レバーに対する操作に基づいて車両走行機器群91に制御信号を与える。自動走行制御モードが選択されると、走行制御部51は、自動走行パラメータで規定されたエンジン回転数や車速でもって車体1を走行させる。さらに、走行制御部51は、操舵制御モジュール6Aで算出された操舵指令に基づいて、操舵モータ14に動作制御信号を出力する。操舵制御モジュール6Aは、目標経路設定モジュール6Bによって設定された目標経路に沿ってトラクタが走行するように操舵指令を算出する。手動走行制御モードと自動走行制御モードとの間のモード切替には自動/手動切替操作具83が用いられるが、トラクタの作業走行状態に応じて、自動的にモード切替が行われることもある。 The travel control unit 51 has a manual travel control mode and an automatic travel control mode. When the manual travel control mode is selected, the travel control unit 51 gives a control signal to the vehicle travel equipment group 91 based on the driver's operation on the accelerator pedal and the speed change lever. When the automatic driving control mode is selected, the driving control unit 51 drives the vehicle body 1 at the engine speed and the vehicle speed defined by the automatic driving parameters. Further, the traveling control unit 51 outputs an operation control signal to the steering motor 14 based on the steering command calculated by the steering control module 6A. The steering control module 6A calculates a steering command so that the tractor travels along the target path set by the target path setting module 6B. The automatic / manual switching operation tool 83 is used for mode switching between the manual running control mode and the automatic running control mode, but the mode may be automatically switched according to the working running state of the tractor.

作業制御部52も、自動作業制御モードと手動作業制御モードとを有する。手動作業制御モードが選択されると、作業制御部52は、運転者による作業操作具に対する操作に基づいて作業装置機器群92に制御信号を与える。自動作業制御モードが選択されると、作業制御部52は、自動作業パラメータに基づいて作業装置機器群92に信号を与え、自動作業パラメータで規定された耕耘装置30の姿勢維持や耕耘装置30の昇降を行う。 The work control unit 52 also has an automatic work control mode and a 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 work operation tool by the driver. 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 cultivating device 30 defined by the automatic work parameter, and maintains the posture of the cultivating device 30. Go up and down.

操舵制御モジュール6Aは、目標経路設定モジュール6Bによって設定された目標経路と、自車位置算出部70から送られてくる自車位置及び継時的な自車位置から算出される走行方位とに基づいて、トラクタを目標経路に追従させるための操舵指令を生成する。なお、以後の説明において、自車位置は、車体基準点Pvと同じ位置とする。操舵制御モジュール6Aの主操舵制御部60及び目標経路設定モジュール6Bの主走行経路設定部65は、主に、直線状の目標経路(大きな曲率半径で湾曲している目標経路を含む)を追従する直進走行に用いられる。 The steering control module 6A is based on the target route set by the target route setting module 6B, the vehicle position sent from the vehicle position calculation unit 70, and the traveling direction calculated from the vehicle position over time. Then, a steering command is generated to make the tractor follow the target path. In the following description, the position of the own vehicle will be the same as the vehicle body reference point Pv. The main steering control unit 60 of the steering control module 6A and the main travel route setting unit 65 of the target route setting module 6B mainly follow a linear target path (including a target path curved with a large radius of curvature). Used for straight running.

特に、図2を用いて説明したような、前走行経路Lsから旋回走行を介して次走行経路Lnに移行していく自動操舵制御を行うため、操舵制御モジュール6Aは、さらに、第1操舵制御部61、第2操舵制御部62、第3操舵制御部63を有する。同様に、目標経路設定モジュール6Bは、旋回経路設定部66、仮想旋回円算出部67、接線算出部68を有する。 In particular, in order to perform automatic steering control for shifting from the previous traveling path Ls to the next traveling path Ln via turning traveling as described with reference to FIG. 2, the steering control module 6A further provides the first steering control. It has a unit 61, a second steering control unit 62, and a third steering control unit 63. Similarly, the target route setting module 6B has a turning route setting unit 66, a virtual turning circle calculation unit 67, and a tangent line calculation unit 68.

第1操舵制御部61は、図5で示すように、トラクタが前走行経路Lsに達すると、前走行経路Lsを離脱して次走行経路Ln(図3参照)に向かう第1旋回走行のための操舵制御を行う。第1旋回走行の操舵制御では、このトラクタの最小旋回半径が選択される。 As shown in FIG. 5, when the tractor reaches the previous travel path Ls, the first steering control unit 61 leaves the previous travel path Ls and heads for the next travel path Ln (see FIG. 3) for the first turning travel. Steering control of. In the steering control of the first turning run, the minimum turning radius of this tractor is selected.

また、図3及び図5に示すように、トラクタが前走行経路Lsに達すると、仮想旋回円算出部67が、次走行経路Lnに進入するための第2旋回走行の目標経路として用いられる仮想旋回円VCを算出する。この仮想旋回円VCは次走行経路Lnの始端ないしはその延長線上で、前走行経路Ls側に接し、その半径は、この実施形態ではトラクタの最小旋回半径である。さらに、仮想旋回円算出部67は、算出した仮想旋回円VCを多数の円弧に区分けし、各円弧の両端を結ぶ線である経路線分を得る。この実施形態では、仮想旋回円VCは、中心角が10度の円弧で36等分され、36本の弦、つまり順次つながった36本の経路線分CHが算出される。 Further, as shown in FIGS. 3 and 5, when the tractor reaches the previous traveling path Ls, the virtual turning circle calculation unit 67 is used as a target route for the second turning traveling to enter the next traveling path Ln. Calculate the swivel circle VC. The virtual turning circle VC is in contact with the previous traveling path Ls side on the starting end of the next traveling path Ln or an extension line thereof, and the radius thereof is the minimum turning radius of the tractor in this embodiment. Further, the virtual turning circle calculation unit 67 divides the calculated virtual turning circle VC into a large number of arcs, and obtains a path line segment which is a line connecting both ends of each arc. In this embodiment, the virtual swirl circle VC is divided into 36 equal parts by an arc having a central angle of 10 degrees, and 36 strings, that is, 36 path line segment channels connected in sequence are calculated.

接線算出部68は、第1旋回走行の間、所定時間間隔または所定走行距離間隔で、車体基準点Pvから仮想旋回円VCへの接線を算出し(図5では、3本の接線が示されている)、その接線とトラクタの操向方位(走行方位線)とのなす角度(図5ではθで表されている)を算出する。さらに、接線算出部68は、この角度:θが、予め設定されている第1所定角:θt以内になった時の、接線を基準接線RTとし、記録する。この実施態様では、第1所定角:θtは30度である。 The tangent line calculation unit 68 calculates the 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 during the first turning run (three tangent lines are shown in FIG. 5). ), The angle between the tangent line and the steering direction (traveling direction line) of the tractor (represented by θ in FIG. 5) is calculated. Further, the tangent calculation unit 68 records the tangent as the reference tangent RT when the angle: θ is within the preset first predetermined angle: θt. In this embodiment, the first predetermined angle: θt is 30 degrees.

基準接線RTが算出されると、第3操舵制御部63が起動し、第1操舵制御部61による操舵制御が終了する。基準接線RTは直線であるので、第3操舵制御部63による操舵制御は、実質的には、直線状の目標経路の追従走行に用いられる操舵制御と同様である。
ここでは、基準接線RTを追従する走行は移行走行と称する。
When the reference tangent RT is calculated, the third steering control unit 63 is activated, and the steering control by the first steering control unit 61 is completed. Since the reference tangent RT is a straight line, the steering control by the third steering control unit 63 is substantially the same as the steering control used for the follow-up running of the linear target path.
Here, the running following the reference tangent RT is referred to as a transition running.

第2操舵制御部62は、図3と図6と図7とに示すように、直線状の移行走行から次走行経路Lnに乗り移るための第2旋回走行における操舵制御を行う。第3操舵制御部63による移行走行から第2操舵制御部62による第2旋回走行への切り替えは、車体基準点Pvが基準接線RTの接点に達する直前、例えば1秒前である。この時点となったタイミングで、第2操舵制御部62は、最も近い経路線分CHを選択し、当該経路線分CHに追従する第2旋回走行を開始する。第2操舵制御部62は、順次、経路線分CHを選択し、当該経路線分CHに追従する操舵制御、実質的には仮想旋回円VCに沿った第2旋回走行のための操舵制御を行う。その際、経路線分CHから外れた距離に応じた減速制御、現在の操舵角と目標操舵角との差に応じた減速制御も実行される。また、第2操舵制御部62は、トラクタの車体基準点と次走行経路Lnとの間の距離:D、及び、トラクタの走行方位と次走行経路Lnとがなす角度:αを算出する(図7参照)。 As shown in FIGS. 3, 6 and 7, the second steering control unit 62 performs steering control in the second turning travel for transferring from the linear transition travel to the next travel route Ln. The switching from the transition running by the third steering control unit 63 to the second turning running by the second steering control unit 62 is immediately before the vehicle body reference point Pv reaches the contact point of the reference tangent RT, for example, one second before. At this timing, the second steering control unit 62 selects the closest path line segment CH and starts the second turning run following the path line segment CH. The second steering control unit 62 sequentially selects the path line segment CH, and performs steering control following the path line segment CH, substantially steering control for the second turning run along the virtual turning circle VC. conduct. At that time, deceleration control according to the distance deviated from the path line segment CH and deceleration control according to the difference between the current steering angle and the target steering angle are also executed. Further, the second steering control unit 62 calculates the distance: D between the vehicle body reference point of the tractor and the next travel path Ln, and the angle: α formed by the travel direction of the tractor and the next travel path Ln (FIG. FIG. 7).

第2操舵制御部62による第2旋回走行の終了条件は、図7に示すように、トラクタの走行方位と次走行経路Lnとがなす角度:αが第2所定角度:αt以内になり、かつ、トラクタの車体基準点と次走行経路Ln(次走行経路Lnの延長線を含む)との間の距離:Dが所定距離以下になることである。この実施形態では、第2所定角度:αtは20度、距離:Dは数十cmである。この終了条件が満たされると、第2操舵制御部62による第2旋回走行が終了し、次走行経路Lnを目標経路として追従する直進走行が主操舵制御部60によって再開される。 As shown in FIG. 7, the end condition of the second turning run by the second steering control unit 62 is that the angle formed by the running direction of the tractor and the next running path Ln: α is within the second predetermined angle: αt. , The distance between the vehicle body reference point of the tractor and the next travel path Ln (including the extension line of the next travel path Ln): D is a predetermined distance or less. In this embodiment, the second predetermined angle: αt is 20 degrees, and the distance: D is several tens of cm. When this end condition is satisfied, the second turning run by the second steering control unit 62 ends, and the straight running following the next run path Ln as the target path is restarted by the main steering control unit 60.

なお、前走行経路Lsと次走行経路Lnとの間隔が短い場合、基準接線RTの長さが短くなり、第1旋回走行から直接第2旋回走行に移行することが可能となる。この場合、第3操舵制御部63による実質的な移行走行は省略される。ただし、その場合であっても、第1旋回走行を終了するためにタイミングを決定するために、接線算出部68によって接線は算出され、接線と走行方位とのなす角度も算出される。 When the distance between the previous traveling path Ls and the next traveling path Ln is short, the length of the reference tangent RT becomes short, and it becomes possible to directly shift from the first turning traveling to the second turning traveling. In this case, the substantial shift running by the third steering control unit 63 is omitted. However, even in that case, the tangent line is calculated by the tangent line calculation unit 68, and the angle formed by the tangent line and the traveling direction is also calculated in order to determine the timing for ending the first turning run.

以下、上述のように構成された操舵制御モジュール6A及び目標経路設定モジュール6Bを用いた旋回走行時の自動操舵制御の概略的な流れを、図8のフローチャートを参照しながら、説明する。
まず、作業対象となる圃場に対して、図2で示すような直線状走行経路が算出される(#01)。選択された最初の目標経路(直線状走行経路の1つ)の始点にトラクタを移動させる(#02)。次いで、自動操舵を用いて目標経路を追従する直進走行が開始する(#03)。トラクタが目標経路の終点に達すると(#04Yes分岐)、次に走行すべき直線状走行経路があるかチェックされ(#05)、次に走行すべき直線状走行経路があれば(#05Yes分岐)、次の走行経路へ旋回走行を用いて乗り移る移行旋回走行処理に入る(#06)。移行旋回走行処理では、今まで走行していた直線状走行経路が前走行経路Lsであり、次に走行する直線状走行経路が次走行経路Lnである。なお、次に走行すべき直線状走行経路がなければ(#05No分岐)、この圃場での自動走行が終了する(#10)。
Hereinafter, a schematic flow of automatic steering control during turning running using the steering control module 6A and the target route setting module 6B configured as described above will be described with reference to the flowchart of FIG.
First, a linear traveling route as shown in FIG. 2 is calculated for the field to be worked (# 01). The tractor is moved to the starting point of the first selected target route (one of the linear traveling routes) (# 02). Then, the straight running following the target route by using the automatic steering is started (# 03). When the tractor reaches the end point of the target route (# 04Yes branch), it is checked whether there is a straight route to travel next (# 05), and if there is a linear route to travel next (# 05Yes branch). ), The transition turning running process of transferring to the next running path using turning running is started (# 06). In the transition turning traveling process, the linear traveling route that has been traveling up to now is the previous traveling route Ls, and the linear traveling route that is traveling next is the next traveling route Ln. If there is no linear traveling route to be traveled next (# 05No branch), the automatic traveling in this field ends (# 10).

移行旋回走行処理に入ると、仮想旋回円VCが算出される(#61)。次に、算出された仮想旋回円VCに基づいて経路線分CHが算出される(#62)。トラクタは、最小旋回半径での第1旋回走行を行う(#63)。同時に、車体基準位置から仮想旋回円VCへの接線が算出される(#64)。算出された接線とトラクタの走行方位とがなす角度:θが第1所定角:θt以内になっているかどうかチェックされる(#65)。角度:θが第1所定角:θt以内でなければ(#65No分岐)、第1旋回走行が続行される(#63)。角度:θが第1所定角:θt以内であれば(#65Yes分岐)、その時点での接線が基準接線RTと決定され、その接線を示す位置データが算出される(#66)。さらに当該接線の接点の位置データも算出される(#67)。 When the transition turning running process is started, the virtual turning circle VC is calculated (# 61). Next, the path line segment CH is calculated based on the calculated virtual swirl circle VC (# 62). The tractor makes the first turning run with the minimum turning radius (# 63). At the same time, a tangent line from the vehicle body reference position to the virtual turning circle VC is calculated (# 64). It is checked whether the angle formed by the calculated tangent line and the traveling direction of the tractor: θ is within the first predetermined angle: θt (# 65). If the angle: θ is not within the first predetermined angle: θt (# 65No branch), the first turning run is continued (# 63). If the angle: θ is within the first predetermined angle: θt (# 65Yes 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 (# 66). Further, the position data of the contact point of the tangent line is also calculated (# 67).

次に、基準接線RTを目標経路とする移行走行が第3操舵制御部63によって行われる(#68)。移行走行において、トラクタの車体基準位置が基準接線RTの接点の直前まで接近すると(#69Yes分岐)、移行走行が終了し、第2旋回走行が行われる(#70)。第2旋回走行では、目標経路となる経路線分CHが順次選択され、選択された経路線分CHを追従するように自動操舵が行われる(#71)。第2旋回走行が進み、トラクタが次走行経路Lnに進入するための条件(角度:αが第2所定角度:αt以内、かつ、距離:Dが所定距離以下)が成立すると(#72Yes分岐)、次走行経路Lnを目標経路とする操舵制御への移行が決定される(#73)。 Next, the shift traveling with the reference tangent RT as the target route is performed by the third steering control unit 63 (# 68). In the shift run, when the vehicle body reference position of the tractor approaches immediately before the contact point of the reference tangent RT (# 69Yes branch), the shift run ends and the second turn run is performed (# 70). In the second turning run, the route line segment CH as the target route is sequentially selected, and automatic steering is performed so as to follow the selected route line segment CH (# 71). When the second turning run proceeds and the conditions for the tractor to enter the next running path Ln (angle: α is within the second predetermined angle: αt and distance: D is within the predetermined distance) are satisfied (# 72Yes branch). , The shift to the steering control with the next traveling route Ln as the target route is determined (# 73).

以上の説明では、トラクタは、目標経路から離脱しても、前進操舵を用いて位置ずれを回復できるとしたが、場合によっては、後進操舵(切り返し走行)を用いた位置ずれ回復が必要となる。図9に例示するように、第2旋回走行においてトラクタが次走行経路Lnに入る手前で、方位と位置の両方が所定以上にずれて、前もって設定された制限値を超えた場合には、次走行経路Lnの延長線を目標経路として、当該目標経路に後進で接近する接近走行、ここでは後進旋回走行を行う。図9には、後進旋回走行の軌跡が符号Tbrで示されている。この後進旋回走行により、方位と位置とのずれが解消された場合、第2旋回走行に戻る。ただし、このような後進操舵を用いたずれ回復処理を所定回、例えば3回行っても、このずれが解消されなかった場合は、この移行旋回走行処理が停止される。 In the above explanation, it is said that the tractor can recover the misalignment by using the forward steering even if the tractor deviates from the target path, but in some cases, it is necessary to recover the misalignment by using the reverse steering (turning back running). .. As illustrated in FIG. 9, when both the direction and the position deviate by more than a predetermined value before the tractor enters the next traveling path Ln in the second turning traveling, the following limits are exceeded. With the extension line of the travel route Ln as the target route, the approaching travel that approaches the target route in the reverse direction, in which the reverse turning travel is performed. In FIG. 9, the locus of the reverse turning run is indicated by the reference numeral Tbr. When the deviation between the direction and the position is eliminated by this reverse turning run, the process returns to the second turning running. However, if the shift recovery process using the reverse steering is performed a predetermined number of times, for example, three times, but the shift is not resolved, the shift turning running process is stopped.

〔別実施の形態〕(1)上述した実施形態で、目標経路設定モジュール6Bで前もって設定されていた第1所定角や第2所定角などの制御しきい値(条件値)は、任意に設定可能である。また、作業の途中で、変更すること可能であるし、を外部から設定することも可能である。さらには、作業走行情報などに含まれている作業地の状態と作業種類との組み合わせから自動的に設定されるように構成してもよい。
(2)図4で示された機能ブロック図における各機能部の区分けは、説明を分かりやすくするための一例であり、種々の機能部を統合したり、単一の機能部を複数に分割したりすることは自由である。
(3)上述した実施形態では、作業装置として耕耘装置30を装備したトラクタが作業車として取り上げられたが、耕耘装置30以外の作業装置を装備したトラクタ、さらには、コンバインや田植機などの農作業機や建機などにも本発明は適用可能である。
[Separate Embodiment] (1) In the above-described embodiment, the control threshold values (condition values) such as the first predetermined angle and the second predetermined angle set in advance in the target route setting module 6B are arbitrarily set. It is possible. In addition, it is possible to change it in the middle of the work, and it is also possible to set it from the outside. Further, it may be configured to be automatically set from the combination of the work site state and the work type included in the work travel information and the like.
(2) The division of each functional part in the functional block diagram shown in FIG. 4 is an example for making the explanation easy to understand, and various functional parts may be integrated or a single functional part may be divided into a plurality of parts. You are free to do it.
(3) In the above-described embodiment, the tractor equipped with the cultivating device 30 as the working device is taken up as the work vehicle, but the tractor equipped with the working device other than the cultivating device 30 and further, the agricultural work such as the combine harvester and the rice transplanter. The present invention can also be applied to machines, construction machines, and the like.

なお、上記実施形態(別実施形態を含む、以下同じ)で開示される構成は、矛盾が生じない限り、他の実施形態で開示される構成と組み合わせて適用することが可能であり、また、本明細書において開示された実施形態は例示であって、本発明の実施形態はこれに限定されず、本発明の目的を逸脱しない範囲内で適宜改変することが可能である。 The configuration disclosed in the above embodiment (including another embodiment, the same shall apply hereinafter) can be applied in combination with the configuration disclosed in other embodiments as long as there is no contradiction. The embodiments disclosed in the present specification are examples, and the embodiments of the present invention are not limited thereto, and can be appropriately modified without departing from the object of the present invention.

本発明は、前走行経路から旋回走行を介して次走行経路に移行していく車両の自動操舵として適用可能である。 The present invention can be applied as automatic steering of a vehicle that shifts from a previous traveling path to a next traveling path via turning traveling.

1 :車体
5 :制御ユニット
6A :操舵制御モジュール
6B :目標経路設定モジュール
7 :衛星測位モジュール
60 :主操舵制御部
61 :第1操舵制御部
62 :第2操舵制御部
63 :第3操舵制御部
65 :主走行経路設定部
66 :旋回経路設定部
67 :仮想旋回円算出部
68 :接線算出部
70 :自車位置算出部
CH :経路線分
Ln :次走行経路
Ls :前走行経路
Pv :車体基準点
RT :基準接線
VC :仮想旋回円
1: Body 5: Control unit 6A: Steering control module 6B: Target route setting module 7: Satellite positioning module 60: Main steering control unit 61: First steering control unit 62: Second steering control unit 63: Third steering control unit 65: Main travel route setting unit 66: Turning route setting unit 67: Virtual turning circle calculation unit 68: Tangent calculation unit 70: Own vehicle position calculation unit CH: Route line Ln: Next travel route Ls: Previous travel route Pv: Vehicle body Reference point RT: Reference tangent VC: Virtual swivel circle

Claims (5)

前走行経路から旋回走行を介して次走行経路に移行していく自車位置検出機能付き車両の自動操舵システムであって、
前記次走行経路に進入する進入旋回走行のための操舵制御を行う進入操舵制御部と、
前記進入旋回走行の目標経路として設定された仮想旋回円への車体基準点からの接線を算出する接線算出部と、を備え、
前記接線算出部によって算出された前記接線と前記車両の走行方位とのなす角度が、第1所定角以内になった場合、当該接線が、前記車両が前記進入旋回走行に移行するための移行経路となる自動操舵システム。
It is an automatic steering system for vehicles with a vehicle position detection function that shifts from the previous travel route to the next travel route via turning travel.
An approach steering control unit that performs steering control for approach turning to enter the next travel path, and
It is provided with a tangent line calculation unit for calculating a tangent line from a vehicle body reference point to a virtual turning circle set as a target route for the approach turning run.
When the angle formed by the tangent line and the traveling direction of the vehicle calculated by the tangent line calculation unit is within the first predetermined angle, the tangent line is a transition route for the vehicle to shift to the approach turning traveling. Automatic steering system.
前記仮想旋回円は、前記仮想旋回円を複数の円弧に区分けすることで得られた弦である経路線分からなり、かつ、
前記進入操舵制御部は、前記目標経路として前記経路線分を順次選択しながら操舵制御を行う請求項1に記載の自動操舵システム。
The virtual swirl circle is composed of a path line segment which is a string obtained by dividing the virtual swirl circle into a plurality of arcs, and
The automatic steering system according to claim 1, wherein the approach steering control unit performs steering control while sequentially selecting the path line segment as the target route.
前記車両の走行方位と前記次走行経路とがなす角度が第2所定角度以内になり、かつ、前記車体基準点と前記次走行経路との間の距離が所定距離以下になった場合、前記次走行経路を新たな目標経路として、操舵制御が行われる請求項1又は2に記載の自動操舵システム。 When the angle formed by the traveling direction of the vehicle and the next traveling path is within the second predetermined angle and the distance between the vehicle body reference point and the next traveling path is equal to or less than the predetermined distance, the following The automatic steering system according to claim 1 or 2, wherein steering control is performed with the traveling route as a new target route. 前記前走行経路を離脱する離脱旋回走行のための操舵制御を行う離脱操舵制御部は、前記車両の最小旋回半径で、操舵制御を行う請求項1から3のいずれか一項に記載の自動操舵システム。 The automatic steering according to any one of claims 1 to 3, wherein the departure steering control unit that performs steering control for the separation turning traveling that leaves the front traveling path performs steering control with the minimum turning radius of the vehicle. system. 前記進入旋回走行の終了段階で、前記車両が前記次走行経路または前記次走行経路の延長線から制限値を超えて離間した場合、後進を用いた前記車両の前記次走行経路への接近走行が行われた後に、再び前記次走行経路への操舵制御が行われる請求項1から4のいずれか一項に記載の自動操舵システム。 When the vehicle is separated from the next traveling path or the extension line of the next traveling path by exceeding a limit value at the end stage of the approach turning traveling, the approaching traveling of the vehicle to the next traveling path using reverse movement is performed. The automatic steering system according to any one of claims 1 to 4, wherein steering control to the next traveling path is performed again after the steering is performed.
JP2020155283A 2017-04-26 2020-09-16 Automatic steering system Active JP6964735B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2020155283A JP6964735B2 (en) 2017-04-26 2020-09-16 Automatic steering system

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2017087348A JP6766006B2 (en) 2017-04-26 2017-04-26 Automatic steering system
JP2020155283A JP6964735B2 (en) 2017-04-26 2020-09-16 Automatic steering system

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP2017087348A Division JP6766006B2 (en) 2017-04-26 2017-04-26 Automatic steering system

Publications (2)

Publication Number Publication Date
JP2021009707A JP2021009707A (en) 2021-01-28
JP6964735B2 true JP6964735B2 (en) 2021-11-10

Family

ID=74200135

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020155283A Active JP6964735B2 (en) 2017-04-26 2020-09-16 Automatic steering system

Country Status (1)

Country Link
JP (1) JP6964735B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2024005845A (en) * 2022-06-30 2024-01-17 三菱重工業株式会社 Route setting method, program, and mobile body

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5177052B2 (en) * 2009-03-30 2013-04-03 井関農機株式会社 Traveling sprayer
JP5669998B1 (en) * 2014-07-04 2015-02-18 マミヤ・オーピー・ネクオス株式会社 Work machine, device for generating travel route of work machine, method, program, recording medium recording program, travel control device for work machine

Also Published As

Publication number Publication date
JP2021009707A (en) 2021-01-28

Similar Documents

Publication Publication Date Title
JP6766006B2 (en) Automatic steering system
JP7072496B2 (en) Control device for self-driving work vehicles
WO2019111563A1 (en) Traveling route setting device
KR102534336B1 (en) Route generation system
CN109152330A (en) Field driving path generates system and field Operation Van
WO2020059653A1 (en) Field work vehicle
JP7384950B2 (en) automatic driving system
JP2020100235A (en) Field working vehicle
JP6964735B2 (en) Automatic steering system
JP2024053067A (en) Autonomous driving system and method
JP6871831B2 (en) Autonomous driving system for work vehicles
JP7045979B2 (en) Traveling work machine
JP7069002B2 (en) Field work vehicle and field map data generation system
WO2020129704A1 (en) Travel working machine
JP6976782B2 (en) Autonomous driving system for work vehicles
WO2022149389A1 (en) Automatic travel system and automatic travel method
WO2020044811A1 (en) Automatic running system
WO2020137810A1 (en) Work vehicle, and work machinery equipped with work vehicle
JP2023078169A (en) Route generating system and route generating method
JP2020028273A (en) Travel path display unit
JP2020101964A (en) Travel state display device and automatic travel system

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20201015

TRDD Decision of grant or rejection written
A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20210915

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20210921

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20211019

R150 Certificate of patent or registration of utility model

Ref document number: 6964735

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150