JP6837449B2 - Automatic driving system for work vehicles - Google Patents
Automatic driving system for work vehicles Download PDFInfo
- Publication number
- JP6837449B2 JP6837449B2 JP2018064549A JP2018064549A JP6837449B2 JP 6837449 B2 JP6837449 B2 JP 6837449B2 JP 2018064549 A JP2018064549 A JP 2018064549A JP 2018064549 A JP2018064549 A JP 2018064549A JP 6837449 B2 JP6837449 B2 JP 6837449B2
- Authority
- JP
- Japan
- Prior art keywords
- work
- obstacle
- unit
- contact avoidance
- map data
- 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
Links
- 238000000034 method Methods 0.000 claims description 79
- 238000001514 detection method Methods 0.000 claims description 45
- 238000005259 measurement Methods 0.000 claims description 33
- 238000012545 processing Methods 0.000 claims description 29
- 238000010295 mobile communication Methods 0.000 claims description 26
- 230000003028 elevating effect Effects 0.000 claims description 13
- 230000005540 biological transmission Effects 0.000 description 9
- 230000001174 ascending effect Effects 0.000 description 8
- 238000004891 communication Methods 0.000 description 7
- 230000002093 peripheral effect Effects 0.000 description 5
- 238000012937 correction Methods 0.000 description 3
- 244000025254 Cannabis sativa Species 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000003384 imaging method Methods 0.000 description 2
- 230000008595 infiltration Effects 0.000 description 2
- 238000001764 infiltration Methods 0.000 description 2
- 238000012546 transfer Methods 0.000 description 2
- 240000007594 Oryza sativa Species 0.000 description 1
- 235000007164 Oryza sativa Nutrition 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000005670 electromagnetic radiation Effects 0.000 description 1
- 230000002706 hydrostatic effect Effects 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 230000001681 protective effect Effects 0.000 description 1
- 235000009566 rice Nutrition 0.000 description 1
- 238000003971 tillage Methods 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Guiding Agricultural Machines (AREA)
- Lifting Devices For Agricultural Implements (AREA)
Description
本発明は、作業車両を作業地において自動走行させる作業車両用の自動走行システムに関する。 The present invention relates to an automatic traveling system for a work vehicle that automatically travels a work vehicle on a work site.
作業車両としては、作業車両の下方において地表に浸透する電磁放射を送受する地面浸透装置と、地面浸透装置からの信号により、機体下方における作業装置(作業具)の切削深さの範囲内における障害物(望ましくない物体)の存否を検出する物体検出装置と、物体検出装置からの信号に基づいて作業装置の昇降を制御する作業具制御装置とを有する自動物体応答制御装置を備えて、作業装置が作業地の障害物に接触するのを防止するように構成されたものがある(例えば特許文献1参照)。 As a work vehicle, a ground infiltration device that transmits and receives electromagnetic radiation that penetrates the ground surface below the work vehicle, and an obstacle within the cutting depth of the work device (work tool) below the machine body due to a signal from the ground infiltration device. A work device including an automatic object response control device having an object detection device for detecting the presence or absence of an object (undesirable object) and a work tool control device for controlling the ascent and descent of the work device based on a signal from the object detection device. Some are configured to prevent the device from coming into contact with obstacles in the work area (see, for example, Patent Document 1).
上記のような自動物体応答制御装置を備えると、作業装置が作業車両の下方に存在する障害物に接触するのを防止することができる。しかしながら、上記のような自動物体応答制御装置では、作業車両が接触回避対象となる障害物の上方に達するまでは、その障害物の存在を検知することができないことから、その障害物に対する作業装置の接触回避を余裕をもって適切に行うことができないようになっている。 When the automatic object response control device as described above is provided, it is possible to prevent the work device from coming into contact with an obstacle existing below the work vehicle. However, since the automatic object response control device as described above cannot detect the presence of the obstacle until the work vehicle reaches above the obstacle to be avoided from contact with the obstacle, the work device for the obstacle cannot be detected. It is not possible to properly avoid contact with a margin.
この実情に鑑み、本発明の主たる課題は、自動走行する作業車両が障害物に対する作業装置の接触回避を余裕をもって適切に行えるようにする点にある。 In view of this situation, a main problem of the present invention is to enable an automatically traveling work vehicle to appropriately avoid contact with an obstacle by a work device with a margin.
本発明の第1特徴構成は、
衛星測位システムを利用して作業車両の現在位置を測定する測位ユニットと、
前記作業車両を自動走行させる自動走行ユニットと、
前記作業車両の横外方を検知範囲に含む障害物検知用の第1超音波センサと、
作業地を含む地図データが記憶された記憶部と、
前記測位ユニットからの測位情報と前記第1超音波センサからの検知情報とに基づいて、前記第1超音波センサが検知した障害物を前記地図データに登録して前記地図データを更新する地図データ処理部と、
更新後の前記地図データと前記測位ユニットからの測位情報とに基づいて、前記作業車両に装備された作業装置と前記障害物との接触を回避する接触回避制御を行う接触回避制御部と、
を有する点にある。
The first characteristic configuration of the present invention is
A positioning unit that measures the current position of a work vehicle using a satellite positioning system,
An automatic traveling unit that automatically travels the work vehicle, and
The first ultrasonic sensor for detecting obstacles that includes the lateral outside of the work vehicle in the detection range, and
A storage unit that stores map data including the work area,
Map data that registers obstacles detected by the first ultrasonic sensor in the map data and updates the map data based on the positioning information from the positioning unit and the detection information from the first ultrasonic sensor. Processing unit and
A contact avoidance control unit that performs contact avoidance control for avoiding contact between the work device equipped on the work vehicle and the obstacle based on the updated map data and the positioning information from the positioning unit.
Is in the point of having.
本構成によれば、自動走行中の作業車両が障害物の横側方を通過するときには、その障害物を第1超音波センサが検知することから、地図データ処理部は、そのときの検知情報と測位ユニットからの測位情報とに基づいて障害物の位置情報を取得することができ、障害物を地図データに登録して地図データを更新することができる。そして、接触回避制御部は、更新後の地図データと測位ユニットからの測位情報とに基づいて、作業車両が障害物の上方に達するよりもかなり前の、例えば作業車両が障害物の横側方を通過した時点において、その障害物が作業地のどの位置に存在するかを認知することができる。
これにより、接触回避制御部は、接触回避制御において、例えば、作業車両が障害物の上方を通らないように作業車両の走行経路を変更する等の時間を要する適切な接触回避処理を余裕をもって行うことができる。そして、このように作業車両の走行経路を変更する場合には、例えば、接触回避制御部が更新後の地図データや変更後の作業車両の走行経路等の接触回避に関する各情報を、作業地やその近くに居る作業者や作業管理者等に通知するようにすれば、通知された作業者や作業管理者等は、その走行経路の変更に伴って生じる作業車両による作業の仕残し領域を容易に把握することができ、仕残し領域に対する手作業等の適切な対処を迅速に行うことができる。
その結果、自動走行中の作業車両は障害物に対する作業装置の接触回避を余裕をもって適切に行えるようになり、これにより、作業車両の作業装置が障害物に接触する虞をより確実に回避することができる。又、これに加えて、その接触回避によって生じる作業の仕残し領域に対する適切な処置を迅速に行うことが可能になる。
According to this configuration, when the work vehicle in automatic traveling passes by the side of the obstacle, the first ultrasonic sensor detects the obstacle, so that the map data processing unit detects the detection information at that time. The position information of the obstacle can be acquired based on the positioning information from the positioning unit and the obstacle can be registered in the map data and the map data can be updated. Then, based on the updated map data and the positioning information from the positioning unit, the contact avoidance control unit performs a long time before the work vehicle reaches above the obstacle, for example, the work vehicle is lateral to the obstacle. At the time of passing through, it is possible to recognize the position of the obstacle in the work area.
As a result, in the contact avoidance control, the contact avoidance control unit performs an appropriate contact avoidance process that requires time, such as changing the traveling route of the work vehicle so that the work vehicle does not pass above the obstacle. be able to. Then, when the travel route of the work vehicle is changed in this way, for example, the contact avoidance control unit provides the updated map data, the updated travel route of the work vehicle, and other information related to contact avoidance to the work location and the work location. By notifying the workers and work managers who are nearby, the notified workers and work managers can easily leave the work left behind area by the work vehicle caused by the change of the traveling route. It is possible to quickly take appropriate measures such as manual work for the leftover area.
As a result, the work vehicle in automatic traveling can appropriately avoid contact with the obstacle with a margin, thereby more surely avoiding the possibility that the work device of the work vehicle comes into contact with the obstacle. Can be done. In addition to this, it becomes possible to quickly take appropriate measures for the unfinished area of work caused by the contact avoidance.
本発明の第2特徴構成は、
前記作業装置を昇降駆動する昇降駆動機構と、
検知範囲が前記作業車両における前記作業装置よりも前方側の底部から下向きに設定された障害物検知用の第2超音波センサとを備え、
前記接触回避制御部は、前記接触回避制御において、更新後の前記地図データと前記測位ユニットからの測位情報とに基づいて、前記作業車両の走行部が前記地図データに登録された障害物に乗り上げるか否かを判定する乗り上げ判定処理と、前記乗り上げ判定処理にて乗り上げないと判定した場合に、前記第2超音波センサからの検知情報に基づいて前記障害物の高さを検知して前記昇降駆動機構の作動を制御する第1接触回避処理を行う点にある。
The second characteristic configuration of the present invention is
An elevating drive mechanism that elevates and drives the work device,
It is equipped with a second ultrasonic sensor for obstacle detection whose detection range is set downward from the bottom on the front side of the work device in the work vehicle.
In the contact avoidance control, the contact avoidance control unit makes the traveling unit of the work vehicle ride on the obstacle registered in the map data based on the updated map data and the positioning information from the positioning unit. When it is determined by the ride-on determination process for determining whether or not the vehicle is not to ride, the height of the obstacle is detected based on the detection information from the second ultrasonic sensor and the vehicle moves up and down. The point is that the first contact avoidance process for controlling the operation of the drive mechanism is performed.
本構成によれば、接触回避制御部は、乗り上げ判定処理において走行部が障害物に乗り上げないと判定した場合は、第2超音波センサからの検知情報によって障害物の高さを検知することが可能であることを考慮して、第2超音波センサからの検知情報に基づく第1接触回避処理を行う。そして、この第1接触回避処理においては、第2超音波センサが障害物の上方に達して障害物の高さを検知したときに、接触回避制御部は、その検知した障害物の高さに基づいて、昇降駆動機構の作動を制御して作業装置を昇降させることで、作業装置が障害物に接触する虞を回避する。
つまり、作業車両の走行経路を変更することなく、作業車両の作業装置が障害物に接触する虞を回避することができる。これにより、走行経路を変更する場合よりも作業車両による作業の仕残し領域を少なくすることができ、その仕残し領域に対する作業に要する労力を軽減することができる。
According to this configuration, when the contact avoidance control unit determines in the riding determination process that the traveling unit does not climb on an obstacle, the contact avoidance control unit can detect the height of the obstacle by the detection information from the second ultrasonic sensor. Considering that it is possible, the first contact avoidance process is performed based on the detection information from the second ultrasonic sensor. Then, in this first contact avoidance process, when the second ultrasonic sensor reaches above the obstacle and detects the height of the obstacle, the contact avoidance control unit sets the height of the detected obstacle. Based on this, by controlling the operation of the elevating drive mechanism to raise and lower the working device, it is possible to avoid the possibility that the working device comes into contact with an obstacle.
That is, it is possible to avoid the possibility that the work device of the work vehicle comes into contact with an obstacle without changing the travel route of the work vehicle. As a result, it is possible to reduce the unfinished area of work by the work vehicle as compared with the case of changing the traveling route, and it is possible to reduce the labor required for the work on the unfinished area.
本発明の第3特徴構成は、
前記作業車両の前後一方側が測定範囲に設定されたライダーセンサを備え、
前記接触回避制御部は、前記乗り上げ判定処理にて乗り上げると判定した場合に、前記ライダーセンサからの測定情報に基づいて前記障害物の高さを検知して前記昇降駆動機構の作動を制御する第2接触回避処理を行う点にある。
The third characteristic configuration of the present invention is
The front and rear sides of the work vehicle are equipped with a rider sensor set in the measurement range.
The contact avoidance control unit detects the height of the obstacle based on the measurement information from the rider sensor and controls the operation of the elevating drive mechanism when it is determined to ride on the vehicle in the riding determination process. 2 The point is to perform contact avoidance processing.
本構成によれば、接触回避制御部は、乗り上げ判定処理において走行部が障害物に乗り上げると判定した場合は、第2超音波センサからの検知情報によって障害物の高さを検知することが不可能になることを考慮して、ライダーセンサからの測定情報に基づく第2接触回避処理を行う。そして、この第2接触回避処理においては、走行部が障害物に乗り上げることでライダーセンサからの測定情報が変化したときに、接触回避制御部は、そのときのライダーセンサからの測定情報の変化に基づいて障害物の高さを検知し、その検知した障害物の高さに基づいて、昇降駆動機構の作動を制御して作業装置を昇降させることで、作業装置が障害物に接触する虞を回避する。
つまり、走行部が障害物に乗り上げる場合においても、作業車両の走行経路を変更することなく、作業車両の作業装置が障害物に接触する虞を回避することができる。これにより、走行経路を変更する場合よりも作業車両による作業の仕残し領域を少なくすることができ、その仕残し領域に対する作業に要する労力を軽減することができる。
According to this configuration, when the contact avoidance control unit determines that the traveling unit rides on an obstacle in the riding determination process, it cannot detect the height of the obstacle by the detection information from the second ultrasonic sensor. Considering that it will be possible, the second contact avoidance process based on the measurement information from the rider sensor is performed. Then, in this second contact avoidance process, when the measurement information from the rider sensor changes due to the traveling unit riding on an obstacle, the contact avoidance control unit changes the measurement information from the rider sensor at that time. By detecting the height of an obstacle based on the above, and controlling the operation of the elevating drive mechanism to move the work device up and down based on the detected height of the obstacle, the work device may come into contact with the obstacle. To avoid.
That is, even when the traveling unit rides on an obstacle, it is possible to avoid the possibility that the working device of the working vehicle comes into contact with the obstacle without changing the traveling route of the working vehicle. As a result, it is possible to reduce the unfinished area of work by the work vehicle as compared with the case of changing the traveling route, and it is possible to reduce the labor required for the work on the unfinished area.
本発明の第4特徴構成は、
前記接触回避制御部は、前記第1接触回避処理又は前記第2接触回避処理において、前記作業車両が前記障害物の存在位置から設定距離だけ手前の減速位置に達したか否かを判定する減速位置到達判定処理と、前記作業車両が前記減速位置に達したときに車速を低下させる減速処理とを行う点にある。
The fourth characteristic configuration of the present invention is
In the first contact avoidance process or the second contact avoidance process, the contact avoidance control unit determines whether or not the work vehicle has reached a deceleration position in front of the obstacle existing position by a set distance. The point is that the position arrival determination process and the deceleration process of reducing the vehicle speed when the work vehicle reaches the deceleration position are performed.
本構成によれば、作業車両が障害物に近づいて減速位置に達するまでの車速を速くすることが可能になる。
その結果、作業効率の向上を図りながら作業車両の作業装置が障害物に接触する虞を回避することができる。
According to this configuration, it is possible to increase the vehicle speed until the work vehicle approaches the obstacle and reaches the deceleration position.
As a result, it is possible to avoid the possibility that the work device of the work vehicle comes into contact with an obstacle while improving the work efficiency.
本発明の第5特徴構成は、
前記地図データ処理部と通信可能な携帯通信端末を備え、
前記地図データ処理部は、前記携帯通信端末との通信により、更新後の地図データを前記携帯通信端末の表示部に表示させて前記障害物の存在位置を知らせる障害物用報知処理を行う点にある。
The fifth characteristic configuration of the present invention is
A mobile communication terminal capable of communicating with the map data processing unit is provided.
The map data processing unit displays updated map data on the display unit of the mobile communication terminal by communicating with the mobile communication terminal to perform obstacle notification processing for notifying the location of the obstacle. is there.
本構成によれば、作業装置と障害物との接触回避のために、障害物の周辺での作業装置による作業精度の低下(例えば、作業の仕残し等)が生じる場合には、前述した障害物用報知処理により、携帯通信端末を所持する作業管理者や作業者等は、その作業精度の低下を容易に予測することができ、作業精度の低下に対する適切な補助作業を迅速に行える。 According to this configuration, in order to avoid contact between the work device and the obstacle, when the work accuracy is lowered by the work device around the obstacle (for example, leftover work), the above-mentioned obstacle is caused. By the object notification process, the work manager or the worker who possesses the mobile communication terminal can easily predict the decrease in the work accuracy, and can quickly perform an appropriate auxiliary work for the decrease in the work accuracy.
以下、本発明を実施するための形態の一例として、本発明に係る作業車両用の自動走行システムを、作業車両の一例であるトラクタに適用した実施形態を図面に基づいて説明する。
尚、本発明に係る作業車両用の自動走行システムは、トラクタ以外の、例えば乗用草刈機、乗用田植機、コンバイン、除雪車等の乗用作業車両、及び、無人草刈機等の無人作業車両に適用することができる。
Hereinafter, as an example of a mode for carrying out the present invention, an embodiment in which the automatic traveling system for a work vehicle according to the present invention is applied to a tractor as an example of a work vehicle will be described with reference to the drawings.
The automatic traveling system for work vehicles according to the present invention is applied to other than tractors, for example, passenger work vehicles such as passenger mowers, rice transplanters, combines and snow removers, and unmanned work vehicles such as unmanned mowers. can do.
図1及び図2に示すように、本実施形態で例示するトラクタ1は、作業車両用の自動走行システムによって作業地S(図3参照)等において自動走行するように構成されている。この自動走行システムは、トラクタ1に搭載された自動走行ユニット2、及び、自動走行ユニット2と通信可能に通信設定された携帯通信端末3を備えている。携帯通信端末3には、タッチ操作可能な表示部51(例えば、液晶パネル)等を有するタブレット型のパーソナルコンピュータやスマートフォン等を採用することができる。
As shown in FIGS. 1 and 2, the
トラクタ1は、駆動可能な操舵輪として機能する左右の前輪(走行部の一例)5、及び、駆動可能な左右の後輪(走行部の一例)6を有する走行機体7が備えられている。走行機体7の前部側には、前部フレーム27とボンネット8とが配置され、ボンネット8の内部には、コモンレールシステムを備えた電子制御式のディーゼルエンジン(以下、エンジンと称する)9が備えられている。走行機体7のボンネット8よりも後方側には、搭乗式の運転部を形成するキャビン10が備えられている。
The
走行機体7の後部には、3点リンク機構11を介して、作業装置12の一例である草刈装置が昇降可能に連結されている。これにより、トラクタ1は草刈仕様に構成されている。トラクタ1の後部には、草刈装置に代えて、ロータリ耕耘装置、プラウ、除雪装置等の作業装置12を連結することができる。
A mowing device, which is an example of the working
トラクタ1には、図2に示すように、エンジン9からの動力を変速する電子制御式の変速装置13、左右の前輪5を操舵する全油圧式のパワーステアリング機構14、左右の後輪6を制動する左右のサイドブレーキ(図示せず)、左右のサイドブレーキの油圧操作を可能にする電子制御式のブレーキ操作機構15、草刈装置等の作業装置12への伝動を断続する作業クラッチ(図示せず)、作業クラッチの油圧操作を可能にする電子制御式のクラッチ操作機構16、草刈装置等の作業装置12を昇降駆動する電子油圧制御式の昇降駆動機構17、トラクタ1の自動走行等に関する各種の制御プログラム等を有する車載電子制御ユニット18、トラクタ1の車速を検出する車速センサ19、前輪5の操舵角を検出する舵角センサ20、及び、トラクタ1の現在位置及び現在方位を測定する測位ユニット21等が備えられている。
As shown in FIG. 2, the
尚、エンジン9には、電子ガバナを備えた電子制御式のガソリンエンジンを採用してもよい。変速装置13には、油圧機械式無段変速装置(HMT)、静油圧式無段変速装置(HST)、又は、ベルト式無段変速装置等を採用することができる。パワーステアリング機構14には、電動モータを備えた電動式のパワーステアリング機構14等を採用してもよい。
An electronically controlled gasoline engine equipped with an electronic governor may be adopted as the
キャビン10の内部には、図1に示すように、パワーステアリング機構14(図2参照)を介した左右の前輪5の手動操舵を可能にするステアリングホイール38、搭乗者用の運転席39、タッチパネル式の表示部、及び、各種の操作具等が備えられている。キャビン10の前方側部位の両横側部には、キャビン10(運転席39)に対する乗降部となる乗降ステップ41が備えられている。
Inside the
図2に示すように、車載電子制御ユニット18は、変速装置13の作動を制御する変速制御部181、左右のサイドブレーキの作動を制御する制動制御部182、草刈装置等の作業装置12の作動を制御する作業装置制御部183、自動走行時に左右の前輪5の目標操舵角を設定してパワーステアリング機構14に出力する操舵角設定部184、及び、予め設定された自動走行用の目標走行経路P(例えば、図3参照)等を記憶する不揮発性の車載記憶部185等を有している。
As shown in FIG. 2, the vehicle-mounted
図2に示すように、測位ユニット21には、衛星測位システム(NSS:Navigation Satellite System)の一例であるGPS(Global Positioning System)を利用してトラクタ1の現在位置と現在方位とを測定する衛星航法装置22、及び、3軸のジャイロスコープ及び3方向の加速度センサ等を有してトラクタ1の姿勢や方位等を測定する慣性計測装置(IMU:Inertial Measurement Unit)23等が備えられている。GPSを利用した測位方法には、DGPS(Differential GPS:相対測位方式)やRTK−GPS(Real Time Kinematic GPS:干渉測位方式)等がある。本実施形態においては、移動体の測位に適したRTK−GPSが採用されている。そのため、作業地周辺の既知位置には、図1及び図2に示すように、RTK−GPSによる測位を可能にする基準局4が設置されている。
As shown in FIG. 2, the
トラクタ1と基準局4との夫々には、図2に示すように、GPS衛星71(図1参照)から送信された電波を受信するGPSアンテナ24,61、及び、トラクタ1と基準局4との間における測位データを含む各種データの無線通信を可能にする通信モジュール25,62等が備えられている。これにより、衛星航法装置22は、トラクタ側のGPSアンテナ24がGPS衛星71からの電波を受信して得た測位データと、基地局側のGPSアンテナ61がGPS衛星71からの電波を受信して得た測位データとに基づいて、トラクタ1の現在位置及び現在方位を高い精度で測定することができる。又、測位ユニット21は、衛星航法装置22と慣性計測装置23とを備えることにより、トラクタ1の現在位置、現在方位、姿勢角(ヨー角、ロール角、ピッチ角)を高精度に測定することができる。
As shown in FIG. 2, the
トラクタ1に備えられるGPSアンテナ24、通信モジュール25、及び、慣性計測装置23は、図1に示すように、アンテナユニット80に収納されている。アンテナユニット80は、キャビン10の前面側の上部位置に配置されている。
The
図2に示すように、携帯通信端末3には、表示部51等の作動を制御する各種の制御プログラム等を有する端末電子制御ユニット52、及び、トラクタ側の通信モジュール25との間における測位データを含む各種データの無線通信を可能にする通信モジュール55等が備えられている。端末電子制御ユニット52は、トラクタ1を自動走行させるための走行案内用の目標走行経路P(例えば、図3参照)を生成する走行経路生成部53、及び、ユーザが入力した各種の入力データや走行経路生成部53が生成した目標走行経路P等を記憶する不揮発性の端末記憶部54等を有している。
As shown in FIG. 2, the
走行経路生成部53が目標走行経路Pを生成するに当たり、携帯通信端末3の表示部51に表示された目標走行経路設定用の入力案内に従って、運転者や管理者を含むユーザ等が、作業車両や作業装置12の種類及び機種等の車体データを入力しており、入力された車体データが端末記憶部54に記憶されている。目標走行経路Pの生成対象となる走行領域R(図3参照)を作業地Sでの作業領域としており、携帯通信端末3の端末電子制御ユニット52は、作業地Sを含む地図データを取得し、この地図データから作業地Sの形状や位置を特定し、その特定した作業地Sの形状や位置から特定した走行領域Rを含む作業地データを取得する。図3では、矩形状の走行領域Rが特定された例を示している。
When the travel
特定された作業地Sの形状や位置等を含む作業地データが端末記憶部54に記憶されると、走行経路生成部53は、端末記憶部54に記憶されている作業地データや車体データを用いて目標走行経路Pを生成する。
When the work area data including the shape and position of the specified work area S is stored in the
図3に示すように、走行経路生成部53は、走行領域Rを中央領域R1と外周領域R2とに区分け設定している。中央領域R1は、走行領域Rの中央部に設定されており、先行してトラクタ1を往復方向に自動走行させて所定の作業(例えば、草刈り等の作業)を行う往復作業領域となっている。外周領域R2は、中央領域R1の周囲に設定されており、中央領域R1に後続してトラクタ1を周回方向に自動走行させて所定の作業を行う周回作業領域となっている。走行経路生成部53は、例えば、車体データに含まれる旋回半径やトラクタ1の前後長さ及び作業幅等から、トラクタ1を作業地Sの際で旋回走行させるために必要となる旋回走行用のスペース等を求めている。走行経路生成部53は、中央領域R1の外周に求めたスペース等を確保するように、走行領域Rを中央領域R1と外周領域R2とに区分けしている。
As shown in FIG. 3, the traveling
走行経路生成部53は、図3に示すように、車体データや作業地データ等を用いて目標走行経路Pを生成している。例えば、目標走行経路Pは、中央領域R1において同じ直進距離を有して作業幅に対応する一定間隔で平行に配置設定された複数の作業経路P1と、隣接する作業経路P1の終端と始端とを走行順に接続する非作業用の複数の旋回経路P2と、外周領域R2に形成される周回経路P3(図中点線にて示している)とを有している。複数の作業経路P1は、トラクタ1が直進走行しながら所定の作業を行うための経路である。旋回経路P2は、トラクタ1が所定の作業を行わずに、トラクタ1の走行方向を180度転換するためのUターン経路であり、作業経路P1の終端と隣接する次の作業経路P1の始端とを接続している。周回経路P3は、外周領域R2にてトラクタ1が周回走行しながら所定の作業を行うための経路である。周回経路P3において、走行領域Rの四隅に位置する経路部は、トラクタ1が前進走行と後進走行とを適宜行いながら、トラクタ1の走行方向を90度転換するための経路部である。ちなみに、図3に示す目標走行経路Pは、あくまで一例であり、どのような目標走行経路を生成するかは、車体データや作業地データ等に応じて種々の変更が可能である。
As shown in FIG. 3, the travel
走行経路生成部53にて生成された目標走行経路Pは、表示部51に表示可能であり、車体データ及び作業地データ等と関連付けた経路データとして端末記憶部54に記憶されている。経路データには、目標走行経路Pの方位角、及び、目標走行経路Pでのトラクタ1の走行形態等に応じて設定された設定エンジン回転速度や目標走行速度等が含まれている。
The target travel route P generated by the travel
このようにして、走行経路生成部53が目標走行経路Pを生成すると、端末電子制御ユニット52が、携帯通信端末3からトラクタ1に地図データとともに経路データを転送することで、トラクタ1の車載電子制御ユニット18が、地図データとともに経路データを取得することができる。車載電子制御ユニット18は、取得した経路データに基づいて、測位ユニット21にて自己の現在位置(トラクタ1の現在位置)を取得しながら、目標走行経路Pに沿ってトラクタ1を自動走行させることができる。測位ユニット21が取得するトラクタ1の現在位置については、リアルタイム(例えば、数秒周期)でトラクタ1から携帯通信端末3に送信されており、携帯通信端末3にてトラクタ1の現在位置が把握されている。
In this way, when the travel
経路データの転送に関しては、トラクタ1が自動走行を開始する前の段階において、経路データの全体を端末電子制御ユニット52から車載電子制御ユニット18に一挙に転送することができる。又、例えば、目標走行経路Pを含む経路データを、データ量の少ない所定距離ごとの複数の経路部分に分割することもできる。この場合には、トラクタ1が自動走行を開始する前の段階においては、経路データの初期経路部分のみが端末電子制御ユニット52から車載電子制御ユニット18に転送される。自動走行の開始後は、トラクタ1がデータ量等に応じて設定された経路取得地点に達するごとに、その地点に対応する以後の経路部分のみの経路データが端末電子制御ユニット52から車載電子制御ユニット18に転送されるようにしてもよい。
Regarding the transfer of the route data, the entire route data can be transferred from the terminal
トラクタ1の自動走行を開始する場合には、例えば、ユーザ等がスタート地点にトラクタ1を移動させた後に、各種の自動走行開始条件が満たされると、携帯通信端末3にて、ユーザが表示部51を操作して自動走行の開始を指示することで、携帯通信端末3は、自動走行の開始指示をトラクタ1に送信する。これにより、トラクタ1では、車載電子制御ユニット18が、自動走行の開始指示を受けることで、測位ユニット21にて自己の現在位置(トラクタ1の現在位置)を取得しながら、目標走行経路Pに沿ってトラクタ1を自動走行させる自動走行制御を開始する。
When starting the automatic running of the
自動走行制御には、変速装置13の作動を自動制御する自動変速制御、ブレーキ操作機構15の作動を自動制御する自動制動制御、左右の前輪5を自動操舵する自動操舵制御、及び、草刈装置等の作業装置12の作動を自動制御する作業用自動制御等が含まれている。
The automatic driving control includes automatic shift control that automatically controls the operation of the
自動変速制御においては、変速制御部181が、目標走行速度を含む目標走行経路Pの経路データと測位ユニット21の出力と車速センサ19の出力とに基づいて、目標走行経路Pでのトラクタ1の走行形態等に応じて設定された目標走行速度がトラクタ1の車速として得られるように変速装置13の作動を自動制御する。
In the automatic shift control, the
自動制動制御においては、制動制御部182が、目標走行経路Pと測位ユニット21の出力とに基づいて、目標走行経路Pの経路データに含まれている制動領域において左右のサイドブレーキが左右の後輪6を適正に制動するようにブレーキ操作機構15の作動を自動制御する。
In the automatic braking control, the
自動操舵制御においては、トラクタ1が目標走行経路Pを自動走行するように、操舵角設定部184が、目標走行経路Pの経路データと測位ユニット21の出力とに基づいて左右の前輪5の目標操舵角を求めて設定し、設定した目標操舵角をパワーステアリング機構14に出力する。パワーステアリング機構14が、目標操舵角と舵角センサ20の出力とに基づいて、目標操舵角が左右の前輪5の操舵角として得られるように左右の前輪5を自動操舵する。
In the automatic steering control, the steering
作業用自動制御においては、作業装置制御部183が、目標走行経路Pの経路データと測位ユニット21の出力とに基づいて、トラクタ1が作業経路P1(例えば、図3参照)の始端等の作業開始位置に達するのに伴って作業装置12による所定の作業(例えば草刈り作業)が開始され、かつ、トラクタ1が作業経路P1(例えば、図3参照)の終端等の作業終了位置に達するのに伴って作業装置12による所定の作業が停止されるように、クラッチ操作機構16及び昇降駆動機構17の作動を自動制御する。
In the automatic work control, the work
このようにして、このトラクタ1においては、変速装置13、パワーステアリング機構14、ブレーキ操作機構15、クラッチ操作機構16、昇降駆動機構17、車載電子制御ユニット18、車速センサ19、舵角センサ20、及び、通信モジュール25等により、測位ユニット21からの測定情報と目標走行経路Pとに基づいて、トラクタ1を目標走行経路Pに沿って自動走行させる自動走行ユニット2が構成されている。
In this way, in the
この実施形態では、キャビン10にユーザ等が搭乗せずにトラクタ1を自動走行させるだけでなく、キャビン10にユーザ等が搭乗した状態でトラクタ1を自動走行させることも可能となっている。よって、キャビン10にユーザ等が搭乗せずに、車載電子制御ユニット18による自動走行制御により、トラクタ1を目標走行経路Pに沿って自動走行させることができるだけでなく、キャビン10にユーザ等が搭乗している場合でも、車載電子制御ユニット18による自動走行制御により、トラクタ1を目標走行経路Pに沿って自動走行させることができる。
In this embodiment, it is possible not only to automatically drive the
キャビン10にユーザ等が搭乗している場合には、トラクタの走行状態を、車載電子制御ユニット18にてトラクタ1を自動走行させる自動走行状態と、ユーザ等の運転に基づいてトラクタ1を走行させる手動走行状態とに切り替えることができる。よって、トラクタが自動走行状態にて目標走行経路Pを自動走行している途中において、トラクタの走行状態を自動走行状態から手動走行状態に切り替えることができる。逆に、トラクタが手動走行状態にて走行している途中において、トラクタの走行状態を手動走行状態から自動走行状態に切り替えることができる。手動走行状態と自動走行状態との切り替えについては、例えば、運転席39の近傍に、自動走行状態と手動走行状態との切り替えを可能にするための切替操作部を備えることができるとともに、その切替操作部を携帯通信端末3の表示部51に表示させることもできる。又、車載電子制御ユニット18による自動走行制御中に、ユーザがステアリングホイール38を操作すると、トラクタの走行状態が自動走行状態から手動走行状態に切り替わるようにすることもできる。
When a user or the like is on board the
図1、図2及び図4〜6に示すように、トラクタ1は、トラクタ1(走行機体7)の周囲における障害物Zの存否を検知し、障害物Zを検知した場合に、作業装置12が障害物Zに接触するのを回避する接触回避システム100を備えている。接触回避システム100は、トラクタ1の右横外方を検知範囲Na,Nbに含む前後2つの第1超音波センサ103A,103Bを有する障害物検知用の右センサユニット103と、トラクタ1の左横外方を検知範囲Na,Nbに含む前後2つの第1超音波センサ104A,104Bを有する障害物検知用の左センサユニット104と、検知範囲Mがトラクタ1における作業装置12よりも前方側の底部1Aから下向きに設定された障害物検知用の第2超音波センサ105と、トラクタ1の前方側が測定範囲Cに設定された前ライダーセンサ101と、トラクタ1の後方側が測定範囲Dに設定された後ライダーセンサ102と、地図データを更新する地図データ処理部106と、作業装置12と障害物Zとの接触を回避する接触回避処理を行う接触回避制御部107とを有している。
As shown in FIGS. 1, 2 and 4 to 6, the
各超音波センサ103A,103B,104A,104B,105は、発信した超音波が物体に当たって跳ね返ってくるまでの往復時間から物体までの距離を測定するTOF(Time Of Flight)方式により、物体までの距離を測定する。各超音波センサ103A,103B,104A,104B,105は、反射波の強度から、検知範囲内の物体が、作業装置12による所定の作業(例えば草刈り作業)に支障のない地面の凹凸や草等の作業対象物か、支障をきたすマンホールや側溝ブロック等の障害物Zかを判定する。
Each
図1及び図4〜6に示すように、左センサユニット104は、キャビン10の左側下方に配置された左乗降ステップ41の底面に、小さい俯角を有する左下向き姿勢で取り付けられている。これにより、左センサユニット104は、トラクタ1の左外方側が検知範囲Nとなるように設定されている。左センサユニット104の検知範囲Nは、前後に並ぶ2つの第1超音波センサ104A,104Bの検知範囲Na,Nbを含む前後方向に広い範囲に設定されている。
図5に示すように、右センサユニット103は、キャビン10の右側下方に配置された右乗降ステップ41の底面に、小さい俯角を有する右下向き姿勢で取り付けられている。これにより、右センサユニット103は、トラクタ1の右外方側が検知範囲Nとなるように設定されている。右センサユニット103の検知範囲Nは、前後に並ぶ2つの第1超音波センサ103A,103Bの検知範囲Na,Nbを含む前後方向に広い範囲に設定されている。
図1及び図4に示すように、第2超音波センサ105は、トラクタ1における作業装置12よりも前方側に位置する前部フレーム27の底部27Aに、ボンネット8の前端よりも後方側で左右の前輪5の間に位置するように取り付けられている。これにより、第2超音波センサ105の検知範囲Mは、左右の前輪5の間において前部フレーム27の底部27Aから下向きに設定されている。
As shown in FIGS. 1 and 4 to 6, the
As shown in FIG. 5, the
As shown in FIGS. 1 and 4, the second
各ライダーセンサ(LiDAR Sensor:Light Detection and Ranging Sensor)101,102は、レーザ光(例えば、パルス状の近赤外レーザ光)が測定対象物に当たって跳ね返ってくるまでの往復時間から測定対象物までの距離を測定するTOF(Time Of Flight)方式により、測定対象物までの距離を測定する。各ライダーセンサ101,102は、レーザ光を上下方向及び左右方向に高速で走査し、各走査角における測定対象物までの距離を順次測定することで、測定対象物までの距離を3次元で測定する。各ライダーセンサ101,102は、測定範囲内における測定対象物までの距離をリアルタイムで繰り返し測定する。各ライダーセンサ101,102は、測定結果から3次元画像を生成して車載電子制御ユニット18に出力する。各ライダーセンサ101,102からの3次元画像は、トラクタ1の表示部や携帯通信端末3の表示部51等の表示装置に表示させることができ、これにより、ユーザ等にトラクタ1の前方側の状況と後方側の状況とを視認させることができる。ちなみに、3次元画像では、例えば、色等を用いて遠近方向での距離を示すことができる。
Each lidar sensor (LiDAR Sensor: Light Detection and Ranging Sensor) 101, 102 has a round-trip time from the round-trip time until the laser beam (for example, pulsed near-infrared laser beam) hits the measurement object and bounces off to the measurement object. The distance to the object to be measured is measured by the TOF (Time Of Flight) method for measuring the distance. The
図1、図4及び図5に示すように、前ライダーセンサ101は、キャビン10のルーフ35における前端部の左右中央部位に、トラクタ1の前方側を斜め上方側から見下ろす前下がり姿勢で配置されている。これにより、前ライダーセンサ101は、トラクタ1の前方側が測定範囲Cとなるように設定されている。後ライダーセンサ102は、キャビン10のルーフ35における後端部の左右中央部位に、トラクタ1の後方側を斜め上方側から見下ろす後下がり姿勢で配置されている。これにより、後ライダーセンサ102は、トラクタ1の後方側が測定範囲Dとなるように設定されている。
ちなみに、各ライダーセンサ101,102の測定範囲C,Dに関しては、それらの左右方向の範囲を作業装置12の作業幅に応じた設定範囲に制限するカット処理を施すようにしてもよい。
As shown in FIGS. 1, 4 and 5, the
Incidentally, regarding the measurement ranges C and D of the
図2に示すように、地図データ処理部106及び接触回避制御部107は、車載電子制御ユニット18に備えられている。車載電子制御ユニット18は、コモンレールシステムに含まれたエンジン用の電子制御ユニット、各ライダーセンサ101,102、及び、各センサユニット103,104等にCAN(Controller Area Network)を介して通信可能に接続されている。
As shown in FIG. 2, the map
トラクタ1には、図1、図2及び図4に示すように、走行機体7の前方側を撮像範囲とする前カメラ108と、走行機体7の後方側を撮像範囲とする後カメラ109とが備えられている。前カメラ108は、前ライダーセンサ101と同様に、キャビン10のルーフ35における前端部の左右中央部位に、トラクタ1の前方側を斜め上方側から見下ろす前下がり姿勢で配置されている。後カメラ109は、後ライダーセンサ102と同様に、キャビン10のルーフ35における後端部の左右中央部位に、トラクタ1の後方側を斜め上方側から見下ろす後下がり姿勢で配置されている。前カメラ108及び後カメラ109の撮像画像は、トラクタ1の表示部や携帯通信端末3の表示部51等の表示装置に表示させることができ、これにより、ユーザ等にトラクタ1の周囲の状況を視認させることができる。
As shown in FIGS. 1, 2 and 4, the
図2〜5に示すように、地図データ処理部106は、測位ユニット21からの測位情報と左右のセンサユニット103,104からの検知情報とに基づいて、左右のセンサユニット103,104が障害物Zを検知するごとに、検知した障害物Zをリアルタイムで地図データに登録して地図データを更新する地図データ更新処理を行う。接触回避制御部107は、更新後の地図データや測位ユニット21からの測位情報等に基づいて前述した接触回避制御をリアルタイムで行う。
As shown in FIGS. 2 to 5, in the map
図7に示すフローチャートに基づいて、地図データ更新処理での地図データ処理部106の制御作動について説明する。
地図データ処理部106は、左右のセンサユニット103,104からの検知情報を監視して、左右いずれかのセンサユニット103,104がマンホール等の障害物Zを検知したか否かを判定する障害物存否判定処理を行う(ステップ#1)。
地図データ処理部106は、障害物存否判定処理において障害物Zを検知したと判定した場合に、車体データに含まれている障害物Zを検知したセンサユニット103,104の位置情報(トラクタ1に対するセンサユニット103,104の取り付け位置)と、そのセンサユニット103,104からの検知情報に含まれているセンサユニット103,104から障害物Zまでの距離情報と、測位ユニット21からの測位情報に含まれているトラクタ1の位置情報とに基づいて、作業地Sにおける障害物Zの位置情報を取得する障害物位置情報取得処理を行う(ステップ#2)。
次に、地図データ処理部106は、取得した障害物Zの位置情報から障害物Zを地図データに登録して地図データを更新する地図データ更新処理を行う(ステップ#3)。
又、地図データ処理部106は、取得した障害物Zの位置情報を端末電子制御ユニット52に送信し、端末記憶部54に記憶された地図データの更新を端末電子制御ユニット52に指令する地図データ更新指令処理と、更新後の地図データを携帯通信端末3の表示部51に表示させて、携帯通信端末3を所持する管理者等にマンホール等の障害物Zの存在位置を知らせる障害物用報知処理とを行い(ステップ#4,#5)、その後ステップ#1に戻る。
Based on the flowchart shown in FIG. 7, the control operation of the map
The map
When the map
Next, the map
Further, the map
つまり、例えば、図3〜5に示すようなマンホール等の障害物Zが存在する作業地Sにおいて、自動走行中のトラクタ1が、その左側方に存在する障害物Zの横側方を通過するときには、その障害物Zを左側のセンサユニット104が検知し、この検知に基づいて、地図データ処理部106が前述した障害物位置情報取得処理と地図データ更新処理とを行うことにより、接触回避制御部107は、更新後の地図データと測位ユニット21からの測位情報とに基づいて、トラクタ1が障害物Zの横側方を通過した時点において、その障害物Zが作業地Sのどの位置に存在するかを認知することができる。これにより、接触回避制御部107は、接触回避制御に基づく適切な接触回避用の各処理を余裕をもって行うことができる。
That is, for example, in the work area S where an obstacle Z such as a manhole as shown in FIGS. 3 to 5 exists, the automatically traveling
図8〜10に示すフローチャートに基づいて、接触回避制御での接触回避制御部107の制御作動について説明する。
図8に示すように、接触回避制御部107は、先ず、更新後の地図データと測位ユニット21からの測位情報とに基づいて、トラクタ1が障害物Zの存在位置から設定距離だけ手前の減速位置Pa(図3参照)に達したか否かを判定する減速位置到達判定処理を行う(ステップ#10)。
接触回避制御部107は、減速位置到達判定処理においてトラクタ1が減速位置Paに達していない間は、車速を接触回避用の設定速度まで低下させる減速処理を保留し、トラクタ1が減速位置Paに達するのに伴って減速処理を行う(ステップ#11)。
又、接触回避制御部107は、トレッド(輪距)等を含む車体データと更新後の地図データと測位ユニット21からの測位情報とに基づいて、トラクタ1の左右の前輪5及び左右の後輪6が地図データに登録された障害物Zに乗り上げるか否かを判定する乗り上げ判定処理を行う(ステップ#12)。
接触回避制御部107は、乗り上げ判定処理において乗り上げないと判定した場合は、第2超音波センサ105からの検知情報に基づいて障害物Zの高さを検知して昇降駆動機構17の作動を制御する第1接触回避処理を行い(ステップ#13)、乗り上げると判定した場合は、前ライダーセンサ101からの測定情報に基づいて障害物Zの高さを検知して昇降駆動機構17の作動を制御する第2接触回避処理を行う(ステップ#14)。
そして、接触回避制御部107は、第1接触回避処理又は第2接触回避処理が終了すると、車速を減速処理が行われる前の元の車速まで上昇させる車速復帰処理を行い(ステップ#15)、その後ステップ#10に戻る。
Based on the flowchart shown in FIGS. 8 to 10, the control operation of the contact
As shown in FIG. 8, the contact
The contact
Further, the contact
When the contact
Then, when the first contact avoidance process or the second contact avoidance process is completed, the contact
図9に示すように、第1接触回避処理において、接触回避制御部107は、先ず、第2超音波センサ105が障害物Zの上方に達したときに得られる第2超音波センサ105からの検知情報に基づいて障害物Zの高さを検知する第1高さ検知処理を行う(ステップ#20)。
そして、接触回避制御部107は、検知した障害物Zの高さに適した作業装置12の最小限の接触回避高さを設定する第1回避高さ設定処理と、昇降駆動機構17の作動を制御して作業装置12を接触回避高さまで上昇させる第1回避上昇処理とを行う(ステップ#21,#22)。
その後、接触回避制御部107は、車体データと更新後の地図データと測位ユニット21からの測位情報とに基づいて、作業装置12が障害物Zの上方を通過したか否かを判定する第1通過判定処理を行う(ステップ#23)。
そして、接触回避制御部107は、第1通過判定処理において作業装置12が障害物Zの上方を通過していない間は、作業装置12を接触回避高さに維持する第1回避高さ維持処理を行い(ステップ#24)、作業装置12が障害物Zの上方を通過するのに伴って、作業装置12を第1回避上昇処理が行われる前の元の作業高さ位置まで下降させる作業高さ復帰処理を行う(ステップ#25)。
その後、第1接触回避処理を終了してステップ#15に移る。
As shown in FIG. 9, in the first contact avoidance process, the contact
Then, the contact
After that, the contact
Then, the contact
After that, the first contact avoidance process is completed and the process proceeds to step # 15.
図10に示すように、第2接触回避処理において、接触回避制御部107は、先ず、左右の前輪5が障害物Zに乗り上げることで前ライダーセンサ101からの測定情報が変化したときに、そのときの前ライダーセンサ101からの測定情報の変化に基づいて障害物Zの高さを検知する第2高さ検知処理を行う(ステップ#30)。ちなみに、接触回避制御部107は、左右両方の前輪5が障害物Zに乗り上げた場合は、そのときの前ライダーセンサ101からの測定情報の高低差に基づいて障害物Zの高さを検知する。又、接触回避制御部107は、左右いずれか一方の前輪5が障害物Zに乗り上げた場合は、そのときの前ライダーセンサ101からの測定情報の傾き具合に基づいて障害物Zの高さを検知する。
そして、接触回避制御部107は、検知した障害物Zの高さに適した作業装置12の最小限の接触回避高さを設定する第2回避高さ設定処理と、昇降駆動機構17の作動を制御して作業装置12を接触回避高さまで上昇させる第2回避上昇処理とを行う(ステップ#31,#32)。
その後、接触回避制御部107は、車体データと更新後の地図データと測位ユニット21からの測位情報とに基づいて、作業装置12が障害物Zの上方を通過したか否かを判定する第2通過判定処理を行う(ステップ#33)。
そして、接触回避制御部107は、第2通過判定処理において作業装置12が障害物Zの上方を通過していない間は、作業装置12を接触回避高さに維持する第2回避高さ維持処理を行い(ステップ#34)、作業装置12が障害物Zの上方を通過するのに伴って、作業装置12を第2回避上昇処理が行われる前の元の作業高さ位置まで下降させる作業高さ復帰処理を行う(ステップ#35)。
その後、第2接触回避処理を終了してステップ#15に移る。
As shown in FIG. 10, in the second contact avoidance process, the contact
Then, the contact
After that, the contact
Then, the contact
After that, the second contact avoidance process is completed and the process proceeds to step # 15.
上記の制御作動により、接触回避制御部107は、左右の前輪5が障害物Zに乗り上げないことで第2超音波センサ105による障害物Zの高さ検知が可能になる場合と、左右の前輪5が障害物Zに乗り上げることで第2超音波センサ105による障害物Zの高さ検知が不可能になる場合とにかかわらず、作業装置12による作業(例えば草刈り作業)を継続しながら、作業装置12が障害物Zに接触する虞を回避することができる。
又、作業装置12と障害物Zとの接触回避のために、障害物Zの周辺での作業装置12による作業精度の低下が生じる(例えば、草刈装置であれば刈り高さが高くなる)場合には、前述した障害物用報知処理により、携帯通信端末3を所持する管理者等は、その作業精度の低下を容易に予測することができ、作業精度の低下に対する適切な補助作業(例えば手刈り作業)を迅速に行える。
その上、前述した減速処理により、トラクタ1が減速位置Paに達するまでの車速を速くすることができる。その結果、作業効率の向上を図りながら作業装置12が障害物Zに接触する虞を回避することができる。
By the above control operation, the contact
Further, in order to avoid contact between the
Moreover, the deceleration process described above can increase the vehicle speed until the
〔別実施形態〕
本発明の他の実施形態について説明する。
尚、以下に説明する各実施形態の構成は、それぞれ単独で適用することに限らず、他の実施形態の構成と組み合わせて適用することも可能である。
[Another Embodiment]
Other embodiments of the present invention will be described.
It should be noted that the configurations of the respective embodiments described below are not limited to being applied independently, but can also be applied in combination with the configurations of other embodiments.
(1)作業車両1の構成に関する代表的な別実施形態は以下の通りである。
例えば、作業車両1は、後側の走行部として、左右の後輪6に代えて左右のクローラを備えるセミクローラ仕様に構成されていてもよい。
例えば、作業車両1は、走行部として、左右の前輪5及び左右の後輪6に代えて左右のクローラを備えるフルクローラ仕様に構成されていてもよい。
例えば、作業車両1は、エンジン9の代わりに電動モータを備える電動仕様に構成されていてもよい。
例えば、作業車両1は、エンジン9と電動モータとを備えるハイブリッド仕様に構成されていてもよい。
例えば、作業車両1は、左右の後輪6が操舵輪として機能する後輪ステアリング仕様に構成されていてもよい。
例えば、作業車両1は、自動走行システムを利用して複数の作業車両1を併走させて作業を行うように構成されていてもよい。
例えば、作業車両1は、キャビン10に代えて、走行機体7から搭乗空間の上方に延びる保護フレームを備えるように構成されていてもよい。
例えば、作業車両1は、左右の前輪5と左右の後輪6との間に作業装置12が昇降可能に備えられたミッドマウント仕様に構成されていてもよい。
(1) Another typical embodiment regarding the configuration of the
For example, the
For example, the
For example, the
For example, the
For example, the
For example, the
For example, the
For example, the
(2)接触回避制御部107に関する代表的な別実施形態は以下の通りである。
例えば、接触回避制御部107は、接触回避制御において、例えば、作業車両1が障害物Zの上方を通らないように目標走行経路Pの一部を補正する経路補正処理を行う構成であってもよい。そして、この構成においては、接触回避制御部107が、補正した目標走行経路Pの一部を端末電子制御ユニット52に送信し、端末記憶部54に記憶された目標走行経路Pの補正を端末電子制御ユニット52に指令する経路補正指令処理と、補正後の目標走行経路Pを携帯通信端末3の表示部51に表示させて、携帯通信端末3を所持する管理者等に補正後の目標走行経路Pを知らせる補正経路報知処理とを行うようにしてもよい。
例えば、接触回避制御部107は、作業車両1が左右の前輪5と左右の後輪6との間に作業装置12が昇降可能に備えられたミッドマウント仕様である場合は、第2超音波センサ105又はライダーセンサ101からの検知情報に基づいて、障害物Zの高さが作業装置12の上昇限界高さを超えることを検知したときに、作業車両1の走行を停止させる強制停止処理を行う構成であってもよい。
例えば、接触回避制御部107は、作業装置12がロータリ耕耘装置等の接地式である場合は、前述した第1回避高さ設定処理及び第2回避高さ設定処理を行わずに、第1回避上昇処理及び第2回避上昇処理において、予め設定された作業待機用の上昇位置まで作業装置12を上昇させる構成であってもよい。
例えば、接触回避制御部107は、乗り上げ判定処理にて走行部5,6が障害物Zに乗り上げると判定した場合に、後ライダーセンサ102からの測定情報に基づいて障害物Zの高さを検知して昇降駆動機構17の作動を制御する第2接触回避処理を行う構成であってもよい。
(2) Another typical embodiment of the contact
For example, in the contact avoidance control, the contact
For example, the contact
For example, when the
For example, the contact
(3)第1超音波センサ103A,103B,104A,104Bに関する代表的な別実施形態は以下の通りである。
例えば、第1超音波センサ103A,103B,104A,104Bは、作業車両1の左右両側部に1つずつ配置されていてもよく、又、作業車両1の左右両側部に3つ以上ずつ配置されていてもよい。
例えば、第1超音波センサ103A,103B,104A,104Bは、作業車両1の左右両側部において、前後方向に一定間隔をあけて配置されていてもよい。
(3) Typical alternative embodiments relating to the first
For example, the first
For example, the first
(4)第2超音波センサ105は、例えば、図11に示すように、走行部5,6が障害物Zに乗り上げる前の段階において障害物Zの高さを検知することができるように、走行部5,6よりも前方側の位置に配置されていてもよい。
(4) For example, as shown in FIG. 11, the second
1 作業車両
1A 底部
3 携帯通信端末
2 自動走行ユニット
5 走行部(前輪)
6 走行部(後輪)
12 作業装置
17 昇降駆動機構
21 測位ユニット
54 記憶部(端末記憶部)
101 ライダーセンサ
102 ライダーセンサ
103A 第1超音波センサ
103B 第1超音波センサ
104A 第1超音波センサ
104B 第1超音波センサ
105 第2超音波センサ
106 地図データ処理部
107 接触回避制御部
185 記憶部(車載記憶部)
C 測定範囲(ライダーセンサ)
D 測定範囲(ライダーセンサ)
M 検知範囲(第2超音波センサ)
Na 検知範囲(第1超音波センサ)
Nb 検知範囲(第1超音波センサ)
Pa 減速位置
S 作業地
Z 障害物
1
6 Running part (rear wheel)
12
101
C measurement range (rider sensor)
D Measurement range (rider sensor)
M detection range (second ultrasonic sensor)
Na detection range (1st ultrasonic sensor)
Nb detection range (1st ultrasonic sensor)
Pa Deceleration position S Work site Z Obstacle
Claims (5)
前記作業車両を自動走行させる自動走行ユニットと、
前記作業車両の横外方を検知範囲に含む障害物検知用の第1超音波センサと、
作業地を含む地図データが記憶された記憶部と、
前記測位ユニットからの測位情報と前記第1超音波センサからの検知情報とに基づいて、前記第1超音波センサが検知した障害物を前記地図データに登録して前記地図データを更新する地図データ処理部と、
更新後の前記地図データと前記測位ユニットからの測位情報とに基づいて、前記作業車両に装備された作業装置と前記障害物との接触を回避する接触回避制御を行う接触回避制御部と、
を有する作業車両用の自動走行システム。 A positioning unit that measures the current position of a work vehicle using a satellite positioning system,
An automatic traveling unit that automatically travels the work vehicle, and
The first ultrasonic sensor for detecting obstacles that includes the lateral outside of the work vehicle in the detection range, and
A storage unit that stores map data including the work area,
Map data that registers obstacles detected by the first ultrasonic sensor in the map data and updates the map data based on the positioning information from the positioning unit and the detection information from the first ultrasonic sensor. Processing unit and
A contact avoidance control unit that performs contact avoidance control for avoiding contact between the work device equipped on the work vehicle and the obstacle based on the updated map data and the positioning information from the positioning unit.
Automatic driving system for work vehicles with.
検知範囲が前記作業車両における前記作業装置よりも前方側の底部から下向きに設定された障害物検知用の第2超音波センサとを備え、
前記接触回避制御部は、前記接触回避制御において、更新後の前記地図データと前記測位ユニットからの測位情報とに基づいて、前記作業車両の走行部が前記地図データに登録された障害物に乗り上げるか否かを判定する乗り上げ判定処理と、前記乗り上げ判定処理にて乗り上げないと判定した場合に、前記第2超音波センサからの検知情報に基づいて前記障害物の高さを検知して前記昇降駆動機構の作動を制御する第1接触回避処理を行う請求項1に記載の作業車両用の自動走行システム。 An elevating drive mechanism that elevates and drives the work device,
It is equipped with a second ultrasonic sensor for obstacle detection whose detection range is set downward from the bottom on the front side of the work device in the work vehicle.
In the contact avoidance control, the contact avoidance control unit makes the traveling unit of the work vehicle ride on the obstacle registered in the map data based on the updated map data and the positioning information from the positioning unit. When it is determined by the ride-up determination process to determine whether or not the vehicle is on the vehicle and the ride-up determination process determines that the vehicle does not ride, the height of the obstacle is detected based on the detection information from the second ultrasonic sensor to move up and down. The automatic traveling system for a work vehicle according to claim 1, wherein the first contact avoidance process for controlling the operation of the drive mechanism is performed.
前記接触回避制御部は、前記乗り上げ判定処理にて乗り上げると判定した場合に、前記ライダーセンサからの測定情報に基づいて前記障害物の高さを検知して前記昇降駆動機構の作動を制御する第2接触回避処理を行う請求項2に記載の作業車両用の自動走行システム。 The front and rear sides of the work vehicle are equipped with a rider sensor set in the measurement range.
The contact avoidance control unit detects the height of the obstacle based on the measurement information from the rider sensor and controls the operation of the elevating drive mechanism when it is determined by the ride-up determination process. 2. The automatic traveling system for a work vehicle according to claim 2, which performs contact avoidance processing.
前記地図データ処理部は、前記携帯通信端末との通信により、更新後の地図データを前記携帯通信端末の表示部に表示させて前記障害物の存在位置を知らせる障害物用報知処理を行う請求項1〜4のいずれか一項に記載の作業車両用の自動走行システム。 A mobile communication terminal capable of communicating with the map data processing unit is provided.
The claim that the map data processing unit performs obstacle notification processing for notifying the existence position of the obstacle by displaying the updated map data on the display unit of the mobile communication terminal by communicating with the mobile communication terminal. The automatic traveling system for a work vehicle according to any one of 1 to 4.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018064549A JP6837449B2 (en) | 2018-03-29 | 2018-03-29 | Automatic driving system for work vehicles |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018064549A JP6837449B2 (en) | 2018-03-29 | 2018-03-29 | Automatic driving system for work vehicles |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2021017536A Division JP7247240B2 (en) | 2021-02-05 | 2021-02-05 | Automated driving system for work vehicles |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2019170312A JP2019170312A (en) | 2019-10-10 |
JP6837449B2 true JP6837449B2 (en) | 2021-03-03 |
Family
ID=68166249
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2018064549A Active JP6837449B2 (en) | 2018-03-29 | 2018-03-29 | Automatic driving system for work vehicles |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6837449B2 (en) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7220358B2 (en) * | 2018-12-21 | 2023-02-10 | 株式会社タダノ | work vehicle |
JP7272241B2 (en) | 2019-11-18 | 2023-05-12 | トヨタ自動車株式会社 | Vehicle travel control device and vehicle control system |
CN113068501A (en) * | 2020-01-06 | 2021-07-06 | 苏州宝时得电动工具有限公司 | Intelligent mower |
JPWO2022107587A1 (en) * | 2020-11-18 | 2022-05-27 | ||
EP4250046A1 (en) * | 2020-11-18 | 2023-09-27 | Kubota Corporation | Moving body, control unit, data generation unit, method for controlling moving body motion, and method for generating data |
WO2022107586A1 (en) * | 2020-11-18 | 2022-05-27 | 株式会社クボタ | Moving body, control unit, and method for controlling operation of moving body |
CN114274873A (en) * | 2021-12-30 | 2022-04-05 | 上海电力大学 | Height limit detection device based on computer vision recognition and control method thereof |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5607205A (en) * | 1995-06-06 | 1997-03-04 | Caterpillar Inc. | Object responsive implement control system |
JP6266407B2 (en) * | 2014-03-28 | 2018-01-24 | ヤンマー株式会社 | Autonomous traveling work vehicle |
JP2016010372A (en) * | 2014-06-30 | 2016-01-21 | 井関農機株式会社 | Automatic control device of unmanned combine-harvester |
JP6267627B2 (en) * | 2014-11-13 | 2018-01-24 | ヤンマー株式会社 | Operation terminal |
JP6507109B2 (en) * | 2016-03-07 | 2019-04-24 | ヤンマー株式会社 | Running area shape registration system for work vehicle |
JP6656047B2 (en) * | 2016-03-29 | 2020-03-04 | ヤンマー株式会社 | Combine |
JP6701002B2 (en) * | 2016-06-23 | 2020-05-27 | 株式会社クボタ | Driving support system and work vehicle |
US20180077851A1 (en) * | 2016-09-16 | 2018-03-22 | Cnh Industrial America Llc | Obstacle detection warning system |
-
2018
- 2018-03-29 JP JP2018064549A patent/JP6837449B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP2019170312A (en) | 2019-10-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6837449B2 (en) | Automatic driving system for work vehicles | |
JP6926020B2 (en) | Obstacle detection system | |
US20210100156A1 (en) | Obstacle Detection System and Work Vehicle | |
JP7356829B2 (en) | automatic driving system | |
JP7064066B2 (en) | Automatic driving system for work vehicles | |
JP2019165665A (en) | Automatic travel system for work vehicle | |
US20210018617A1 (en) | Obstacle Detection System for Work Vehicle | |
KR20210107619A (en) | Obstacle detection system for work vehicles | |
WO2020137134A1 (en) | Collision avoidance system for work vehicle | |
JP2018116609A (en) | Work vehicle | |
JP2019170228A (en) | Automatic traveling device of work vehicle | |
JP6942664B2 (en) | Travel control system for work vehicles | |
JP2019168888A (en) | Obstacle detection system | |
JP6937263B2 (en) | Travel control system for work vehicles | |
JP6926021B2 (en) | Work vehicle | |
WO2019187938A1 (en) | Travel control system of work vehicle | |
JP2019170309A (en) | Work vehicle | |
JP6942666B2 (en) | Work vehicle | |
JP7059221B2 (en) | Control system for work vehicles | |
JP7247240B2 (en) | Automated driving system for work vehicles | |
JP7338958B2 (en) | Automated driving system for work vehicles | |
JP6923480B2 (en) | Obstacle detection system | |
JP7094337B2 (en) | Work vehicle | |
JP2022087244A (en) | Control system for work vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20200212 |
|
RD03 | Notification of appointment of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7423 Effective date: 20200814 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20210108 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20210202 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20210209 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6837449 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |