JPS6233606B2 - - Google Patents
Info
- Publication number
- JPS6233606B2 JPS6233606B2 JP57060214A JP6021482A JPS6233606B2 JP S6233606 B2 JPS6233606 B2 JP S6233606B2 JP 57060214 A JP57060214 A JP 57060214A JP 6021482 A JP6021482 A JP 6021482A JP S6233606 B2 JPS6233606 B2 JP S6233606B2
- Authority
- JP
- Japan
- Prior art keywords
- light receiving
- light
- receiving device
- row
- 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.)
- Expired
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0234—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
- G05D1/0236—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons in combination with a laser
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Optics & Photonics (AREA)
- Electromagnetism (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
【発明の詳細な説明】
本発明は、所定位置に配置された投光装置から
発光されるビーム光を受光するための複数個の受
光素子を受光面に配設してある受光装置を車体に
設け、この受光装置の受光面における受光位置検
出結果に基いて走行方向を自動制御すべく構成し
てある作業車に関する。
発光されるビーム光を受光するための複数個の受
光素子を受光面に配設してある受光装置を車体に
設け、この受光装置の受光面における受光位置検
出結果に基いて走行方向を自動制御すべく構成し
てある作業車に関する。
従来より、芝刈作業車等の作業車を所定方向に
自動的に直進走行させるために、レーザー等のビ
ーム光を一定方向に投光する投光装置を所定位置
に配置するとともに、このビーム光を受ける受光
装置を車体に設けて、前記ビーム光により誘導し
て作業車の走行方向を自動制御する手段が採用さ
れている。
自動的に直進走行させるために、レーザー等のビ
ーム光を一定方向に投光する投光装置を所定位置
に配置するとともに、このビーム光を受ける受光
装置を車体に設けて、前記ビーム光により誘導し
て作業車の走行方向を自動制御する手段が採用さ
れている。
しかしながら、特にレーザー光はその特性上小
さなビームで直進する性質のものであるから、作
業車が走行する地面の状態によつて車体が上下揺
動すると、前記受光装置による安定した受光がで
きなくなり、正確な走行方向の自動制御ができな
くなるとう欠点が有つた。
さなビームで直進する性質のものであるから、作
業車が走行する地面の状態によつて車体が上下揺
動すると、前記受光装置による安定した受光がで
きなくなり、正確な走行方向の自動制御ができな
くなるとう欠点が有つた。
本発明は、かかる従来欠点を解消することを目
的とするもので、前記受光素子が受光面にマトリ
クス状に配列されており、かつ、上下方向中央部
の基準列にある受光素子以外の受光素子でビーム
光を受光した場合には、前記基準列の受光素子で
ビーム光を受光するように、前記受光装置を前記
作業装置とは別に車体に対して自動的に昇降制御
すべく構成してあることを特徴とする。
的とするもので、前記受光素子が受光面にマトリ
クス状に配列されており、かつ、上下方向中央部
の基準列にある受光素子以外の受光素子でビーム
光を受光した場合には、前記基準列の受光素子で
ビーム光を受光するように、前記受光装置を前記
作業装置とは別に車体に対して自動的に昇降制御
すべく構成してあることを特徴とする。
上記特徴構成によれば、作業車が走行地面に凹
凸が有つて車体が上下揺動したり、地面の高低に
より走行機体が投光装置からのビーム光高さに対
して上下動しても、車体に設けられた受光装置が
前記車体の上下動を打消すように自動的に昇降さ
れ、常に安定した受光ができるので、作業車の正
確な走行方向制御が行なえるようになつたのであ
る。殊に、常に受光面における上下方向中央部の
基準列に位置する受光素子で受光するように制御
していることから、車体が多少上下に揺動、ある
いは、傾斜地を移動しても、ビーム光が受光面か
ら外れてしまうという不都合を可及的に抑制しな
がら作業を続行できるという効果がある。
凸が有つて車体が上下揺動したり、地面の高低に
より走行機体が投光装置からのビーム光高さに対
して上下動しても、車体に設けられた受光装置が
前記車体の上下動を打消すように自動的に昇降さ
れ、常に安定した受光ができるので、作業車の正
確な走行方向制御が行なえるようになつたのであ
る。殊に、常に受光面における上下方向中央部の
基準列に位置する受光素子で受光するように制御
していることから、車体が多少上下に揺動、ある
いは、傾斜地を移動しても、ビーム光が受光面か
ら外れてしまうという不都合を可及的に抑制しな
がら作業を続行できるという効果がある。
以下、本発明の実施例を図面に基いて説明す
る。
る。
第1図は、レーザー光による芝刈作業車3の走
行方向制御における投光装置1と受光装置4の関
係を示す略示側面図である。
行方向制御における投光装置1と受光装置4の関
係を示す略示側面図である。
地上の所定位置に配置された投光装置1から一
定方向にビーム状のレーザー光2を投光する。こ
のレーザー光2を機体の中央部に作業装置として
の芝刈装置Aを装着した芝刈作業車3の前部に設
けられた受光装置4により受光する。この受光装
置4の受光面には多数の受光素子S…がマトリク
ス状に配列されており、後記するように、どの受
光素子Sがビーム光2を受光したかの検出結果に
基いて、前記芝刈作業車3がビーム光2に沿うよ
うに誘導されて所定方向に走行すべく自動制御さ
れながら芝刈作業を行なうものである。
定方向にビーム状のレーザー光2を投光する。こ
のレーザー光2を機体の中央部に作業装置として
の芝刈装置Aを装着した芝刈作業車3の前部に設
けられた受光装置4により受光する。この受光装
置4の受光面には多数の受光素子S…がマトリク
ス状に配列されており、後記するように、どの受
光素子Sがビーム光2を受光したかの検出結果に
基いて、前記芝刈作業車3がビーム光2に沿うよ
うに誘導されて所定方向に走行すべく自動制御さ
れながら芝刈作業を行なうものである。
第2図および第3図は前記受光装置4の構造を
略示した正面図および側面図である。
略示した正面図および側面図である。
前記芝刈作業車3の前フレーム5部において支
持フレーム6により支持された受光装置4を設け
てあり、この受光装置4は、前述のように、その
受光面に行方向A1〜A5列方向B1〜B5に夫々マト
リクス状に配列された複数個の受光素子S…によ
り構成され、中央部A3,B3に配設された受光素
子Sを基準受光位置とするものである。
持フレーム6により支持された受光装置4を設け
てあり、この受光装置4は、前述のように、その
受光面に行方向A1〜A5列方向B1〜B5に夫々マト
リクス状に配列された複数個の受光素子S…によ
り構成され、中央部A3,B3に配設された受光素
子Sを基準受光位置とするものである。
さらに、前記受光装置4はその支持フレーム6
がモータ7によりギヤボツクス8を介して駆動さ
れて昇降自在に支持されている。
がモータ7によりギヤボツクス8を介して駆動さ
れて昇降自在に支持されている。
尚、前記ギヤボツクス8の1回転による受光装
置4の昇降に伴う受光位置の移動距離は前記マト
リクス状に配設した受光素子Sの1列分(例え
ば、B1とB2の間隔)に対応すべく構成されてい
る。
置4の昇降に伴う受光位置の移動距離は前記マト
リクス状に配設した受光素子Sの1列分(例え
ば、B1とB2の間隔)に対応すべく構成されてい
る。
また、前記ギヤボツクス8には1回転毎に回転
数を検出して受光装置4の移動量を検出する位置
検出センサー9が設けられている。
数を検出して受光装置4の移動量を検出する位置
検出センサー9が設けられている。
以下、上述の構成による受光装置4の受光位置
制御機構および車体の走行方向制御機構の動作を
第4図に示したブロツク図に基いて説明する。
制御機構および車体の走行方向制御機構の動作を
第4図に示したブロツク図に基いて説明する。
上下方向(列方向)の受光位置検出のために、
同一列上のA1〜A5の受光素子出力を各列B1〜B5
毎に論理和OR処理をして演算装置10にI/0
ポート11を介して入力する。
同一列上のA1〜A5の受光素子出力を各列B1〜B5
毎に論理和OR処理をして演算装置10にI/0
ポート11を介して入力する。
一方、同様にして左右方向(行方向)の受光位
置検出のために同一行上のB1〜B5の受光素子出
力を各行A1〜A5毎に論理和OR処理をして演算装
置10にI/0ポート11を介して入力する。
置検出のために同一行上のB1〜B5の受光素子出
力を各行A1〜A5毎に論理和OR処理をして演算装
置10にI/0ポート11を介して入力する。
さらに、前記ギヤボツクス8に設けた位置検出
センサー9の出力を前記I/0ポート11を介し
て演算装置10に入力する。
センサー9の出力を前記I/0ポート11を介し
て演算装置10に入力する。
前記演算装置10は前記I/0ポート11、
CPU12およびメモリ13から構成され、メモ
リ13に記憶されたプログラムに従つて、前記
I/0ポート11を介して入力される受光装置4
の受光されている受光素子位置に基いて、I/0
ポート11を介して前記モータ7および後記走行
方向を制御するためのステアリング用ソレノイド
バルブ14を制御する信号を出力する。
CPU12およびメモリ13から構成され、メモ
リ13に記憶されたプログラムに従つて、前記
I/0ポート11を介して入力される受光装置4
の受光されている受光素子位置に基いて、I/0
ポート11を介して前記モータ7および後記走行
方向を制御するためのステアリング用ソレノイド
バルブ14を制御する信号を出力する。
まず、受光装置4の自動昇降による受光位置制
御機構について以下詳細に説明する。
御機構について以下詳細に説明する。
前記芝刈作業車3の走行に伴つて投光装置1か
らのレーザー光2が受光装置4の基準受光素子列
B3以外の受光素子S、例えばB2列上で受光され
た場合には、前記演算装置10のCPU12によ
り列方向に1位置上方へ受光位置が変化したこと
を感知する。
らのレーザー光2が受光装置4の基準受光素子列
B3以外の受光素子S、例えばB2列上で受光され
た場合には、前記演算装置10のCPU12によ
り列方向に1位置上方へ受光位置が変化したこと
を感知する。
そして、前記モータ7を正回転させる信号を
I/0ポート11により出力して、前記位置検出
センサー9により1列分の移動量を検出するまで
受光装置4を上昇させる。
I/0ポート11により出力して、前記位置検出
センサー9により1列分の移動量を検出するまで
受光装置4を上昇させる。
同様にして、B1列上の受光素子Sで受光され
た場合には、前記位置検出センサー9により2列
分の移動量を検出するまでのモータ7を正回転す
る。
た場合には、前記位置検出センサー9により2列
分の移動量を検出するまでのモータ7を正回転す
る。
さらに、前記基準列B3より下方のB4またはB5
列上で受光された場合には、夫々、所定の列分受
光装置4を下降させるべくモータ7を逆回転させ
る。
列上で受光された場合には、夫々、所定の列分受
光装置4を下降させるべくモータ7を逆回転させ
る。
このようにして、芝刈作業車3がその走行状態
により上下方向に揺動した場合でも、自動的に受
光装置4を昇降させることにより、常に基準列
B3上の受光素子Sで投光装置1からのレーザー
光2を受光できるのである。
により上下方向に揺動した場合でも、自動的に受
光装置4を昇降させることにより、常に基準列
B3上の受光素子Sで投光装置1からのレーザー
光2を受光できるのである。
次に、左右方向すなわち前記受光装置4の行方
向A1〜A5に受光素子位置がずれた場合、芝刈作
業車3の操行車輪15,15のステアリング制御
による走行方向制御機構について以下詳細に説明
する。
向A1〜A5に受光素子位置がずれた場合、芝刈作
業車3の操行車輪15,15のステアリング制御
による走行方向制御機構について以下詳細に説明
する。
前記芝刈作業車3の走行に伴つて、投光装置1
からのレーザー光2が受光装置4の基準受光素子
行A3以外の受光素子S、例えばA2行上で受光さ
れた場合には、前記演算装置10のCPU12に
より行方向に1位置右に受光装置が変化したこと
を感知する。
からのレーザー光2が受光装置4の基準受光素子
行A3以外の受光素子S、例えばA2行上で受光さ
れた場合には、前記演算装置10のCPU12に
より行方向に1位置右に受光装置が変化したこと
を感知する。
そして、I/0ポート11よりバツフア16,
16′を介して、前記ステアリング用ソレノイド
バルブ14を所定量左ステアリングさせるべくパ
ルス駆動して機体を左方向へ方向制御する。
16′を介して、前記ステアリング用ソレノイド
バルブ14を所定量左ステアリングさせるべくパ
ルス駆動して機体を左方向へ方向制御する。
同様にして、A1行上で受光を感知した場合に
は、2位置に対応する所定量左方向へステアリン
グさせるべく、前記ソレノイドバルブ14を駆動
する。
は、2位置に対応する所定量左方向へステアリン
グさせるべく、前記ソレノイドバルブ14を駆動
する。
また、基準行A3より左方向(A4行,A5行)に
受光装置がずれた場合は、前記とは逆にそれぞれ
対応する所定量右へステアリングさせるべく前記
ソレノイドバルブ14を駆動する。
受光装置がずれた場合は、前記とは逆にそれぞれ
対応する所定量右へステアリングさせるべく前記
ソレノイドバルブ14を駆動する。
このようにして、芝刈作業車3がその走行状態
により左右に走行方向がずれた場合でも、自動的
にそのずれた量に対応して逆方向に車体を自動的
にステアリング制御することにより、芝刈作業車
3は前記レーザー光2に誘導されて直進走行する
のである。
により左右に走行方向がずれた場合でも、自動的
にそのずれた量に対応して逆方向に車体を自動的
にステアリング制御することにより、芝刈作業車
3は前記レーザー光2に誘導されて直進走行する
のである。
図面中、17は油圧ポンプ、18は油圧シリン
ダである。
ダである。
第5図は前記演算装置10の受光位置制御およ
び走行方向制御の動作を示すフローチヤートであ
る。
び走行方向制御の動作を示すフローチヤートであ
る。
第6図は受光素子Sの構造を示す側断面図で、
筒状体19の前方内部に設けられたレンズ20に
より集束した光を前記筒状体19の底部に配設さ
れたフオトダイオードS′により受光し、このダイ
オードS′の出力を検波器21により検波して演算
装置10にレーザー光検出信号を出力する構成と
されている。
筒状体19の前方内部に設けられたレンズ20に
より集束した光を前記筒状体19の底部に配設さ
れたフオトダイオードS′により受光し、このダイ
オードS′の出力を検波器21により検波して演算
装置10にレーザー光検出信号を出力する構成と
されている。
第7図は前記受光素子Sの他の実施例を示す平
断面図で、前記筒状体19の底部を湾曲させ、こ
の湾曲面に複数個のフオトダイオードS′…を配設
した構成とされている。
断面図で、前記筒状体19の底部を湾曲させ、こ
の湾曲面に複数個のフオトダイオードS′…を配設
した構成とされている。
このように、フオトダイオードS′…を複数設け
た場合は、さらに細かい車体揺動が検出できるの
で、より正確な車体の直進走行制御ができるので
ある。
た場合は、さらに細かい車体揺動が検出できるの
で、より正確な車体の直進走行制御ができるので
ある。
図面は本発明に係る走行方向制御センサー付作
業車の実施例を示し、第1図は投光装置と受光装
置の関係を示す略示側面図、第2図は受光装置構
造の略示正面図、第3図は受光装置構造の略示側
面図、第4図は制御機構のブロツク図、第5図は
そのフローチヤート、第6図は受光素子の構造を
示す側断面図、そして第7図は受光素子の別実施
例を示す平断面図である。 1……投光装置、2……ビーム光、3……作業
車、4……受光装置、A……作業装置、S……受
光素子、B3……基準列。
業車の実施例を示し、第1図は投光装置と受光装
置の関係を示す略示側面図、第2図は受光装置構
造の略示正面図、第3図は受光装置構造の略示側
面図、第4図は制御機構のブロツク図、第5図は
そのフローチヤート、第6図は受光素子の構造を
示す側断面図、そして第7図は受光素子の別実施
例を示す平断面図である。 1……投光装置、2……ビーム光、3……作業
車、4……受光装置、A……作業装置、S……受
光素子、B3……基準列。
Claims (1)
- 1 走行車体に対して、作業装置Aを装備させる
とともに、地上の所定位置に配置された投光装置
1から発光されるビーム光2を受光するための複
数個の受光素子S…を受光面に配設してある受光
装置4を設け、この受光装置4の受光面における
受光位置検出結果に基いて走行方向を自動制御す
べく構成してある作業車であつて、前記受光素子
S…が受光面にマトリクス状に配列されており、
かつ、上下方向中央部の基準列B3にある受光素
子S…以外の受光素子S…でビーム光2を受光し
た場合には、前記基準列B3の受光素子S…でビ
ーム光2で受光するように、前記受光装置4を前
記作業装置Aとは別に車体に対して自動的に昇降
制御するべく構成してあることを特徴とする走行
方向制御センサー付作業車。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP57060214A JPS58176711A (ja) | 1982-04-10 | 1982-04-10 | 走行方向制御センサ−付作業車 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP57060214A JPS58176711A (ja) | 1982-04-10 | 1982-04-10 | 走行方向制御センサ−付作業車 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPS58176711A JPS58176711A (ja) | 1983-10-17 |
| JPS6233606B2 true JPS6233606B2 (ja) | 1987-07-22 |
Family
ID=13135679
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP57060214A Granted JPS58176711A (ja) | 1982-04-10 | 1982-04-10 | 走行方向制御センサ−付作業車 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPS58176711A (ja) |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| ES2244301B2 (es) * | 2003-12-02 | 2008-02-16 | Universidad De La Laguna | Dispositivo de bajo coste para la localizacion de robots autonomos. |
| US8874371B2 (en) * | 2011-08-09 | 2014-10-28 | The Boeing Company | Beam directed motion control system |
| EP2859423B1 (en) | 2012-06-07 | 2016-01-06 | Koninklijke Philips N.V. | System and method for guiding a robot cleaner along a path |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS5652234A (en) * | 1979-10-01 | 1981-05-11 | Komatsu Ltd | Controller for travelling of construction equipment |
-
1982
- 1982-04-10 JP JP57060214A patent/JPS58176711A/ja active Granted
Also Published As
| Publication number | Publication date |
|---|---|
| JPS58176711A (ja) | 1983-10-17 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US4603753A (en) | Automatic running work vehicle | |
| US12279549B2 (en) | Robotic work tool and method for improved collision handling | |
| JP5664634B2 (ja) | 田植機 | |
| JPH0583403B2 (ja) | ||
| JPS6233606B2 (ja) | ||
| JP2021026348A (ja) | 作業車両 | |
| JPS5922106A (ja) | 自動走行車輛 | |
| JPH0241282B2 (ja) | ||
| JPH0331401B2 (ja) | ||
| JP2506158B2 (ja) | ビ―ム光利用の作業車誘導装置 | |
| JPH0216607A (ja) | ビーム光利用の作業車誘導装置 | |
| JPS6242658Y2 (ja) | ||
| JP2556472Y2 (ja) | 乗用田植機の植付部姿勢制御装置 | |
| JP2674164B2 (ja) | トラクタ等の作業水準制御センサ | |
| JPS62275603A (ja) | コンバイン等の走向制御方式 | |
| JPH0366682B2 (ja) | ||
| JPH0324009Y2 (ja) | ||
| JP2573958B2 (ja) | 田植え機誘導用のビ−ム光検出装置 | |
| JPH01188907A (ja) | ビーム光誘導装置 | |
| JPS6245534Y2 (ja) | ||
| KR20210149913A (ko) | 자율주행장치 | |
| JP2024092638A (ja) | 作業車両の作業管理システム | |
| JPH0323925B2 (ja) | ||
| JP2568404B2 (ja) | 光ビームを用いた無人車の誘導装置 | |
| JPH0323923B2 (ja) |