JP7070905B2 - Travel control device for traveling vehicles - Google Patents

Travel control device for traveling vehicles Download PDF

Info

Publication number
JP7070905B2
JP7070905B2 JP2018166531A JP2018166531A JP7070905B2 JP 7070905 B2 JP7070905 B2 JP 7070905B2 JP 2018166531 A JP2018166531 A JP 2018166531A JP 2018166531 A JP2018166531 A JP 2018166531A JP 7070905 B2 JP7070905 B2 JP 7070905B2
Authority
JP
Japan
Prior art keywords
traveling
traveling vehicle
control unit
angle
vehicle
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
JP2018166531A
Other languages
Japanese (ja)
Other versions
JP2020036569A (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.)
MINORU SANGYO KABUSHIKI KAISHA
Original Assignee
MINORU SANGYO KABUSHIKI KAISHA
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by MINORU SANGYO KABUSHIKI KAISHA filed Critical MINORU SANGYO KABUSHIKI KAISHA
Priority to JP2018166531A priority Critical patent/JP7070905B2/en
Publication of JP2020036569A publication Critical patent/JP2020036569A/en
Application granted granted Critical
Publication of JP7070905B2 publication Critical patent/JP7070905B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Guiding Agricultural Machines (AREA)
  • Lifting Devices For Agricultural Implements (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Description

本発明は、車両幅が条間より狭く構成されており条間を走行するように構成されていたり、少数の苗列を跨いで走行するように構成されていたりするような小型の走行車両の走行制御装置に関するものである。 INDUSTRIAL APPLICABILITY The present invention is for a small traveling vehicle in which the vehicle width is narrower than that of the inter-rows and is configured to travel between the inter-rows, or is configured to travel across a small number of seedling rows. It relates to a travel control device.

本発明の第一の背景技術としては、特許文献1に記載された田植機を例示する。この田植機は、走行機体の前方の既植苗列を撮影する第1カメラ、後方の既植苗列と移植直後の苗列とを同時に撮影する第2カメラ夫々を備え、第1カメラで撮影された既植苗列を表示する第1ディスプレイの表示面の目標位置と表示される既植苗列とで走行機体と既植苗列との位置関係を判定可能に構成し、第2カメラで撮影された既植苗列と移植直後の苗列とを表示するディスプレイの表示によって既植苗列と、移植直後の苗列との位置関係を判定可能に構成する。 As the first background technique of the present invention, the rice transplanter described in Patent Document 1 is exemplified. This rice planting machine is equipped with a first camera that captures the row of seedlings that have been planted in front of the traveling aircraft, and a second camera that simultaneously captures the row of seedlings that have been planted behind and the row of seedlings immediately after transplantation. The target position on the display surface of the first display that displays the pre-planted seedling row and the displayed pre-planted seedling row are configured so that the positional relationship between the traveling machine and the pre-planted seedling row can be determined, and the pre-planted seedling photographed by the second camera is configured. The positional relationship between the pre-planted seedling row and the seedling row immediately after transplantation can be determined by displaying the row and the seedling row immediately after transplantation.

また、本発明の第二の背景技術としては、特許文献2に記載された走行制御装置を例示する。この走行制御装置では、画像処理部は、車両走行中に撮像部により異なる位置で撮像した複数の撮像画像を処理し、車両走行の目標となる目標追従ラインを導出する。走行制御部は、目標追従ラインに沿って走行するように車両の走行を制御する。画像処理部の基準領域設定部は、撮像画像において複数の画素値から構成されて直線状に並ぶ複数の基準領域を設定する。基準領域追跡部は、基準領域が設定された撮像画像とは異なる位置で新たに撮像された撮像画像において基準領域と実空間上で同じ領域であると判定された参照領域の撮像画像上の位置情報を算出する。凹凸検出部は、参照領域の複数の位置情報にもとづいて実空間上の地面の凹凸を検出する。目標追従ライン生成部は、検出された凹凸にもとづいて目標追従ラインを生成する。 Further, as the second background technique of the present invention, the traveling control device described in Patent Document 2 is exemplified. In this travel control device, the image processing unit processes a plurality of captured images captured at different positions by the image pickup unit while the vehicle is traveling, and derives a target tracking line that is a target of vehicle travel. The travel control unit controls the travel of the vehicle so as to travel along the target follow-up line. The reference area setting unit of the image processing unit sets a plurality of reference areas composed of a plurality of pixel values in the captured image and arranged in a straight line. The reference area tracking unit is a position on the captured image of the reference region determined to be the same region in real space as the reference region in the newly captured image captured at a position different from the captured image in which the reference region is set. Calculate the information. The unevenness detecting unit detects the unevenness of the ground in the real space based on a plurality of position information of the reference area. The target tracking line generation unit generates a target tracking line based on the detected unevenness.

特開平9-154313号公報Japanese Unexamined Patent Publication No. 9-154313 特開2013-201958号公報Japanese Unexamined Patent Publication No. 2013-201958

特許文献1の田植機や特許文献2の走行制御装置が搭載される車両は、いずれも大型な乗用型車両であるため、カメラを圃場面から上方に高く離れた高所に設置できるので、一定の俯角で苗列を構成する多数の苗を上から見下ろして撮影することができる。しかしながら、車両幅が条間より狭く構成されており条間を走行するように構成されていたり、少数の苗列を跨いで走行するように構成されていたりするような小型の走行車両では、前記乗用型車両のようにカメラを高所に設置すると重心が高くなり走行時や強風時等の機体の安定性を損なうため、カメラをそのような高所に設置することができない。そして、圃場面から低所に設置されたカメラによれば一定の俯角のもとでは少数の苗しか撮影できない。そのため、苗列の途中に欠株が存在していると、苗列を見失ってしまうことがあるという課題がある。仮にそのような低所にあるカメラの俯角を小さく設定すると多数の苗が撮影可能になるが、その反面、各苗の上端の抽出が困難になり、特に、苗列が曲がっている場合に苗列が抽出できなくなってしまうという課題が生じる。 Since the rice transplanter of Patent Document 1 and the vehicle equipped with the travel control device of Patent Document 2 are both large passenger-type vehicles, the camera can be installed at a high place high above the field scene, so that it is constant. It is possible to take a picture of a large number of seedlings that make up a row of seedlings from the depression angle. However, in a small traveling vehicle in which the vehicle width is narrower than the inter-row space and is configured to travel between the inter-row spaces, or is configured to travel across a small number of seedling rows, the above-mentioned If the camera is installed in a high place like a passenger-type vehicle, the center of gravity becomes high and the stability of the aircraft during running or strong wind is impaired, so that the camera cannot be installed in such a high place. And, according to the camera installed in the low place from the field scene, only a small number of seedlings can be photographed under a certain depression angle. Therefore, if there is a missing stock in the middle of the seedling line, there is a problem that the seedling line may be lost. If the depression angle of the camera in such a low place is set small, many seedlings can be photographed, but on the other hand, it becomes difficult to extract the upper end of each seedling, especially when the seedling row is bent. The problem arises that columns cannot be extracted.

また、特許文献1の田植機では、走行機体の前方を撮影する第1カメラと、後方を撮影する第2カメラとの2台のカメラを装備しているとともに、2台のカメラの画像を処理するために高性能な制御装置を用いる必要があり、コストがかかるという課題がある。 Further, the rice transplanter of Patent Document 1 is equipped with two cameras, a first camera for photographing the front of the traveling vehicle and a second camera for photographing the rear, and processes images of the two cameras. In order to do so, it is necessary to use a high-performance control device, and there is a problem that it is costly.

さらに、特許文献2の走行制御装置では、目標追従ラインの導出のために、車両走行中に撮像部により異なる位置で撮像した複数の撮像画像を処理しなければならないだけでなく、撮像画像において複数の画素値から構成されて直線状に並ぶ複数の基準領域を設定する処理、新たに撮像された撮像画像において基準領域と実空間上で同じ領域であると判定された参照領域の撮像画像上の位置情報を算出することによって基準領域を追跡する処理、参照領域の複数の位置情報に基づいて実空間上の地面の凹凸を検出する処理、検出された凹凸に基づいて目標追従ラインを生成する処理等の多くの画像処理を含んでいるので、処理負荷が高く、高性能な制御装置を用いる必要があり、コストがかかるという課題がある。 Further, in the traveling control device of Patent Document 2, not only a plurality of captured images captured at different positions by the imaging unit while the vehicle is traveling must be processed in order to derive a target tracking line, but also a plurality of captured images are captured. The process of setting a plurality of reference regions that are composed of the pixel values of the above and are arranged in a straight line. Processing to track the reference area by calculating the position information, processing to detect the unevenness of the ground in the real space based on multiple position information of the reference area, processing to generate the target tracking line based on the detected unevenness. Since it includes a lot of image processing such as, there is a problem that the processing load is high, it is necessary to use a high-performance control device, and it is costly.

前記課題を解決するために、第1の発明の走行車両の走行制御装置は、
栽培エリア内に条植えされた作物の苗列に沿って走行する走行動作と、該走行動作後に次の走行動作の対象とする苗列の先端に向けて旋回する旋回動作とを行うように構成された走行車両の走行制御装置であって、
前記走行車両の旋回方向の現状角度を検出する旋回方向センサーと、
与えられる目標角度及び前記現状角度の角度差分が無くなるようにフィードバック制御を行い、その結果として前記走行車両の旋回方向を制御する姿勢制御信号を出力するように構成されており、さらに、前記走行車両の走行における一定距離間隔で前記現状角度を保存するとともに、定期的に、直前の所定回数分の該現状角度の平均値を算出するように構成されている姿勢制御部と、
前記走行車両の進行方向前方の苗列を撮像する撮像部と、
該撮像部により撮像した画像に基づいて前記苗列の存在を検出するとともに、該苗列に沿って走行するための目標旋回方向を検出し、それらの検出結果を出力する画像処理部と、
前記走行動作中に、前記画像処理部により前記苗列の存在及び前記目標旋回方向が検出されたときは、該目標旋回方向に基づく前記目標角度を前記姿勢制御部に与え、前記苗列の存在及び前記目標旋回方向が検出されなかったときは、前記姿勢制御部からの前記現状角度の平均値を前記走行動作における前記走行車両の進行方向を示す角度であり且つ該走行車両の現在位置における前記苗列の方向を示す角度であるものとして用いることによって得られる前記目標角度を前記姿勢制御部に与え、その結果として前記姿勢制御部から出力された前記姿勢制御信号に基づいて前記走行車両の旋回方向を制御するように構成されている走行制御部と
を備える
In order to solve the above-mentioned problems, the traveling control device for a traveling vehicle according to the first invention
It is configured to perform a traveling motion of traveling along a row of seedlings of crops planted in a cultivation area and a turning motion of turning toward the tip of the row of seedlings to be targeted for the next traveling motion after the traveling motion. It is a running control device for a running vehicle.
A turning direction sensor that detects the current angle of the turning direction of the traveling vehicle, and a turning direction sensor.
It is configured to perform feedback control so that the angle difference between the given target angle and the current angle is eliminated, and as a result, output an attitude control signal for controlling the turning direction of the traveling vehicle, and further, the traveling vehicle. An attitude control unit configured to store the current angle at regular distance intervals and periodically calculate the average value of the current angle for a predetermined number of times immediately before .
An image pickup unit that captures an image of a row of seedlings in front of the traveling vehicle in the traveling direction,
An image processing unit that detects the presence of the seedling row based on the image captured by the image pickup unit, detects a target turning direction for traveling along the seedling row, and outputs the detection results.
When the presence of the seedling row and the target turning direction are detected by the image processing unit during the traveling operation, the target angle based on the target turning direction is given to the attitude control unit, and the seedling row is given . When the presence of the vehicle and the target turning direction are not detected , the average value of the current angle from the attitude control unit is an angle indicating the traveling direction of the traveling vehicle in the traveling operation and the current position of the traveling vehicle. The target angle obtained by using the angle indicating the direction of the seedling row in the above is given to the attitude control unit, and as a result, the traveling vehicle is based on the attitude control signal output from the attitude control unit. With a travel control unit configured to control the turning direction of
To prepare for .

前記平均値としては、例えば、過去における直近の所定数の現状角度と、最新の現状角度との平均値(単純な平均値でもよいし、新しさに応じて重み付けを変更(例えば新しいほど重み付けを重く)した平均値でもよい。)を用いることを例示する。
この構成によれば、前記苗列に欠株が存在していることにより前記画像処理部による画像処理の結果、前記苗列の存在及び目標旋回方向が検出されなかったときでも、前記姿勢制御部による前記現状角度の平均値に基づいて前記走行車両の走行を制御するように構成されている。そのため、前記欠株があっても走行が停止せず、前記走行車両の安定した自律走行が実現できる。
As the average value, for example, the average value of the latest predetermined number of current angles in the past and the latest current angle (a simple average value may be used, or the weighting is changed according to the newness (for example, the newer the weighting). It may be an example of using a heavy) average value).
According to this configuration, even when the presence of the seedling row and the target turning direction are not detected as a result of image processing by the image processing unit due to the presence of the seedling row, the attitude control unit. It is configured to control the traveling of the traveling vehicle based on the average value of the current angle according to the above. Therefore, even if there is a stock shortage, the traveling does not stop, and stable autonomous traveling of the traveling vehicle can be realized.

また、この構成によれば、前記走行車両の進行方向又は前記苗列の方向として、保存された過去の前記現状角度と最新の現状角度との平均値を採用することにより、前記現状角度の一時的なぶれの影響を低減することができ、前記走行車両の安定した自律走行が実現できる。 Further, according to this configuration, by adopting the average value of the saved past current state angle and the latest current state angle as the traveling direction of the traveling vehicle or the direction of the seedling row, the current state angle is temporarily set. The influence of the target shake can be reduced, and stable autonomous driving of the traveling vehicle can be realized.

第2の発明の走行車両の走行制御装置としては、
前記第2の発明において、
前記走行制御部は、前記姿勢制御部で検出された前記現状角度の前記平均値を前記旋回動作の開始時の基準角度として用いる態様を例示する。
As a traveling control device for a traveling vehicle according to the second invention ,
In the second invention,
The traveling control unit exemplifies an embodiment in which the average value of the current angle detected by the attitude control unit is used as a reference angle at the start of the turning operation.

この構成によれば、前記苗列の終端部における湾曲に合わせて前記旋回動作を前記走行車両に行わせることができる。 According to this configuration, the traveling vehicle can be made to perform the turning operation in accordance with the bending at the end portion of the seedling row.

第3の発明の走行車両の走行制御装置としては、
前記第1~3のいずれかの発明において、
前記画像処理部は、前記苗列の存在位置と前記走行車両の中央との左右方向における位置ズレ量が所定量以上の場合に左右方向への前記目標旋回方向を出力するように構成されている態様を例示する。
As a traveling control device for a traveling vehicle according to the third invention ,
In any of the first to third inventions,
The image processing unit is configured to output the target turning direction in the left-right direction when the amount of positional deviation between the existing position of the seedling row and the center of the traveling vehicle in the left-right direction is a predetermined amount or more. An embodiment is illustrated.

この構成によれば、シンプルな画像処理で前記走行車両の走行制御を実現できる。 According to this configuration, it is possible to realize the traveling control of the traveling vehicle by simple image processing.

第4の発明の走行車両の走行制御装置としては、
前記第1~4のいずれかの発明において、
前記走行車両の走行距離を測定する走行距離検出部を備え、
前記走行制御部は、該走行距離に基づいて検出される前記苗列の先端及び終端付近において、前記走行車両の走行速度を低減させるように構成されている態様を例示する。
As a traveling control device for a traveling vehicle according to the fourth invention ,
In any of the first to fourth inventions,
A mileage detection unit that measures the mileage of the traveling vehicle is provided.
The travel control unit exemplifies an embodiment configured to reduce the travel speed of the traveling vehicle near the tip and end of the seedling row detected based on the travel distance.

この構成によれば、前記走行速度を低減させることにより、前記苗列の先端又は終端付近において、前記画像処理部に確実に苗列を認識させることができ、前記走行車両の安定した自律走行が実現できる。 According to this configuration, by reducing the traveling speed, the image processing unit can surely recognize the seedling row near the tip or the end of the seedling row, and the traveling vehicle can stably run autonomously. realizable.

第5の発明の走行車両の走行制御装置としては、
前記第5の発明において、
前記走行車両前方にある物体を検出する対物センサーを有し、該対物センサーにより栽培エリアの終端を検出する終端検出部を備え、
前記走行制御部は、該終端検出部により該終端を検出すると、前記走行車両に前記旋回動作をさせるように構成されている態様を例示する。
As the traveling control device for the traveling vehicle of the fifth invention ,
In the fifth invention,
It has an objective sensor that detects an object in front of the traveling vehicle, and has a termination detection unit that detects the end of the cultivation area by the objective sensor.
The travel control unit exemplifies an embodiment in which the traveling vehicle is configured to perform the turning operation when the termination is detected by the termination detecting unit.

この構成によれば、前記終端の撮像画像に対する画像処理のみにより該終端を検出する場合よりも、確実に終端を検出することができる。そのように画像処理のみにより前記終端を検出しようとすると、畦畔の上の雑草等を苗と誤検出して終端検出を失敗することがあるからであり、また、それを防止するために、畦畔を管理したり、畔波シートなどにより畦畔を安定した形状に保ったりする必要があるからである。 According to this configuration, the end can be detected more reliably than in the case where the end is detected only by image processing on the captured image of the end. This is because if we try to detect the end only by image processing, weeds on the ridge may be mistakenly detected as seedlings and the end detection may fail, and in order to prevent it, This is because it is necessary to manage the ridges and keep the ridges in a stable shape by using a shore wave sheet or the like.

第6の発明の走行車両の走行制御装置としては、
前記第6の発明において、
前記走行制御部は、前記苗列の先端から終端付近に至るまでの所定距離を走行したことが前記走行距離検出部によって検知されるまでは、前記終端検出部からの終端検出情報を無効化するように構成されている態様を例示する。
As the traveling control device for the traveling vehicle of the sixth invention ,
In the sixth invention,
The travel control unit invalidates the end detection information from the end detection unit until the travel distance detection unit detects that the vehicle has traveled a predetermined distance from the tip of the seedling row to the vicinity of the end. The embodiment configured as such is illustrated.

この構成によれば、前記苗列の終端付近以降のみ、前記終端検出部からの終端検出情報を利用することにより、それ以前における前記栽培エリアの終端の誤検出を排除することができる。 According to this configuration, by using the end detection information from the end detection unit only near the end of the seedling row, it is possible to eliminate erroneous detection of the end of the cultivation area before that.

本発明に係る走行車両の走行制御装置によれば、小型の走行車両の安定した自律走行が実現できるという優れた効果を奏する。 According to the traveling control device for a traveling vehicle according to the present invention, it is possible to realize stable autonomous traveling of a small traveling vehicle, which is an excellent effect.

本発明を具体化した一実施形態に係る走行制御装置を備えた走行車両を示す図であり、(a)は側面図、(b)は正面図である。It is a figure which shows the traveling vehicle which provided the traveling control device which concerns on one Embodiment which embodied this invention, (a) is a side view, (b) is a front view. 同走行制御装置の構成を示すブロック図である。It is a block diagram which shows the structure of the traveling control device. 同走行制御装置の姿勢制御部の機能を示すブロック図である。It is a block diagram which shows the function of the attitude control part of the traveling control device. 同姿勢制御装置の動作を示す平面図である。It is a top view which shows the operation of the same attitude control device. 同走行制御装置の画像処理部の画像処理例を示す図であり、(a)は苗列が走行車両の中心より右にずれている場合、(b)は苗列が同中心と一致している場合、(c)は苗列が同中心より左にずれている場合である。It is a figure which shows the image processing example of the image processing part of the traveling control device, (a) is the case where the seedling row is shifted to the right from the center of the traveling vehicle, (b) is the seedling row coincide with the same center. If so, (c) is the case where the seedling row is shifted to the left from the same center. 同画像処理部での検知結果に基づく走行制御装置による走行車両の制御例を示す図である。It is a figure which shows the control example of the traveling vehicle by the traveling control device based on the detection result in the image processing unit. 苗列の途中部における同走行制御装置による走行制御例を示す平面図である。It is a top view which shows the traveling control example by the same traveling control device in the middle part of a seedling row. 苗列の先端及び終端付近における同走行制御装置による走行制御例を示す平面図である。It is a top view which shows the running control example by the same running control device near the tip and the end of a seedling row. 苗列の終端検出に関する同走行制御装置による走行制御例を示す平面図である。It is a top view which shows the running control example by the same running control device about the end detection of a seedling row. 走行動作開始時に角度ズレしている場合の同走行制御装置による走行制御例を示す平面図である。It is a top view which shows the example of the running control by the same running control device when the angle is deviated at the start of running operation. 苗列の終端付近が湾曲している場合の同走行制御装置による走行制御例を示す平面図である。It is a top view which shows the example of the running control by the same running control device when the vicinity of the end of a seedling row is curved.

図1~図11は本発明を具体化した一実施形態の走行車両1及びその走行制御装置5を示している。 1 to 11 show a traveling vehicle 1 and a traveling control device 5 thereof according to an embodiment of the present invention.

本例の走行車両1は、図1に示すように、水田や畑等の圃場に植設された稲や野菜等の作物の苗列Nを跨ぐ門型に形成された機体フレーム2と、該機体フレーム2の両側部に設けられた一対の走行手段としてのクローラ3と、該各クローラ3にそれぞれ駆動力を供給する一対の駆動部4と、該一対の駆動部4を制御する走行制御装置5と、駆動部4及び走行制御装置5に電力を供給する電池6とを備えており、栽培エリア内に条植えされた作物の苗列Nに沿って走行する走行動作と、該走行動作後に次の走行動作の対象とする苗列Nの先端に向けて旋回する旋回動作とを自律的に繰り返し行うように構成されている。図1において矢印Fは機体前側を指し示している。 As shown in FIG. 1, the traveling vehicle 1 of this example includes a machine frame 2 formed in a gate shape straddling a seedling row N of crops such as rice and vegetables planted in a field such as a paddy field or a field. A crawler 3 as a pair of traveling means provided on both sides of the machine frame 2, a pair of driving units 4 for supplying driving force to each of the crawler 3, and a traveling control device for controlling the pair of driving units 4. 5 and a battery 6 for supplying electric power to the drive unit 4 and the travel control device 5 are provided, and the traveling operation of traveling along the seedling row N of the crops planted in the cultivation area and after the traveling operation. It is configured to autonomously and repeatedly perform a turning motion toward the tip of the seedling row N, which is the target of the next running motion. In FIG. 1, the arrow F points to the front side of the machine body.

本例の走行制御装置5は、図2に示すように、旋回方向センサー11、姿勢制御部12、撮像部13、画像処理部14、エンコーダー15、走行距離検出部16、対物センサー17、終端検出部18、及び走行制御部19を備えている。 As shown in FIG. 2, the travel control device 5 of this example includes a turning direction sensor 11, an attitude control unit 12, an image pickup unit 13, an image processing unit 14, an encoder 15, a mileage detection unit 16, an objective sensor 17, and a terminal detection. A unit 18 and a traveling control unit 19 are provided.

姿勢制御部12は、走行車両1の旋回方向(上下軸まわりの回転角度であるヨー角)の現状角度ωfを検出する旋回方向センサー11が接続されている。そして、図3及び図4に示すように、姿勢制御部12は、一定距離間隔で現状角度ωfを保存するとともに、定期的に、直前の所定回数分の現状角度ωfの平均値Ωを算出する。後述する走行制御部19は、それを走行動作における走行車両1の進行方向であって、走行車両1の現在位置における苗列Nの方向を示す角度として用いる。また、図3及び図4に示すように、姿勢制御部12は、走行制御部19から与えられた目標角度ωrefと、現状角度ωfとの角度差分ωeが無くなるようにフィードバック制御を行い、その結果を姿勢制御信号として出力するように構成されている。目標角度ωrefとしては、後述する走行制御部19により、走行動作時はΩが与えられ、旋回動作時は90°が2回与えられる。 The attitude control unit 12 is connected to a turning direction sensor 11 that detects the current angle ωf of the turning direction (yaw angle which is a rotation angle around the vertical axis) of the traveling vehicle 1. Then, as shown in FIGS. 3 and 4, the attitude control unit 12 stores the current angle ωf at regular distance intervals, and periodically calculates the average value Ω of the current angle ωf for a predetermined number of times immediately before. .. The travel control unit 19, which will be described later, uses it as an angle indicating the traveling direction of the traveling vehicle 1 in the traveling operation and the direction of the seedling row N at the current position of the traveling vehicle 1. Further, as shown in FIGS. 3 and 4, the attitude control unit 12 performs feedback control so that the angle difference ωe between the target angle ωref given by the travel control unit 19 and the current angle ωf disappears, and as a result. Is configured to be output as an attitude control signal. As the target angle ωref, Ω is given during the running operation and 90 ° is given twice during the turning operation by the traveling control unit 19 described later.

撮像部13は、走行車両1の進行方向前方の苗列Nを撮像するカメラを備えている。撮像部は、走行車両1の高所に一定の俯角で設置されている。本例の撮像部の撮影範囲は、該走行車両1の前方5~6mまでの範囲に設定されている。撮像部による撮影範囲はカメラの設置高さ、苗列Nを構成する苗の高さや間隔等に応じて適宜変更することができる。 The image pickup unit 13 includes a camera that images the seedling row N in front of the traveling vehicle 1 in the traveling direction. The image pickup unit is installed at a high place of the traveling vehicle 1 at a constant depression angle. The shooting range of the imaging unit of this example is set to a range of 5 to 6 m in front of the traveling vehicle 1. The shooting range by the imaging unit can be appropriately changed according to the installation height of the camera, the height and spacing of the seedlings constituting the seedling row N, and the like.

画像処理部14は、該撮像部13が接続されており、該撮像部13により撮像した画像に基づいて苗列Nに沿って走行するための目標旋回方向を検出する。本例の画像処理部14は、苗列Nと走行車両1の中央との左右方向における位置ズレ量を検出し、それに基づいて目標旋回方向を決定するように構成されている。具体的には、植物は赤外光の反射率が高いことから、撮像画像から赤外光を抽出し(図5における各画像の上段参照)、苗列Nを撮像画像上で縦方向に延びる赤外光の線形状であるものとし、撮像画像の横方向における一定範囲ごとに縦方向の赤外光の積算値を求め(図5における各画像の下段参照)、その積算値が最大となる横方向の位置Pに苗列Nが存在していると判定し、機体フレーム2の中心位置C(図5における各画像の中段参照)とのズレに応じて目標旋回方向を出力するように構成されている。具体的には、図6に示すように、その苗列Nの存在位置Pと、機体フレーム2の中心位置Cとが右又は左方向に所定の閾値以上ずれているときは、該右又は左方向への旋回するように目標旋回方向を出力し、該閾値未満のずれのときは、直進するように目標旋回方向を出力するように構成されている。赤外光の積算値が所定の閾値未満であるときは、撮影範囲内の苗列Nに欠株が発生していると判定し、それが検知されたことを出力する。 The image processing unit 14 is connected to the image pickup unit 13, and detects a target turning direction for traveling along the seedling row N based on the image captured by the image pickup unit 13. The image processing unit 14 of this example is configured to detect the amount of positional deviation between the seedling row N and the center of the traveling vehicle 1 in the left-right direction, and determine the target turning direction based on the amount of the positional deviation. Specifically, since plants have high reflectance of infrared light, infrared light is extracted from the captured image (see the upper part of each image in FIG. 5), and the seedling row N extends in the vertical direction on the captured image. Assuming that it has a linear shape of infrared light, the integrated value of vertical infrared light is obtained for each fixed range in the horizontal direction of the captured image (see the lower part of each image in FIG. 5), and the integrated value becomes the maximum. It is determined that the seedling row N exists at the position P in the lateral direction, and the target turning direction is output according to the deviation from the center position C of the aircraft frame 2 (see the middle stage of each image in FIG. 5). Has been done. Specifically, as shown in FIG. 6, when the existence position P of the seedling row N and the center position C of the aircraft frame 2 deviate from each other by a predetermined threshold value or more in the right or left direction, the right or left The target turning direction is output so as to turn in the direction, and the target turning direction is output so as to go straight when the deviation is less than the threshold value. When the integrated value of infrared light is less than a predetermined threshold value, it is determined that a stock shortage has occurred in the seedling row N within the imaging range, and it is output that it is detected.

