JPH01269407A - 作業用車両の自動操向装置 - Google Patents

作業用車両の自動操向装置

Info

Publication number
JPH01269407A
JPH01269407A JP63101032A JP10103288A JPH01269407A JP H01269407 A JPH01269407 A JP H01269407A JP 63101032 A JP63101032 A JP 63101032A JP 10103288 A JP10103288 A JP 10103288A JP H01269407 A JPH01269407 A JP H01269407A
Authority
JP
Japan
Prior art keywords
angle
steering
distance
boundary
line
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
JP63101032A
Other languages
English (en)
Inventor
Hideki Kamiyama
神山 英機
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Yanmar Co Ltd
Original Assignee
Yanmar Agricultural Equipment Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Yanmar Agricultural Equipment Co Ltd filed Critical Yanmar Agricultural Equipment Co Ltd
Priority to JP63101032A priority Critical patent/JPH01269407A/ja
Publication of JPH01269407A publication Critical patent/JPH01269407A/ja
Pending legal-status Critical Current

Links

Landscapes

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

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 〔産業上の利用分野〕 本発明は未作業域と既作業域との境界を倣いガイドとし
て、コンバイン、田植機3杭打機等の作業用車両を自動
的に操向せしめる作業用車両の自動操向装置に関する。
〔従来技術] 作業用車両である田植機は、走行機体と該機体の後部に
連結された植付部とからなり、走行機体を走行させつつ
、植付部に搭載した苗株を、該植付部に装備された植付
爪の動作により、所定の間隔にて田面上に植付けるもの
である。
ところで、苗株相互間の植付は間隔が過度に狭いと、苗
株の生育不良を招来する虞があり、逆に植付は間隔が過
度に広いと、単位面積当たりの収穫量が少なくなるため
、苗株の植付けは、適正な植付は間隔にて行われること
が望ましい。田植機においては、前記植付爪が走行機体
の走行速度と同期して動作するようになっており、走行
機体の進行方向の植付は間隔は、走行速度の如何に拘わ
らず、自動的に前記適正値に保たれるが、走行機体の進
行方向と直交する方向の植イ」け間隔(以下条間隔とい
う)を前記適正値に保つためには、未作業域と既作業域
との境界である既に植付けられた苗株の列条に沿って走
行機体を操向させっつ植イ」けを行わせる必要がある。
そこで条間隔を前記適正値に保った状態で植付は作業が
行えるように、走行機体を前記苗株の列条に沿って自動
的に操向せしめる自動操向装置を装備した田植機がある
この自動操向装置の一例として、特開昭53−1271
13号に開示されている発明がある。これは、現状の植
付は条に隣接する既植苗の列条に赤外線を照射し、走行
機体の側部に左右方向に並設した複数個の受光素子から
なるセンサにより前記既植苗からの反射光を受光する場
合に、これらのセンサの内、前記の列条の直上に位置す
るセンサにより前記反射光の受光がなされることを利用
し、所定のセンサにより常に受光がなされるように操向
制御を行うことにより、既植苗の列条に対する走行機体
の相対位置を適正位置に保つものであり、前記所定のセ
ンサよりも左側(又は右側)に位置するセンサにより受
光がなされた場合には、走行機体の相対位置が右(又は
左)にずれていると判断しで、このずれを解消すべく、
左方向(又は右方向)に所要量の操舵を行う構成となっ
ている。
〔発明が解決しようとする課題〕
しかしながら前記発明においては、所定のセンサにより
苗株からの反射光が受光される範囲を操向制御を行わな
い不感帯とし、それと相隣するセンサにより反射光が受
光された場合に受光されたセンサに応じて操向制御を行
う、即ちセンサの位置により苗株を検出するという苗株
の一次元的検出にWづき自動操向しているので、走行機
体と苗株の列条とのなず角度については検出できず、目
椋操舵角を所要操舵角より大きく設定し、自動操向が不
安定となり、また追従性が悪くなる虞があると共に、欠
株又は苗株の倒覆等の影響を受けやすく菌株の検出が不
正確となる虞があった。
−・方ビデオカメラにて境界である苗株の列条を撮像す
ることにより二次元的に苗株の列条を検出し、撮像され
た苗列の近イ以直線を求め、その近似直線と画像中心線
との距離である偏差及び近似直線と画像中心線とのなす
角度である傾きを検出する検出装置に関する発明が特開
昭62−61509号公報に開示されている。しかしな
がら前記発明においては、画像上の偏差及び傾きから実
際の田面上の基準線に対する機体の偏差及び傾きを演算
する手段が具体的には開示されておらず、またその演算
には多くの時間と多大なメモリを必要とするという問題
があった。
本発明は斯かる事情に鑑のなされたものであり、偏差及
び傾きに対応する各別の不感帯を設け、各別の不感帯と
距離及び角度との大小比較に基づき自動操向することに
より演算時間を短かく、メモリ容量を減少できると共に
、安定し、追従性と精度の向」ことを回った自IJ]操
向装置を提供することを目的とする。
〔課題を解決するための手段] 本発明に係る作業用車両の自動操向装置は、未作業域と
既作業域の境界に倣い自動操向する作業用車両の自動操
向装置において、前記境界を撮像する境界撮像装置と、
該境界撮像装置で撮像された画像から前記境界を抽出し
1、直線辺イ以する手段と、該手段により求められた線
分と画像における機体の進行方向に設定してある基準線
とのなす角度及び画像の所定位置における前記線分と、
11線との距離を算出する手段と、該手段により算出さ
れた前記角度及び前記距離と、前記基準線に対して所定
の角度を有して設けられた複数の角度不感帯及び前記基
準線に対して所定の幅を有して設けられた複数の距離不
感帯との各別の関係に基づき自動操向する手段とを具備
することを特徴とする。
〔作用〕
本発明によれば、直線辺イ以された境界を示す線分と基
準線とのなす角度及び基t4B線と線分との距離と角度
不感帯及び距離不惑帯との関係に基づぎ自動操向するの
で、二次元的に境界を検出し操向すると共に、大小比較
の演算で自動操向を可能とする。
〔実施例〕
以下本発明をその実施例を示す凹面に基づいて詳述する
。第1図は本発明に係る田植機の自動操向装置(以下本
発明装置という)を装備した乗用田植機の側面図、第2
図はその平面図である。
図においてAは、左右各一対の前輪1.1及び後輪2.
2に支持された走行機体であり、該走行機体Aは、その
前部に搭載した動力部3にて発生された動力を、図示し
ない王クラッチ、変速機等の伝動機構を介して後輪2,
2に伝達し、該後輪2.2の回転により、田面上を自走
する。
またBは、走行機体Aの後部に装着された3点リンク機
構4の後端部に、該機構4の昇降動作に伴って、走行機
体1こ対して昇降自在となるように取付られた植付部で
あり、該植付部Bは、6条植えの田植機の場合、第2図
に示す如く、その後端部の左右両側に一対の植付爪7,
7を備え、左右方向に互いに適長離隔さ−Uて並設され
た3組の苗植装置6.6,6、該苗植装置6,6.6の
上側に左右方向への摺動自在に取イ」けられた苗載台8
、及び苗植装置6,6.6の下側に、左右方向に互いに
適長離隔させて、前後方向に揺動自在に取付けられた3
個のフロート9. 9. 9等から構成されている。而
して、3点リンク機構4の動作により田面上に陸上され
た植付部Bは、走行機体Aに牽引されて、フロート9,
9.9の作用により田面上を滑走しつつ、苗植装置6.
6.6の夫々の植付爪7,7・・・の動作により、苗載
台8J二に載置されこれに沿って滑動落下する苗マツI
〜を、苗載台8の最下部において、数珠づつの苗株に切
り分け、田面上に列条をなして植付ける。
走行機体Aの、前輪1,1の中心よりもやや前方の左右
両側には、一対のマーカ取付杆10a、 ]Oaの基端
部が、水平面内での回動自在に取付けてあり、該取付杆
10a、 10aの下方に向けて屈曲された先端部には
、容易に視認可能なように、黄色のプラスチックにて円
柱状に成形されたマーカ10.10が、田面の上方に適
長離隔させて夫々固着されている。マーカ取付杆10a
、 10aは夫々の先端部を、第1図及び第2図に示す
如く、左前方又は右前方に突出させた位置と、走行機体
Aの下部に収納された位置とのいずれか一方の位置にて
M沢的に拘束できるようにしてあり、左側(又は右側)
の取イ」杆10aが突出位置にある場合に、この先端の
前記マーカ10を、走行機体Aの左側(又は右側)の既
植苗の列条に一致させることにより、植付部Bにより植
付けられる苗株と、前記既植苗の列条との間の条間隔を
所定値に保つことができる。
また、走行機体Aの、後輪2.2の上端よりもやや前上
方の左右両側には、その先端部を左右に突出させて、セ
ンサ取付杆21L、21Rが固着してあり、該取付杆2
1L、21Rの先端部には、境界撮像装置である苗列撮
像装置20L、 20Rが取付けである。
第3図は苗列撮像装置20.Lの取付状態を示す拡大側
面図、第4図はその平面図である。
苗列撮像装置2f)Lは、カラービデオカメラ20La
を用い、走行機体の進行方向に対して前下方にそのレン
ズ部の中心を向け、その取付位置から所定距離前下方の
田面上に前行程で植えられた未作業域と既作業域との境
界である苗列のうちの最外側の4株程度の苗株を1最像
できるようにその前後方向の取付角度を設定され、その
視野内にて撮像された画像を後述する画像処理部22に
伝達する。
走行機体への右側に位置する苗列撮像装置20Rは前記
左側の苗列撮像装置2OLと同様に取付けられている。
走行機体への後部には運転席DSが設けてあり、該運転
席DSの左側には、前記変速機の変速段の変更及び前記
主クラッチの係脱を行うための主変速レバ11が、また
運転席O5の右側には、作業選択レバ12が夫々配設さ
れている。
第5図は、作業選択レバ12の取付位置近傍の上方から
の拡大平面図である。作業選択レバ12は、その下部を
走行機体Aの適宜位置に枢支してある一方、走行機体A
の上部に固設された案内板13に前後方向を長手方向と
して形成された案内孔14にその中途部を押通させてあ
り、該孔14に沿って、これを前後方向又は左右方向に
回動操作し、所定の係止位置にて係止せしめるごとによ
り、種々の作業状態を選択できるようにしたものである
即ち、該レバ12を前記案内孔14の後半部(第5図に
おいては右半部)において、前後方向に回動操作するこ
とにより、前記3点リンク機構4の図示しない昇降用油
圧シリンダへの圧油の送給方向を切換え、該シリンダの
動作により植付部Bが走行機体へに対して上智又は下部
し、前記後半部の中途部に右向きに分岐形成された係止
部14aに係止せしめることにより、植付部Bか適宜の
高さ位置にて停止するようになっている。また、前記作
業選択レバ12を案内孔14の前半部に回動操作するご
とにより、図示しない植?=jけクラッチが係合され、
動力部3からの動力が伝達されて、植付部Bがその動作
を開始するようになっており、該レバ]2を案内孔14
の最前部に係[にさ−けた場合には、植付部Bの動作速
度が高速となり、案内孔14の前半部の中途部に係止さ
せた場合には、植付部Bの動作速度が低速となる。更に
、前記2個所の係止位置の夫々において、案内孔14に
左右に分岐形成された横孔14b、 14cに沿って、
作業選択レバ12を右又は左に回動操作することにより
、右側又は左側の前記マーカ10が突出されると同時に
、逆側のマーカ10が収納されるようになっている。
第6図は前輪1.1の操舵機構の模式的平面図である。
回において30は、その長手方向を左右方向として走行
機体Aの下部に水平に固着されたフロントアクスルであ
り、該フロントアクスル30の左、右両端部には、左、
右の前輪1.1を夫り軸支するナックルアーム32.3
2が、キングピン31.31を介して水平面内での回動
自在に枢支されている。また、前記フロントアクスル3
0の上面の適宜位置には、枢軸33が上向きに立設され
ており、該枢軸33には、第6図に示す如き変形丁字形
の平面形状を有する回動部材34が、丁字形の交叉部を
水平面内での回動自在に枢支して取4=Jけられている
。該回動部月34の丁字形の縦線に相当する部分は、前
方に突出させてあり、その端部は、各別のリンク部tA
’35.36を介して前記ナックルアーム32.32の
前端部と夫々連結させである。また、回動部tA34の
丁字形の横線に相当する部分の右側の端部は、その基端
部を走行機体Aの前部に水平面内での回動自在に枢支し
てなる操向シリンダ40のピストンロッF’40aの先
端部に、また左側の端部は、前記操向シリンダ40への
圧油の送給方向を切換える方向切換弁41のスプール4
1aの一端部に夫々係止してある。該方向切換弁旧は、
4ボ一ト3位置切換弐であり、運転席DSの前部に配設
された前輪操舵用のハンドル15が左又は右方向に回動
操作された場合に、これに応りJして鉛直面内にて回動
し、その下部が後又は前方向に移動する回動アー1、托
の下端部に、前記スプール4]aの他端部を係止さ・U
て配設されている。
本発明装置の油圧回路は、前記操向シリンダ40、前記
方向切換弁41、動力部3から駆動力を伝達されて回転
する油圧ポンプP、及び4ボ一ト3位置切換式の電磁方
向切換弁V等から構成されており、油圧ポンプPからの
圧油は、分配弁42により2方向に分岐され、一方が方
向切換弁41を経て、また他方が電磁方向切換弁■を経
て、夫々操向シリンダ40に送給されるようになしてあ
る。
前述の如く、方向切換弁41のスプール41aは、回動
アーム16の下端部に係止してあり、ハンドル15が右
方向に回動操作され、回動アーム16が第6図における
時計廻りに回動した場合、前記スプール41aは該アー
ム16の下端部によって押圧され、方向切換弁41を通
過した圧油が操向シリンダ40の進出側油室に送給され
、ピストンロッド40aが進出する結果、前記回動部材
34が第6閏における時計廻りに回動し、該部材34の
前端に係止したリンク部材35.36を介して、ナック
ルアーム32.32と共に、前輪1,1は右に操舵され
る。また前記ハンドル15が左方向に回動操作された場
合、方向切換弁41を通過した圧油が操向シリンダ40
の退入側油室に送給され、ピストンロッド40aが退入
する結果、操舵機構が前述の場合と逆方向に動作して前
輪1.1は左に操舵される。
また、前記電磁方向切換弁VのソレノイドS!(又はソ
レノイドSr)が励磁された場合には、油圧ポンプPか
らの圧油が、該弁Vを通過して操向シリンダ40の退入
側(又は進出側)油室に送給され、この圧油によりビス
1−ンロンド40aが退入(又は進出)する結果、前記
ハンドル15が左方向(又は右方向)に回動操作された
場合と同様に、前記回動部材34が第6図における時計
廻り(又は反時旧廻り)に回動し、該部材34の前端に
係止したリンク部材35.36を夫々介して、ナンクル
アーム32.32と共に左右の前輪1.1は左(又は右
)に操舵される。
このようにして操舵される前輪1,1の操舵角を検出す
べく、前記キングピン3L31 の一方に、該ピン31
の回動位置に応した電位を出力するボテンンゴノータを
用いてなる操舵角センサ38が装着されている。第7図
は操舵角センサの操舵角と出力電圧との関係を示すグラ
フであり、縦軸には出力電圧(V)を、また横軸には操
舵角■θ (°)ヲトっている。該操舵角センサ38は
、第7図に示す如く直進に対して右に操向されていると
きは3゜5■より大きい電位を出力し、また左に操向さ
れているときは3.5■より小さい電位を夫々出力する
またハンドル15に操作力が加えられていない場合には
、電磁方向切換弁Vを通過した圧油による油圧シリンダ
40の動作により回動部材34の回動位置が変化したと
きにおいても、方向切換弁41は、スプール41aに設
+Jたばねの作用によりその中立位置をとるようにして
あり、これと共にハンドル15は直進走行状態に復帰す
るようになっている。
そしてハンドル15に連結されたステアリングコラム1
5aの基端部には、該ハンドル15が直進状態から右又
は左方向に回動操作された場合にオンする手動操舵検出
スイッチ54(第8図参照)が配設してある。
さて、第8図は本発明装置の要旨である制御系のブロッ
ク図であり、第9図は画像処理部の構成を示すブロック
図である。図において50はマイクロプロセッサを用い
てなる操向制御部であり、該制御部50の入カポ−1’
 a + には画像処理部22の出力が与えられている
。画像処理部22はマイクロプロセッサ・を用いてなり
、その分解能は縦横夫々256画素を有している。また
画像処理部22は作業選択レバ12が案内孔14の前記
横孔14bもしくは横孔14cに沿って左方向又は右方
向に回動操作され、左側又は右側の前記マーカ10が突
出された場合に切換ねり、左右の苗列撮像装置201.
2ORを選択する選択スイッチ221 、NTSC方式
のビデオカメラ人力信号をこの画像処理部の画素毎に赤
色、緑色、青色の各色信号R,G、 Bに分離するNT
SCデコーダからなるカメラ入力信号変換部222、分
離された赤、緑、青の各色信号R,G、Bに基づき、後
述する演算により画像情報を2値化する2値化演算部、
2値化された画素のうち所定の画素間距離を有する画素
を抽出する画素抽出部226、抽出された画素により直
線辺イ以を行うハフ変換部227の順で接続されてなり
、前記2値化演算部225、画素抽出部226ハフ変換
部227での演算は前記マイクロプロセンサに搭載した
ソフトウェアにより行われている。
またハフ変換部227及びカメラ人力信号変換部222
は画像情報演算結果及び直線近似結果等の各種情報をビ
デオ信号出力に変換するモニタ出力信号変換部223に
接続され、変換されたビデオ信号により前記各種情報を
表示するカラーモニタ224がモニタ出力信号変換部2
23に接続されている。そしてハフ変換部227がらの
出力が操向制御部5oの入力ポートa、に与えられる。
また操向側?ff1部50の入力ポートa2には、前記
操舵角センサ38の出力電位が与えられており、該入力
ボートa 2に入力される信号は、操向制御部50の入
力インタフェースにて所定の処理を施され、前輪1,1
の現状の操舵角に対応するディジクルデータとして、操
向制御部5oのCPUに取込まれるようになっている。
また操向制御部50の入力ポートa3には、運転席O3
に着座した作業者による手動操作可能な位置に配設され
、自動操向を行わせる場合に、オンされる自動スイッチ
51が接続されており、該スイッチ51がオンされた場
合に、入力ポートa3はハイレベルに転しる。
入力ボートa4には、作業選択レバ】2が案内孔14前
半部の回動位置にある場合にオンする植付はスイッチ5
2が接続されており、操向制御部5oは、該スイッチ5
2のオンに伴って入力ボートa4がハイレベルになるこ
とにより、植付部Bが動作して 。
いることを認識する。
入力ポートa、には、主変速レバ11の操作により主ク
ラッチが係合された場合にオンする主クラツチスイッチ
53が接続されており、操向制御部50は、該スイッチ
53のオンに伴って入力ボートa5がハイレベルになる
ことにより、走行機体Aが走行していることを認識する
更に操向制御部50の入力ボートa6には、前述の如く
配設された手動操作検出スイッチ54が接続されており
、該スイッチ54がオンされた場合に入力ボートa6が
ハイレベルに転しるようになしてある。
一方、操向制御部50の出カポ−1−b1は、電磁方向
切換弁■のソレノイドSρとボディーアースの間に介装
したスイッチングトランジスタ60に接続されており、
同様に、出カポ−1’bzは、ソレノイドSrとボディ
ーアースの間に介装したスイッチングトランジスタ61
に接続されている。そして出力ポートb、(又は出力ポ
ートb2)がハイレベルとなった場合には、スイッチン
グl−ランジスタロ0(又は同61)が動作して、ソレ
ノイドS!(又は同Sr)に励磁電流が流れるようにな
っている。
操向制御部50の出カポ−1−b、は、操向制御が行わ
れていることを作業者に報知せしめるための自動ランプ
62に、また出力ポートb4は、前記苗列撮像装置2O
L、2ORのいずれかにより既植苗が検出されており、
操向制御が適正に行われていることを作業者に報知せし
めるための苗検出ランプ63に夫々接続されており、出
カポ−)b、+、b、のハイレベル出力に応じて各ラン
プが点灯するようになっている。
また、出力ポートb9.b6は、各種警報出力のための
警報ランプ64.警報ブザ65に夫々接続されており、
出力ポートb5のハイレベル出力に応して警報ランプ6
4が点灯し、出力ポートb6のハイレベル出力に応じて
警報ブザ65が鳴動するようになっている。
操向制御部50、苗列撮像装置2OL、20R及びツレ
ノイド5ffi、Srは、前記操舵角センサ38及び各
スイッチと共に、いずれもエンジン始動用のキースイッ
チ70を介して電源に接続されており、該スイッチ70
がオンされている場合にのめ夫々の動作を行うことがで
きる。
さて以上の如く構成された操向制御計部50の動作内容
について、本発明装置を装備した乗用田植機による植付
は作業手順と共に説明する。
運転席O3に着座した作業者により自動スイッチ51が
オン操作され、入力ボートa3がハイレベルに転しると
、操向制御部50は、出力ポートb3を断続的にハイレ
ベルとし、自動ランプ62を点滅せしめて、制御動作の
準備段階にあることを作業者に報知する。
次いで作業者は、作業選択レバ12を前方に回動操作し
て植付部Bを田面上に降下せしめ、更に走行機体Aの走
行速度に応して植付部Bの動作速度を選択し、作業選択
レノ\12を前記案内孔14前半部の所定の係止位置ま
で回動操作する。このレバ操作により、前記植付はスイ
ッチ52がオンされて人カポ−)aaがハイレベルに転
しると、操向制御部50は、出力ポートb3を連続的に
ハイレベルとし、自動ランプ62を点灯させ、以後その
制御動作を開始する。
さて作業者は、作業選択レバ12を所定の係止位置にて
係止せしめた後、例えば、倣いガイドとなる既植苗の列
条が走行機体Aの左側にある場合には、該レバ12を左
方向に回動操作して、左側のマーカ10を機体Aの左側
に突出させる。
作業者は、左側に突出された前記マーカ10を視認しつ
つ、これが、前行程において植付けた苗株の列条の内、
最も右側に位置する列条の直上に位置するようにハンド
ル15を操作して、走行機体Aの大略の位置決めを行っ
た後、更に、苗検出ランプ63を視認しつつ、これが点
灯されるまでハンドル15を操作して、走行機体への初
期位置設定を行えば、その後は、前記列条中に所定の間
隔にて植付けられている苗が、苗列撮像装置2OLによ
って連続的に撮像され、この撮像結果に基づく画像処理
部22及び操向制御部50の後述の動作により、所定の
基準位置Xo(本実施例においてはカラービデオカメラ
20Laの撮像範囲の中心線)に前記苗が常に位置する
ように走行機体Aは自動操向される。
第10図は画像処理部の制御内容を示すフローチャー1
・であり苗列撮像装置2OLによって既植苗が撮像され
ると、画像処理部22は、カラービデオカメラ20La
の画像情報であるビデオカメラ人力信号を設定タイミン
グ毎に取り込みカメラ入力信号変換部222にて赤色信
号、緑色信号、青色信号の各色信号R,G、Bに分離す
る。ごれを全ての画素について行うのであるが、縦横2
56画素×256画素−65,53636画素いて行う
と計算時間に多大な時間を要するので、縦横32画素×
32画素−1024画素について行う。即ち8画素毎に
サンプリングして前記各信号R,G、Bを分離する(ス
テップ1)。
次に分前された各画素の各色信号R,G、Bにより下記
条件式を用い、画像1ft報を2値化演算部225で2
値化し、苗による画素を抽出する(ステップ2)。
G>1?かつG>8かつG>0.38(R+G 十B)
・・(1)上記条件式(1)は各色信号R,G、Bの値
を闇値を用いず2値化するために発明されたものであり
、これにより時刻毎に変化する外乱光の明暗等の外部条
件に応じた闇値の変更が不要となった。
次に得られた2値化画像の抽出及び直線近似の手段につ
いて説明する。第11図は2硫化された画像を撮像画面
に表示した模式図であり、撮像画面の中心0を原点とし
進行方向をy軸止方向とし、また左右方向をX軸方向と
なしている。またXOは前記基準位置を示し、本実施例
ではy軸と一致している。さらにa −gは2値化され
た画像を示しており、各画像a、b・・・の添字は各画
素を示している。
画像a、b・・・が2値化されると、第11図左」二よ
り32 X 32画素を走査し、上から順に画素αを抽
出する (第11図では画素a、)。次に抽出された画
素αと下記の条件の範囲にある画素βを全て抽出する(
ステップ3)。
いま画素αのx、  y座標を夫々Xヶ、Yty−画素
βのx、y座標を夫々Xβ、yBとすると、条外式を下
記の如く設定する。
l x、−xβ1≦4         ・・・(2)
y、y−yβ≧8          ・・・(3)一
般に既植苗に倣う田植作業を行う場合、田植機の進行方
向に対して既植苗の苗列の傾きは小さく、また菌株毎の
画像に表われた直線成分は苗株の長さはほぼ一定長以下
なので、ある一定画素以下となる。これらのことより前
記条件式(2)にて傾きの小さな画素を抽出し、条件式
(3)にて同一菌株を抽出するのを防止し、苗株の直線
成分が近似直線に影響を与えないようにしている。本実
施例では上記条件式(2)、 (3)にて画素す、〜b
5.d、〜d4が抽出され、画素C+ 〜”s +  
e、c、、rl、r2゜g+、g2は抽出されない。次
の画素α(第11図では画素a2)について同しように
条件式(2) (3)を用いて画素βを抽出し、この動
作を画素βが抽出不可となるまで繰返す(ステップ4)
次にハフ変換部227にて画素αと抽出された画素βと
を結ぶ線分を算出し、その線分の数n、その線分と中心
Oとの距離ρ0.ρ2・・・及びその角度θ3.θ2・
・・を求める(ステップ5)。
次に線分の数nが零かどうかを判定しくステップ6)、
零のときは画面を一定量回転しくステップ7)再度ステ
ップ5を実行する。零以外のときは次に進み、求められ
た距離ρ1.ρ2・・・及び角度θ8.θ2・・・の夫
々の平均値を求め、求められた距離をρ、角度をθとす
ると、このρが求めるハフ値となりθがその角度となる
。そして、このハフ値ρ及び角度θの算出を設定タイミ
ング毎に演算する(ステップ8)。
画像処理部22が設定タイミング毎にハフ値ρ及び角度
θを算出するとその値が操向制御部50に出力される(
ステップ9)。
このように本実施例においては、32画素にて画像をサ
ンプリングし色信号を分離しているので演算速度を高速
化でき、2植化を闇値を使用せずに行っているので、外
乱光等の明暗による闇値の変更等の設定動作を不要とな
し、また2値化した画素のうち所定の範囲画素距離を有
する画素を抽出し、直線近似しているので、苗列の直線
成分の画素及びノイズ等の苗取外の画素に直線近位が影
響を受けることがない。
通常ハフ値を用いる自動操向制御では得られた画像上の
ハフ値ρ及び角度θを圃面」二のハフ値ρ。
及び角度θ。(第4図参照)に換算し、それにより求め
た目標操舵角と操舵角センサ38で得られたディジタル
データとを比較して操向制御するのであるが、前記自動
操向制御では圃面上へのハフ値の換算に多くの旧算を必
要とするので、本発明装置では、撮像画面の機体の進行
方向に2つの距離不感帯と3つの角度不感帯とを設けて
操向制御する。第12図は撮像画面に設けられた距離不
感帯の一例を示す模式図であり、第11図と同一の座標
をとっている。距離不感帯はX軸力向にXp、χmのX
p 範囲の第1距離不感帯とその半分X ph −−。
χmh−□の範囲の第2距離不感帯とを機体の進行方向
に設けている。
第13回は各別の不感帯を用いた自動操向の一例を示す
フローチャートである。ハフ値ρ及びその角度θが設定
タイミング毎に操向制御部50に人力されると、そのハ
フ値ρが第1距離不感帯内に入っているかどうか判定し
くステップ1)、入っていればさらに第2距則不感帯内
に入っているかどうか判定する(ステップ2)。第2距
離不感帯に入っていると判定されると、角度θが第1角
度不感帯である進行方向から±2゛2内かどうか判定し
くステップ3)、±2°以内であれば、操舵角センサ3
8の出力電圧により操舵角■θを読込み(ステップ4)
、操舵角■θが直進位置から±j。
以内かどうかを判定しくステップ5)、±1°以内であ
れば操向制御を終了し、操舵角■θが±1゜を超えてい
る場合は、右方向に超えているのか(ステップ6)左方
向に超えているのか(ステップ7)を判定し、右方向に
超えている場合は操向制御部50の出力ポートb1をハ
イレベルとなし、ソレノイドS℃をオンする(ステップ
8)、左方向に超えている場合は操向制御部50の出カ
ポ−)bzをハイレベルとなし、ソレノイドSrをオン
する(ステップ9)。そしてこの動作を操舵角■θが直
進位置の±1゛1内になるまで反復し、±1゜以内にな
ると操向制御部50の出カポ−)b+及び同b2を共に
ローレベルとなしソレノイドSN及び同Srを共にオフ
する(ステップ10)。その後ステップ5にて再度操舵
角■θが直進位置の±1゜以内かどうか判定する。
一方ステンプ2でハフ値ρが第2距離不感帯に入ってい
ない場合は、角度θが第2角度不感帯である進行方向か
ら±1°以内かどうか判定され(ステップ11)、±1
°以内であればステップ4に進む。またステップ1で第
1距離不感帯にハフ値ρカ入っていない場合、ステップ
11で角度θが±1°を超える場合、又はステップ3で
角度θが±2′を超える場合は角度θが第3角度不感帯
である進行位置から±8°より大きいかどうか判定され
(ステップ12)、角度θが±8°より大きい場合は角
度θが正か(ステップ13)、負か(ステップ14)を
判定し、角度θが正のときは、走行機体Aが苗列に対し
て左に傾きすぎているので操向制御部50の出力ポート
b2をハイレベルとなしツレノイドSrをオンしくステ
ップ15)、負の場合は出力ポートb、をハイレベルと
なしソレノイドS12をオンする(ステップ16)。そ
してこれを角度θが±8°以内となるまで反復する。角
度θが±8゛8内のときは、操舵角■θを読み取り(ス
テップ17)、角度θが操舵角■θ±1°の範囲内かど
うか判定され(ステップ18)、範囲内であれば、操向
制御部50の出力ポートb1及び同b2を共にローレベ
ルとなしソレノイドSI!、及び同Srを共にオフしく
ステップ19)、操向制御を終了する。また範囲外であ
れば、ステップ13に進み前述したごとくソレノイドS
r又はSI!、をオンし、操舵角■θ±1°が角度θの
範囲内となるまで反復する。
前述したごとく本発明装置においては、角度及び距離不
感帯を複数設け、それとハフ値ρ及び角度θの大小関係
に基づき自動操向しているので、ハフ値ρ及び角度θを
実際の走行基準線Xoに対する偏差及び傾きに換算する
必要がなく、その計算が大幅に簡略化できる。
一方、前記2値化演算部225により、2値化が不能の
場合、又は画素抽出部226にて画素が抽出不能の場合
、操向制御部50は、ぞの制御動作を直ちに停止すると
共に、出力ボートb、□b6をハイレベルとして、警報
ランプ64を点灯させ、警報ブリ′65を鳴動させて作
業者Gこ自動操向が不可能であることを報知する。
また操向制御部50は、前述の如き制御動作を行ってい
る間にその人カポ−1−a +、のレベルを常時監視し
ており、該人力ボートa6がハイレベルに転した場合に
は、作業者によりハンドル15の手動操作がなされたと
判断し、この操作による操舵を優先すべく、操向制御動
作を直らに停止する。そしてこの停止は、ハンドル]5
の操作が終了し、前記入力ボートa、1がローレベルに
復帰してから所定時間経過後に解除され、これ以後、操
向制御部50は前述の制御動作を継続して行う。
尚本実施例では苗列撮像装置としてカラービデオカメラ
を用いたが、本発明はこれに限るものではなく、苗株を
検出でき、それを2値化できる撮像装置であれば何でも
よい。
また本実施例では基準位置を撮像画面の進行方向の中心
線とし、ハフ値及びその角度を撮像画面であればどこで
もよい。
さらに本実施例では第2不感帯を第1不感帯の半分の範
囲としたが本発明はこれに限るものではなく、第1不感
帯及び第2不惑帯の範囲は撮像画面内に任意の幅で設定
可能である。
さらにまた本実施例では田植機に本発明装置を適用した
が、本発明はこれに限るものではなく、コンバイン、杭
打機等の他の作業用車両にも適用可能であることば言う
までもない。
〔効果〕
以上詳述した如く、本発明装置においては、境界撮像装
置である苗列撮像装置の1最像画面に設けた距離及び角
度の各別の複数の距離不感帯及び角度不感帯と距離及び
角度との大小関係に基づき自動操向しているので、自動
操向の演算時間を短縮でき、メモリ容量を小さくできる
と共に、二次元的に境界である苗株を検出しているので
苗列に対する機体の追従性及び苗株の検出精度が向上し
、安定した自動操向装置を提供できる等価れた効果を奏
する。
【図面の簡単な説明】
図面は本発明の一実施例を示すものであり、第1図は本
発明装置を装備した乗用田植機の側面図、第2図はその
平面図、第3図は苗列撮像装置の拡大側面図、第4図は
その平面図、第5図は作業選択レバの操作位置説明のた
めの平面図、第6図は前輪の操舵機構の模式的平面図、
第7図は操舵角センサの操舵角と出力電圧との関係を示
すグラフ、第8図は本発明装置の構成を示すブロック図
、第9図は画像処理部の構成を示すブロック図、第10
図は画像処理部の制御内容を示すフローチャート、第1
1図は撮像画面の2値化された画像を示す模式図、第1
2図は撮像画面に設けた不感帯の一例を示す模式図、第
13図は不感帯を用いた自動操向の一例を示すフローチ
ャー1・である。

Claims (1)

  1. 【特許請求の範囲】 1、未作業域と既作業域の境界に倣い自動操向する作業
    用車両の自動操向装置において、前記境界を撮像する境
    界撮像装置と、 該境界撮像装置で撮像された画像から前記境界を抽出し
    、直線近似する手段と、 該手段により求められた線分と画像における機体の進行
    方向に設定してある基準線とのなす角度及び画像の所定
    位置における前記線分と基準線との距離を算出する手段
    と、 該手段により算出された前記角度及び前記距離と、前記
    基準線に対して所定の角度を有して設けられた複数の角
    度不感帯及び前記基準線に対して所定の幅を有して設け
    られた複数の距離不感帯との各別の関係に基づき自動操
    向する手段と を具備することを特徴とする作業用車両の自動操向装置
JP63101032A 1988-04-22 1988-04-22 作業用車両の自動操向装置 Pending JPH01269407A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP63101032A JPH01269407A (ja) 1988-04-22 1988-04-22 作業用車両の自動操向装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP63101032A JPH01269407A (ja) 1988-04-22 1988-04-22 作業用車両の自動操向装置

Publications (1)

Publication Number Publication Date
JPH01269407A true JPH01269407A (ja) 1989-10-26

Family

ID=14289831

Family Applications (1)

Application Number Title Priority Date Filing Date
JP63101032A Pending JPH01269407A (ja) 1988-04-22 1988-04-22 作業用車両の自動操向装置

Country Status (1)

Country Link
JP (1) JPH01269407A (ja)

Similar Documents

Publication Publication Date Title
JPH01269407A (ja) 作業用車両の自動操向装置
JP2594098B2 (ja) 移植機の自動操向装置
JP2649908B2 (ja) 移植機の自動操向装置におけるノイズ除去装置
JP2505403Y2 (ja) 移植機の自動操向装置
JP2521961Y2 (ja) 移植機の自動操向装置
JPH0729777Y2 (ja) 移植機の自動操向装置
JP2594097B2 (ja) 移植機の自動操向装置
JP2673565B2 (ja) 移植機の自動操向装置
JP2715132B2 (ja) 移植機の自動操向装置
JPH0614611A (ja) 作物列検出装置
JP2502981Y2 (ja) 田植機における作物列検出画像処理装置
JP2594102B2 (ja) 作業用車両の自動操向装置
JP2684024B2 (ja) 作業用車両の自動操向装置
JP2673563B2 (ja) 移植機の自動操向装置
JPH0746084Y2 (ja) 作業用車両の自動操向装置
JP2715136B2 (ja) 移植機の自動操向装置
JP2599957B2 (ja) 作業用車両の自動操向装置
JP2715133B2 (ja) 移植機の自動操向装置
JP2649907B2 (ja) 移植機の自動操向装置
JPH01269406A (ja) 作業用車両の自動操向装置
JPH02154606A (ja) 移植機の自動操向装置
JPH01243910A (ja) 移植機の自動操向装置
JPH02235115A (ja) 作物検出用2値化装置
JPH09224415A (ja) 作業車の方向検出装置、走行状態表示装置、及び走行制御装置
JP2710644B2 (ja) 農作業機における自動操舵制御装置