走行距離検出部16は、クローラ3の駆動軸の回転を検出するエンコーダー15が接続されており、該エンコーダー15で検出した回転に基づいて走行車両1の走行距離を測定するように構成されている。 The mileage detection unit 16 is connected to an encoder 15 that detects the rotation of the drive shaft of the crawler 3, and is configured to measure the mileage of the traveling vehicle 1 based on the rotation detected by the encoder 15. ..

終端検出部18は、走行車両1前方にある物体を検出する対物センサー17が接続されており、該対物センサー17により栽培エリアの終端にある物理的な境界(畦畔、壁、柵、ビニールハウスの端等)又は該終端に設置された境界を示す境界物Eを検出する。対物センサー17としては特に限定されないが、境界物Eを非接触で検出する超音波センサー、TOF(Time of Flight)センサーを採用することを例示するが、接触式センサーを採用することもできる。また、本例では、対物センサー17の取付角度と高さは、境界物Eに応じて調節可能に構成されている。 An objective sensor 17 for detecting an object in front of the traveling vehicle 1 is connected to the terminal detection unit 18, and the physical boundary (ridge, wall, fence, vinyl house) at the end of the cultivation area is connected by the objective sensor 17. Detects a boundary object E indicating a boundary installed at the end, etc.) or at the end. The objective sensor 17 is not particularly limited, but an ultrasonic sensor that detects a boundary object E in a non-contact manner and a TOF (Time of Flight) sensor are exemplified, but a contact type sensor can also be adopted. Further, in this example, the mounting angle and height of the objective sensor 17 are configured to be adjustable according to the boundary object E.

走行制御部19は、姿勢制御部12での制御結果及び画像処理部14での画像処理結果に基づいて走行車両1の走行を制御し、走行車両1に走行動作、終端検出、及び旋回動作を行わせるように構成されている。 The travel control unit 19 controls the travel of the traveling vehicle 1 based on the control result of the attitude control unit 12 and the image processing result of the image processing unit 14, and causes the traveling vehicle 1 to perform a traveling operation, a terminal detection, and a turning operation. It is configured to do.

走行動作に関する走行制御部19の動作について説明すると、図7に示すように、走行制御部19は、画像処理部14により欠株の発生が検知されていないときは、該画像処理部14から出力される右又は左方向への旋回指示に応じて走行車両1の走行を制御し、同欠株の発生が検知されているときは、姿勢制御部12により検出された走行車両1の進行方向Ωを目標角度ωrefとして姿勢制御部12に与え、その結果、姿勢制御部12から出力された姿勢制御信号に基づいて走行車両1の走行を制御するように構成されている。画像処理部14から出力される右又は左方向への旋回指示に対する具体的な走行制御としては、特に限定されないが、本例では、図6に示すように、旋回方向側のクローラ3の駆動速度を減速することにより実現しているが、これに限定されず、例えば走行手段が操舵装置により進行方向を変更するように構成されているときは操舵装置を制御することにより実現することができる。 Explaining the operation of the traveling control unit 19 regarding the traveling operation, as shown in FIG. 7, the traveling control unit 19 outputs from the image processing unit 14 when the occurrence of stock shortage is not detected by the image processing unit 14. The running of the traveling vehicle 1 is controlled according to the right or left turning instruction, and when the occurrence of the same missing stock is detected, the traveling direction Ω of the traveling vehicle 1 detected by the attitude control unit 12. Is given to the attitude control unit 12 as a target angle ωref, and as a result, the traveling of the traveling vehicle 1 is controlled based on the attitude control signal output from the attitude control unit 12. The specific travel control for the right or left turning instruction output from the image processing unit 14 is not particularly limited, but in this example, as shown in FIG. 6, the driving speed of the crawler 3 on the turning direction side is not particularly limited. However, the speed is not limited to this, and for example, when the traveling means is configured to change the traveling direction by the steering device, it can be realized by controlling the steering device.

また、走行制御部19は、図8に示すように、該走行距離に基づいて検出される苗列Nの先端及び終端付近において、走行車両1の走行速度を低減させるように構成されている。その理由は、苗列Nでは、その一部で、苗の植付不良や生育不良等により株が欠損する欠株が発生することがあるが、苗列Nの先端又は終端の付近で欠株が発生した場合、赤外光の積算値が小さくなり、通常の走行速度では欠株により断続した苗列Nの画像処理が行えないため直進走行を継続できず、列に対して斜めに走行したり、停止したり、隣の列に移行したりすることがあるためである。そこで、走行速度を通常よりも低減させることにより、苗列Nを確実に認識させて、画像処理の精度を上げるようにしているのである。苗列Nの強度が全体的に小さい場合は、苗列Nの先端及び終端付近における減速区間を長くし、走行速度を低く低減させるように調整し、同強度が全体的に大きい場合はその逆に調整することが好ましい。減速の程度としては、特に限定されないが、10~50%の範囲で低減させることを例示し、具体的には40%低減させることを例示する。苗列Nの先端及び終端付近において速度を低減させる区間の長さは、撮像部13の撮影範囲や、苗列Nの全長等に応じて適宜変更することが好ましい。本例では、撮像部13の撮影範囲を基準に、先端及び終端の区間の長さをそれぞれ5~10mの範囲で設定することを例示し、具体的には5mに設定することを例示する。苗列Nの全長が短い(例えば20m以下)場合は、全体の速度低減防止のため、先端及び終端の区間の長さを前記全長の約5%に設定することを例示する。 Further, as shown in FIG. 8, the traveling control unit 19 is configured to reduce the traveling speed of the traveling vehicle 1 in the vicinity of the tip and the end of the seedling row N detected based on the traveling distance. The reason is that in the seedling row N, there may be a shortage of strains due to poor planting or growth of seedlings, but there is a shortage near the tip or end of the seedling row N. When This is because it may stop, stop, or move to the next row. Therefore, by reducing the traveling speed more than usual, the seedling row N is surely recognized and the accuracy of the image processing is improved. If the strength of the seedling row N is generally low, the deceleration section near the tip and end of the seedling row N is lengthened and adjusted to reduce the traveling speed to a low level, and if the strength is generally high, the opposite is true. It is preferable to adjust to. The degree of deceleration is not particularly limited, but the reduction is exemplified in the range of 10 to 50%, and specifically, the reduction is exemplified by 40%. It is preferable that the length of the section for reducing the speed near the tip and the end of the seedling row N is appropriately changed according to the photographing range of the imaging unit 13, the total length of the seedling row N, and the like. In this example, it is illustrated that the lengths of the front end and end sections are set in the range of 5 to 10 m, respectively, based on the photographing range of the image pickup unit 13, and specifically, it is illustrated that the length is set to 5 m. When the total length of the seedling row N is short (for example, 20 m or less), it is exemplified that the length of the tip and end sections is set to about 5% of the total length in order to prevent the overall speed reduction.

終端検出に関する走行制御部19の動作について説明すると、図9に示すように、走行制御部19は、苗列Nの先端から終端付近に至るまでの所定距離を走行したことが走行距離検出部16によって検知されるまでは、終端検出部18からの終端検出情報を無効化するように構成されている。そして、所定距離を走行したことが検知されると、終端検出部18からの終端検出情報を有効化し、終端検出部18からの終端検出情報をチェックし始める。そして、走行制御部19は、終端検出情報を検知すると、走行車両1に旋回動作を開始させる。 Explaining the operation of the travel control unit 19 regarding the end detection, as shown in FIG. 9, the travel distance detection unit 16 has traveled a predetermined distance from the tip of the seedling row N to the vicinity of the end. It is configured to invalidate the termination detection information from the termination detection unit 18 until it is detected by. Then, when it is detected that the vehicle has traveled a predetermined distance, the terminal detection information from the terminal detection unit 18 is enabled, and the terminal detection information from the terminal detection unit 18 is started to be checked. Then, when the travel control unit 19 detects the end detection information, the travel control unit 19 causes the traveling vehicle 1 to start a turning operation.

旋回動作に関する走行制御部19の動作について説明すると、走行制御部19は、図10及び図11に示すように、姿勢制御部12に対し、走行車両1の進行方向Ωを旋回開始時の基準角度として与えるとともに、目標角度ωrefを与え、その結果、該姿勢制御部12からの信号に応じて走行車両1の走行を制御する。旋回動作は、目標角度ωrefが90°の旋回を2回行うことにより、合計180°旋回するようになっている。このとき、目標角度ωrefに到達する前(例えば目標角度ωrefの10°前)より減速を開始し、S字減速とすることで、スムーズな停止制動を実現し、旋回方向センサー11による旋回方向角度の測定を確実に行わせるように構成されている。旋回開始時の基準角度をΩとしているので、図10に示すように走行動作開始時に角度ズレしていても終端付近の苗列Nの方向に対応して旋回し、図11に示すように終端付近の苗列Nの方向が湾曲していてもそれに対応して旋回するようになっている。 Explaining the operation of the traveling control unit 19 regarding the turning operation, as shown in FIGS. 10 and 11, the traveling control unit 19 sets the traveling direction Ω of the traveling vehicle 1 with respect to the attitude control unit 12 as a reference angle at the start of turning. As a result, the target angle ωref is given, and as a result, the traveling of the traveling vehicle 1 is controlled according to the signal from the attitude control unit 12. The turning operation is such that a total of 180 ° is turned by performing two turns with a target angle ωref of 90 °. At this time, deceleration is started before reaching the target angle ωref (for example, 10 ° before the target angle ωref), and S-shaped deceleration is performed to realize smooth stop braking and the turning direction angle by the turning direction sensor 11. It is configured to ensure that the measurement of is performed. Since the reference angle at the start of turning is Ω, even if the angle is deviated at the start of running operation as shown in FIG. 10, the turn is made corresponding to the direction of the seedling row N near the end, and the end is shown as shown in FIG. Even if the direction of the seedling row N in the vicinity is curved, it turns correspondingly.

以上のように構成された本例の走行車両1の走行制御装置5によれば、走行制御部19は、前記走行動作中に、画像処理部14により苗列Nの存在及び目標旋回方向が検出されたときは、該目標旋回方向に基づいて走行車両1の走行を制御し、苗列Nの存在及び目標旋回方向が検出されなかったときは、姿勢制御部12からの姿勢制御信号に基づいて走行車両1の走行を制御するように構成されている。この構成によれば、苗列Nに欠株が存在していることにより画像処理部14による画像処理の結果、苗列Nの存在及び目標旋回方向が検出されなかったときでも、姿勢制御部12による姿勢制御信号に基づいて走行車両1の走行を制御するように構成されている。そのため、欠株があっても走行が停止せず、走行車両1の安定した自律走行が実現できる。 According to the travel control device 5 of the traveling vehicle 1 of this example configured as described above, the traveling control unit 19 detects the existence of the seedling row N and the target turning direction by the image processing unit 14 during the traveling operation. When this is done, the traveling of the traveling vehicle 1 is controlled based on the target turning direction, and when the presence of the seedling row N and the target turning direction are not detected, based on the attitude control signal from the attitude control unit 12. It is configured to control the running of the traveling vehicle 1. According to this configuration, even when the presence of the seedling row N and the target turning direction are not detected as a result of image processing by the image processing unit 14 due to the presence of the seedling row N, the attitude control unit 12 It is configured to control the traveling of the traveling vehicle 1 based on the attitude control signal according to the above. Therefore, even if there is a stock shortage, the traveling does not stop, and stable autonomous traveling of the traveling vehicle 1 can be realized.

また、姿勢制御部12は、一定距離間隔で現状角度ωfを保存するとともに、該保存された過去の現状角度ωfと最新の現状角度ωfとの平均値を走行車両1の進行方向又は苗列Nの方向として採用する。この構成によれば、走行車両1の進行方向又は苗列Nの方向として、保存された過去の現状角度ωfと最新の現状角度ωfとの平均値Ωを採用することにより、現状角度ωfの一時的なぶれの影響を低減することができ、走行車両1の安定した自律走行が実現できる。 Further, the attitude control unit 12 saves the current angle ωf at regular distance intervals, and sets the average value of the saved past current angle ωf and the latest current angle ωf in the traveling direction of the traveling vehicle 1 or the seedling row N. Adopt as the direction of. According to this configuration, by adopting the average value Ω of the saved past current angle ωf and the latest current angle ωf as the traveling direction of the traveling vehicle 1 or the direction of the seedling row N, the current angle ωf is temporarily set. The influence of the target shake can be reduced, and stable autonomous traveling of the traveling vehicle 1 can be realized.

また、走行制御部19は、姿勢制御部12で検出された現状角度ωfの平均値Ωを旋回動作の開始時の基準角度として用いる。この構成によれば、苗列Nの終端部における湾曲に合わせて前記旋回動作を走行車両1に行わせることができる。 Further, the traveling control unit 19 uses the average value Ω of the current angle ωf detected by the attitude control unit 12 as a reference angle at the start of the turning operation. According to this configuration, the traveling vehicle 1 can be made to perform the turning operation in accordance with the bending at the end portion of the seedling row N.

また、画像処理部14は、苗列Nの存在位置と走行車両1の中央との左右方向における位置ズレ量が所定量以上の場合に目標旋回方向を検出するように構成されている。この構成によれば、シンプルな画像処理で走行車両1の走行制御を実現できる。 Further, the image processing unit 14 is configured to detect the target turning direction when the amount of positional deviation between the existing position of the seedling row N and the center of the traveling vehicle 1 in the left-right direction is a predetermined amount or more. According to this configuration, traveling control of the traveling vehicle 1 can be realized by simple image processing.

また、走行車両1の走行距離を測定する走行距離検出部16を備え、走行制御部19は、該走行距離に基づいて検出される苗列Nの先端及び終端付近において、走行車両1の走行速度を低減させるように構成されている。この構成によれば、走行速度を低減させることにより、苗列Nの先端又は終端付近において、画像処理部14に確実に苗列Nを認識させることができ、安定した自律走行が実現できる。 Further, a mileage detection unit 16 for measuring the mileage of the traveling vehicle 1 is provided, and the traveling control unit 19 has a traveling speed of the traveling vehicle 1 near the tip and the end of the seedling row N detected based on the mileage. Is configured to reduce. According to this configuration, by reducing the traveling speed, the image processing unit 14 can surely recognize the seedling row N near the tip or the end of the seedling row N, and stable autonomous traveling can be realized.

また、走行車両1前方にある物体を検出する対物センサー17を有し、該対物センサー17により栽培エリアの終端を示す境界物Eを検出する終端検出部18を備え、走行制御部19は、該終端検出部18により該終端を検出すると、走行車両1に前記旋回動作をさせるように構成されている。この構成によれば、前記終端の撮像画像に対する画像処理のみにより該終端を検出する場合よりも、確実に終端を検出することができる。そのように画像処理のみにより前記終端を検出しようとすると、畦畔の上の雑草等を苗と誤検出して終端検出を失敗することがあるからであり、また、それを防止するために、畦畔を管理したり、畔波シートなどにより畦畔を安定した形状に保ったりする必要があるからである。 Further, the vehicle has an objective sensor 17 for detecting an object in front of the traveling vehicle 1, a terminal detecting unit 18 for detecting a boundary object E indicating the end of the cultivation area by the objective sensor 17, and the traveling control unit 19 has the objective sensor 17. When the end is detected by the end detection unit 18, the traveling vehicle 1 is configured to perform the turning operation. According to this configuration, the end can be detected more reliably than in the case where the end is detected only by image processing on the captured image of the end. This is because if we try to detect the end only by image processing, weeds on the ridge may be mistakenly detected as seedlings and the end detection may fail, and in order to prevent it, This is because it is necessary to manage the ridges and keep the ridges in a stable shape by using a shore wave sheet or the like.

さらに、走行制御部19は、苗列Nの先端から終端付近に至るまでの所定距離を走行したことが走行距離検出部16によって検知されるまでは、終端検出部18からの終端検出情報を無効化するように構成されている。この構成によれば、苗列Nの終端付近以降のみ、終端検出部18からの終端検出情報を利用することにより、それ以前における栽培エリアの終端の誤検出を排除することができる。 Further, the travel control unit 19 invalidates the terminal detection information from the terminal detection unit 18 until the travel distance detection unit 16 detects that the vehicle has traveled a predetermined distance from the tip of the seedling row N to the vicinity of the end. It is configured to be. According to this configuration, by using the end detection information from the end detection unit 18 only near the end of the seedling row N, it is possible to eliminate the erroneous detection of the end of the cultivation area before that.

なお、本発明は前記実施形態に限定されるものではなく、例えば以下のように、発明の趣旨から逸脱しない範囲で適宜変更して具体化することもできる。
(1)走行車両1を、2以上の苗列Nを跨いで走行するように構成したり、条間を走行するように構成したりすること。
(2)走行車両1の走行手段としてのクローラ3を他の走行手段(例えば車輪)に変更すること。
(3)カメラ、旋回方向センサー11、対物センサー17、エンコーダー等の各センサーを、それぞれ実質的に同一機能を有する他の方式のセンサーに変更すること。
The present invention is not limited to the above-described embodiment, and may be appropriately modified and embodied as described below within a range that does not deviate from the gist of the invention.
(1) The traveling vehicle 1 is configured to travel across two or more seedling rows N, or to travel between rows.
(2) Changing the crawler 3 as a traveling means of the traveling vehicle 1 to another traveling means (for example, wheels).
(3) Change each sensor such as the camera, the turning direction sensor 11, the objective sensor 17, and the encoder to a sensor of another type having substantially the same function.

1 走行車両
2 機体フレーム
3 クローラ
4 駆動部
5 走行制御装置
6 電池
11 旋回方向センサー
12 姿勢制御部
13 撮像部
14 画像処理部
15 エンコーダー
16 走行距離検出部
17 対物センサー
18 終端検出部
19 走行制御部
C 機体フレームの中心位置
E 境界物
F 矢印
N 苗列
Ns 苗列の先端
Ne 苗列の終端
P 苗列の存在位置P
ωe 角度差分
ωf 現状角度
ωref 目標角度
Ω 現状角度の平均値
1 Traveling vehicle 2 Aircraft frame 3 Crawler 4 Driving unit 5 Driving control device 6 Battery 11 Turning direction sensor 12 Attitude control unit 13 Imaging unit 14 Image processing unit 15 Encoder 16 Mileage detection unit 17 Objective sensor 18 Termination detection unit 19 Driving control unit C Center position of the aircraft frame E Boundary object F Arrow N Seedling row Ns Seedling row tip Ne Seedling row end P Seedling row presence position P
ωe Angle difference ωf Current angle ωref Target angle Ω Average value of current angle

Claims (6)

栽培エリア内に条植えされた作物の苗列に沿って走行する走行動作と、該走行動作後に次の走行動作の対象とする苗列の先端に向けて旋回する旋回動作とを行うように構成された走行車両の走行制御装置であって、
前記走行車両の旋回方向の現状角度を検出する旋回方向センサーと、
与えられる目標角度及び前記現状角度の角度差分が無くなるようにフィードバック制御を行い、その結果として前記走行車両の旋回方向を制御する姿勢制御信号を出力するように構成されており、さらに、前記走行車両の走行における一定距離間隔で前記現状角度を保存するとともに、定期的に、直前の所定回数分の該現状角度の平均値を算出するように構成されている姿勢制御部と、
前記走行車両の進行方向前方の苗列を撮像する撮像部と、
該撮像部により撮像した画像に基づいて前記苗列の存在を検出するとともに、該苗列に沿って走行するための目標旋回方向を検出し、それらの検出結果を出力する画像処理部と、
前記走行動作中に、前記画像処理部により前記苗列の存在及び前記目標旋回方向が検出されたときは、該目標旋回方向に基づく前記目標角度を前記姿勢制御部に与え、前記苗列の存在及び前記目標旋回方向が検出されなかったときは、前記姿勢制御部からの前記現状角度の平均値を前記走行動作における前記走行車両の進行方向を示す角度であり且つ該走行車両の現在位置における前記苗列の方向を示す角度であるものとして用いることによって得られる前記目標角度を前記姿勢制御部に与え、その結果として前記姿勢制御部から出力された前記姿勢制御信号に基づいて前記走行車両の旋回方向を制御するように構成されている走行制御部と
を備える走行車両の走行制御装置。
It is configured to perform a traveling motion of traveling along a row of seedlings of crops planted in a cultivation area and a turning motion of turning toward the tip of the row of seedlings to be targeted for the next traveling motion after the traveling motion. It is a running control device for a running vehicle.
A turning direction sensor that detects the current angle of the turning direction of the traveling vehicle, and a turning direction sensor.
It is configured to perform feedback control so that the angle difference between the given target angle and the current angle is eliminated, and as a result, output an attitude control signal for controlling the turning direction of the traveling vehicle, and further, the traveling vehicle. An attitude control unit configured to store the current angle at regular distance intervals and periodically calculate the average value of the current angle for a predetermined number of times immediately before .
An image pickup unit that captures an image of a row of seedlings in front of the traveling vehicle in the traveling direction,
An image processing unit that detects the presence of the seedling row based on the image captured by the image pickup unit, detects a target turning direction for traveling along the seedling row, and outputs the detection results.
When the presence of the seedling row and the target turning direction are detected by the image processing unit during the traveling operation, the target angle based on the target turning direction is given to the attitude control unit, and the seedling row is given . When the presence of the vehicle and the target turning direction are not detected , the average value of the current angle from the attitude control unit is an angle indicating the traveling direction of the traveling vehicle in the traveling operation and the current position of the traveling vehicle. The target angle obtained by using the angle indicating the direction of the seedling row in the above is given to the attitude control unit, and as a result, the traveling vehicle is based on the attitude control signal output from the attitude control unit. With a travel control unit configured to control the turning direction of
A traveling control device for a traveling vehicle.
前記走行制御部は、前記姿勢制御部で検出された前記現状角度の前記平均値を前記旋回動作の開始時の基準角度として用いる
請求項1に記載の走行車両の走行制御装置。
The travel control device according to claim 1, wherein the travel control unit uses the average value of the current angle detected by the attitude control unit as a reference angle at the start of the turning operation.
前記画像処理部は、前記苗列の存在位置と前記走行車両の中央との左右方向における位置ズレ量が所定量以上の場合に左右方向への前記目標旋回方向を出力するように構成されている
請求項1又は2に記載の走行車両の走行制御装置。
The image processing unit is configured to output the target turning direction in the left-right direction when the amount of positional deviation between the existing position of the seedling row and the center of the traveling vehicle in the left-right direction is a predetermined amount or more. The travel control device for a traveling vehicle according to claim 1 or 2.
前記走行車両の走行距離を測定する走行距離検出部を備え、
前記走行制御部は、該走行距離に基づいて検出される前記苗列の先端及び終端付近において、前記走行車両の走行速度を低減させるように構成されている
請求項1~3のいずれか一項に記載の走行車両の走行制御装置。
A mileage detection unit that measures the mileage of the traveling vehicle is provided.
One of claims 1 to 3, wherein the traveling control unit is configured to reduce the traveling speed of the traveling vehicle in the vicinity of the tip and the end of the seedling row detected based on the traveling distance. The traveling control device for the traveling vehicle according to the above.
前記走行車両前方にある物体を検出する対物センサーを有し、該対物センサーにより栽培エリアの終端を検出する終端検出部を備え、
前記走行制御部は、該終端検出部により該終端を検出すると、前記走行車両に前記旋回動作をさせるように構成されている
請求項4に記載の走行車両の走行制御装置。
It has an objective sensor that detects an object in front of the traveling vehicle, and has a termination detection unit that detects the end of the cultivation area by the objective sensor.
The travel control device for a traveling vehicle according to claim 4, wherein the traveling control unit is configured to cause the traveling vehicle to perform the turning operation when the termination is detected by the termination detecting unit.
前記走行制御部は、前記苗列の先端から終端付近に至るまでの所定距離を走行したことが前記走行距離検出部によって検知されるまでは、前記終端検出部からの終端検出情報を無効化するように構成されている
請求項5に記載の走行車両の走行制御装置。
The travel control unit invalidates the end detection information from the end detection unit until the travel distance detection unit detects that the vehicle has traveled a predetermined distance from the tip of the seedling row to the vicinity of the end. The travel control device for a traveling vehicle according to claim 5.
JP2018166531A 2018-09-06 2018-09-06 Travel control device for traveling vehicles Active JP7070905B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2018166531A JP7070905B2 (en) 2018-09-06 2018-09-06 Travel control device for traveling vehicles

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2018166531A JP7070905B2 (en) 2018-09-06 2018-09-06 Travel control device for traveling vehicles

Publications (2)

Publication Number Publication Date
JP2020036569A JP2020036569A (en) 2020-03-12
JP7070905B2 true JP7070905B2 (en) 2022-05-18

Family

ID=69736973

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018166531A Active JP7070905B2 (en) 2018-09-06 2018-09-06 Travel control device for traveling vehicles

Country Status (1)

Country Link
JP (1) JP7070905B2 (en)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2012157334A (en) 2011-02-02 2012-08-23 Yanmar Co Ltd Rice transplanter
JP2013252087A (en) 2012-06-06 2013-12-19 Minoru Industrial Co Ltd Field-traveling apparatus
US20170006759A1 (en) 2015-07-08 2017-01-12 The Royal Institution For The Advancement Of Learning/Mcgill University Guidance system and steering control device for an agricultural vehicle

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0728575B2 (en) * 1988-02-23 1995-04-05 株式会社クボタ Turn control device of reaper harvester
JP2996705B2 (en) * 1990-09-18 2000-01-11 ヤンマー農機株式会社 Steering control device for automatic traveling work vehicle

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2012157334A (en) 2011-02-02 2012-08-23 Yanmar Co Ltd Rice transplanter
JP2013252087A (en) 2012-06-06 2013-12-19 Minoru Industrial Co Ltd Field-traveling apparatus
US20170006759A1 (en) 2015-07-08 2017-01-12 The Royal Institution For The Advancement Of Learning/Mcgill University Guidance system and steering control device for an agricultural vehicle

Also Published As

Publication number Publication date
JP2020036569A (en) 2020-03-12

Similar Documents

Publication Publication Date Title
US10321625B2 (en) Autonomous working machine such as autonomous lawn mower
JP5952611B2 (en) Travel control device
WO2016093311A1 (en) Work vehicle
JP6497546B2 (en) Travel control device
EP2135498B1 (en) A method of navigating an agricultural vehicle and an agricultural vehicle
CN110243372B (en) Intelligent agricultural machinery navigation system and method based on machine vision
US20170357267A1 (en) Autonomous work vehicle obstacle detection system
JP6420173B2 (en) Automated traveling field work vehicle
US9912933B2 (en) Road surface detection device and road surface detection system
EP3330147B1 (en) Method and apparatus for generating a driving route for an autonomous vehicle
CN103582907A (en) Device for determining road profile, onboard image-recognition device, device for adjusting image-capturing axis, and lane-recognition method.
JP6486045B2 (en) System, vehicle and method for on-line calibration of in-vehicle camera
CN104742959A (en) Lane Keeping Control Device Of Vehicle
JPWO2017149813A1 (en) Sensor calibration system
JP5328427B2 (en) Travel control device
CN109923028A (en) Neutral point detection device and steering control system
WO2019176844A1 (en) Work vehicle and crop row recognition program
JP7070905B2 (en) Travel control device for traveling vehicles
JP6044084B2 (en) Moving object position and orientation estimation apparatus and method
CN105550676A (en) Logistics delivery vehicle trace tracking method based on linearity CCD
JP2006101816A (en) Method and apparatus for controlling steering
Hanawa et al. Development of a stereo vision system to assist the operation of agricultural tractors
JP6740116B2 (en) Moving vehicle
Freese et al. Nonlinear robust path control for a field robot scouting in strawberry orchards
JP2015011645A (en) Optical axis correction device

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20180918

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20201207

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20210921

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20211102

A601 Written request for extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A601

Effective date: 20211216

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220228

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: 20220419

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20220425

R150 Certificate of patent or registration of utility model

Ref document number: 7070905

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150