JPS62214408A - 自走車両の方向制御装置 - Google Patents
自走車両の方向制御装置Info
- Publication number
- JPS62214408A JPS62214408A JP61058571A JP5857186A JPS62214408A JP S62214408 A JPS62214408 A JP S62214408A JP 61058571 A JP61058571 A JP 61058571A JP 5857186 A JP5857186 A JP 5857186A JP S62214408 A JPS62214408 A JP S62214408A
- Authority
- JP
- Japan
- Prior art keywords
- reflecting
- light beam
- self
- reflected
- reflected light
- 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
Links
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 206010013642 Drooling Diseases 0.000 description 1
- 208000008630 Sialorrhea Diseases 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 238000000034 method Methods 0.000 description 1
- 230000003134 recirculating effect Effects 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
〔曜業上の利用分野〕
この発明は、トラクタ、コンバイン、自動車等の自走車
両の方向制御装置に関するもので、走行方向に対して左
右夫々互に間隔を置いて配電された反射柱体に対する走
行方向を検出することにより、自走車両の走行方向が簡
易に算出し制御されるように構成したものであって、ト
ラクタ等の上記自走車両に利用できる。
両の方向制御装置に関するもので、走行方向に対して左
右夫々互に間隔を置いて配電された反射柱体に対する走
行方向を検出することにより、自走車両の走行方向が簡
易に算出し制御されるように構成したものであって、ト
ラクタ等の上記自走車両に利用できる。
方向制御装置として従来のものは、特定の数個所の定点
からレーザービーム等を発射して一自走車両側に設けら
れた受信部が、成る移動時間中の受信方位の変化に基づ
いて進行方位と現在位置を算するものが広く用いられて
いる。
からレーザービーム等を発射して一自走車両側に設けら
れた受信部が、成る移動時間中の受信方位の変化に基づ
いて進行方位と現在位置を算するものが広く用いられて
いる。
ところが上記従来の装置は、定点におけるレーザービー
ムの発射設備及び受信設備が複雑で高価となって低コス
ト化が要求される例えばトラクタ等の自走車両には実用
化がむつかしいと云う問題がある。
ムの発射設備及び受信設備が複雑で高価となって低コス
ト化が要求される例えばトラクタ等の自走車両には実用
化がむつかしいと云う問題がある。
この発明は、方向検出のための発信及び受信設備が充分
に簡単なものとなるように工夫したものであって、その
構成は、自走車両(1)だ設けられて光ビームを回動し
て走査する光ビーム走査手段(7)と、自走車両(1)
の走行方向に対して左右に夫々互に間隔をおいて配置さ
れ、上記光ビームを光ビーム走査手段(7)の方向に向
って反射するように設けられた反射柱体18+(8)と
、夫々の反射柱体(8)(8)からの反射光を受光する
ように上記光ビーム走査手段(7)と共に回動するよう
設けられた反射光受光手段aυと、上記夫々の反射柱体
f81(8)からの反射光の受光時間差を検出して、自
走車両(1)の走行方向に対する左右夫々の反射柱体(
8)(8)がなす夫々の交角(Al)(Bりを算出する
交角算出手段■と、このようにして算出された夫々の交
角を、左右の反射柱体(8)(8)間に位置する走行目
標点(pro)に対する目標交魚ル)(白りに一致させ
るべく、自走車両(1)に舵取指令を出力する走行方向
制御部(至)とを有していることを特徴とする自走車両
の方向制御装置である。
に簡単なものとなるように工夫したものであって、その
構成は、自走車両(1)だ設けられて光ビームを回動し
て走査する光ビーム走査手段(7)と、自走車両(1)
の走行方向に対して左右に夫々互に間隔をおいて配置さ
れ、上記光ビームを光ビーム走査手段(7)の方向に向
って反射するように設けられた反射柱体18+(8)と
、夫々の反射柱体(8)(8)からの反射光を受光する
ように上記光ビーム走査手段(7)と共に回動するよう
設けられた反射光受光手段aυと、上記夫々の反射柱体
f81(8)からの反射光の受光時間差を検出して、自
走車両(1)の走行方向に対する左右夫々の反射柱体(
8)(8)がなす夫々の交角(Al)(Bりを算出する
交角算出手段■と、このようにして算出された夫々の交
角を、左右の反射柱体(8)(8)間に位置する走行目
標点(pro)に対する目標交魚ル)(白りに一致させ
るべく、自走車両(1)に舵取指令を出力する走行方向
制御部(至)とを有していることを特徴とする自走車両
の方向制御装置である。
自走車両(1)の光ビーム走査手段(7)から発射され
た光ビームは、まず1方の反射柱体(8)にて反射さ幻
て直ちに反射光受光手段αDにて受光され、成る時間を
経過したとぎ、他方の反射柱体(8)にて反射されて直
ちに反射光受光手段0υにて受光されるので、自走車両
(1)の進行方向に対する左右夫々の反射柱体f8)(
8)が有している左右の交角(ん)(Bりは、上記の受
光時間差に基づいて交角算出手段のによって算出され、
このようにして上記交角(Al)(Bl)が走行目標点
(plo)に向う目標交角(AI ) (Ax )に一
致するように走行方向制御部(ハ)の指令によって自走
車両(1)の走行方向が制御されることになる。
た光ビームは、まず1方の反射柱体(8)にて反射さ幻
て直ちに反射光受光手段αDにて受光され、成る時間を
経過したとぎ、他方の反射柱体(8)にて反射されて直
ちに反射光受光手段0υにて受光されるので、自走車両
(1)の進行方向に対する左右夫々の反射柱体f8)(
8)が有している左右の交角(ん)(Bりは、上記の受
光時間差に基づいて交角算出手段のによって算出され、
このようにして上記交角(Al)(Bl)が走行目標点
(plo)に向う目標交角(AI ) (Ax )に一
致するように走行方向制御部(ハ)の指令によって自走
車両(1)の走行方向が制御されることになる。
次にこの発明の一実施例を図に基づいて説明する。第2
図に側面視を%第1図にその平面視を、第3図に第2図
の要部拡大縦断面を夫々示したように、走行車両(1)
に取付けた装置箱(2)に光ビーム走査体(3)の回転
軸(4)を立設して回転自在に設け、光ビーム走査体(
3)には、はう物面腕(5)とその焦点に置いたランプ
(6)とによって光ビームを投光する光ビーム走査手段
(7)と、後述のように反射柱体(8)によって光ビー
ムが反射された反射光を集束する受光レンズ(9)及び
受光レンズ(9)の焦点に設けられた受光素子(1(1
1とからなる反射光受光手段aυとが設けてあり、光ビ
ーム走査体(3)は1回転軸(4)が@1図の矢線で示
す例えば左廻り方向に等速回転する一モータO2によっ
てギヤ列a3を介して回転駆動されるものであり、左右
の反射柱体f8)(8)間を結ぶ仮想直線上に走行目標
点(PIG)が定められるので、左の反射柱体(8)か
らの反射があった時点から走行目標点(PIO)に光ビ
ームが回った時点までの時間差及び走行目標点(PIG
)に光ビームが向った時点から右の反射柱体(8)から
の反射があった時点までの時間差の夫々に基づいて所定
の短い走行距離毎に自走車両(i)の走行方向囚に対す
る左右の反射柱体(8)(8)がなす夫々の交角(例え
ば走行車両(1)が位置(0)にあるときは、交角(ん
)(Bl)となっている)を算出し、この算出された夫
々の交角(AI)(Bl)が走行目標点(P+ o )
に向う走行目標線山上に走行車両(1)が乗っていると
きの目標交角(AI)(Bt)に一致するよ5に走行方
向制御が行われるものである。即ち、反射光受光手段A
llが反射光を受光する夫々の時点と、光ビームが自走
車両(1)の進行方向に一致する時点とを回転軸(4)
に取付けた円板(14と発光部a9及び受光部usnη
からなるロータリエンコーダ鰻及びタイマー負傷に基き
前記夫々の時間差をマイクロコンピュータ3身にて構成
している交角算出部+211によって前述した交角(A
x)(Bt)として算出するように交角算出手段■を構
成している。
図に側面視を%第1図にその平面視を、第3図に第2図
の要部拡大縦断面を夫々示したように、走行車両(1)
に取付けた装置箱(2)に光ビーム走査体(3)の回転
軸(4)を立設して回転自在に設け、光ビーム走査体(
3)には、はう物面腕(5)とその焦点に置いたランプ
(6)とによって光ビームを投光する光ビーム走査手段
(7)と、後述のように反射柱体(8)によって光ビー
ムが反射された反射光を集束する受光レンズ(9)及び
受光レンズ(9)の焦点に設けられた受光素子(1(1
1とからなる反射光受光手段aυとが設けてあり、光ビ
ーム走査体(3)は1回転軸(4)が@1図の矢線で示
す例えば左廻り方向に等速回転する一モータO2によっ
てギヤ列a3を介して回転駆動されるものであり、左右
の反射柱体f8)(8)間を結ぶ仮想直線上に走行目標
点(PIG)が定められるので、左の反射柱体(8)か
らの反射があった時点から走行目標点(PIO)に光ビ
ームが回った時点までの時間差及び走行目標点(PIG
)に光ビームが向った時点から右の反射柱体(8)から
の反射があった時点までの時間差の夫々に基づいて所定
の短い走行距離毎に自走車両(i)の走行方向囚に対す
る左右の反射柱体(8)(8)がなす夫々の交角(例え
ば走行車両(1)が位置(0)にあるときは、交角(ん
)(Bl)となっている)を算出し、この算出された夫
々の交角(AI)(Bl)が走行目標点(P+ o )
に向う走行目標線山上に走行車両(1)が乗っていると
きの目標交角(AI)(Bt)に一致するよ5に走行方
向制御が行われるものである。即ち、反射光受光手段A
llが反射光を受光する夫々の時点と、光ビームが自走
車両(1)の進行方向に一致する時点とを回転軸(4)
に取付けた円板(14と発光部a9及び受光部usnη
からなるロータリエンコーダ鰻及びタイマー負傷に基き
前記夫々の時間差をマイクロコンピュータ3身にて構成
している交角算出部+211によって前述した交角(A
x)(Bt)として算出するように交角算出手段■を構
成している。
自走車両(1)の走行方向を示す第1図に例示した目標
交角(ん)(Br)を設定するために、走行開始後の走
行距離を走行距離検出手段@にて検出し、第6図に模型
的に示したように短かい走行距離(Δt)を通過する毎
に、走行目標線(D上における現在時!t−J) 、(
lz −tΔ1)・・・毎の目標交角(ん)(Bl)、
(Al+ΔA)、(BI+ΔB)を、目標交角設定手段
のによって予め算出して記憶しておき(又は走行動作の
つど算出しておく)交角算出手段器にて算出された例え
ば地点fO)の交角(AI ) (Bl )が、この地
点(0)に対応する走行目標線(口上の地点(0+ )
の目標交角囚)(B+)に一致することになるように走
行制御部(ト)は、自走車両(1)の蛇取装f@に舵取
指令を出力すべく構成されている。左右1対の反射柱体
(81(8)は、自走車両(1)の走行方向を長い距離
にわたって、しかも曲線状に案内誘導できるように、@
7図に例示した如く複数組設けることができるものであ
って。
交角(ん)(Br)を設定するために、走行開始後の走
行距離を走行距離検出手段@にて検出し、第6図に模型
的に示したように短かい走行距離(Δt)を通過する毎
に、走行目標線(D上における現在時!t−J) 、(
lz −tΔ1)・・・毎の目標交角(ん)(Bl)、
(Al+ΔA)、(BI+ΔB)を、目標交角設定手段
のによって予め算出して記憶しておき(又は走行動作の
つど算出しておく)交角算出手段器にて算出された例え
ば地点fO)の交角(AI ) (Bl )が、この地
点(0)に対応する走行目標線(口上の地点(0+ )
の目標交角囚)(B+)に一致することになるように走
行制御部(ト)は、自走車両(1)の蛇取装f@に舵取
指令を出力すべく構成されている。左右1対の反射柱体
(81(8)は、自走車両(1)の走行方向を長い距離
にわたって、しかも曲線状に案内誘導できるように、@
7図に例示した如く複数組設けることができるものであ
って。
同図の左方から走行するとき最も近い反射柱体(8)(
8)との目標交角(ん)と(BOとの和が例えば約90
’〜120゛程度の成る所定角以下のときは、この最も
近い反射柱体f8)(8)の目標交角(Aj)(Bg)
を制御に使用するようにし、この最も近い反射柱体(8
)(8)の目標交角(AI)(Bl)が上記所定角を越
える程度までこの反射柱体(8)(8)に接近したとき
以後は1次に近い反射柱体(8)(8)の目標交角(A
m) (B2)を制御に使用するように走行制御部(ハ
)を構成している。
8)との目標交角(ん)と(BOとの和が例えば約90
’〜120゛程度の成る所定角以下のときは、この最も
近い反射柱体f8)(8)の目標交角(Aj)(Bg)
を制御に使用するようにし、この最も近い反射柱体(8
)(8)の目標交角(AI)(Bl)が上記所定角を越
える程度までこの反射柱体(8)(8)に接近したとき
以後は1次に近い反射柱体(8)(8)の目標交角(A
m) (B2)を制御に使用するように走行制御部(ハ
)を構成している。
図示例のロータリエンコーダ(1阻1第4図にその要部
平面を示したように1円板α荀の1゛つの旧上に数多く
のスリット(ハ)を等間隔で設け、この円板(14)に
走行方向用スリツHコを設け、発光部(151からスリ
ット□□□を通って受光部f+61に入射した光を受光
部q61によってパルスに変換し、走行方向用スリット
(至)が発光部a9と受光部[6)との間に位置すると
きは、光ビームの方向が自走車両(1)の走行方向に一
致している状態であるように設けているので、例えば右
方の反射柱体(8)の反射光を反射光受光手段qυが感
知した時点から、受光部uF3が走行方向用スリット器
の通過光を感知した時点までの上記パルス数を計数して
1時間差及び交角(AI)として交角算出手段のにて算
出し、同様に走行方回用スリツ)019の通過光を感知
した時点から左方の反射柱体(8)の反射光を反射光受
光手段(111が感知した時点までのパルス数に基づい
て時間差及び交角(Bz)を算出するものである。
平面を示したように1円板α荀の1゛つの旧上に数多く
のスリット(ハ)を等間隔で設け、この円板(14)に
走行方向用スリツHコを設け、発光部(151からスリ
ット□□□を通って受光部f+61に入射した光を受光
部q61によってパルスに変換し、走行方向用スリット
(至)が発光部a9と受光部[6)との間に位置すると
きは、光ビームの方向が自走車両(1)の走行方向に一
致している状態であるように設けているので、例えば右
方の反射柱体(8)の反射光を反射光受光手段qυが感
知した時点から、受光部uF3が走行方向用スリット器
の通過光を感知した時点までの上記パルス数を計数して
1時間差及び交角(AI)として交角算出手段のにて算
出し、同様に走行方回用スリツ)019の通過光を感知
した時点から左方の反射柱体(8)の反射光を反射光受
光手段(111が感知した時点までのパルス数に基づい
て時間差及び交角(Bz)を算出するものである。
〔発明の効果〕
この発明に係る自走車両の方向制御装置は上述のように
構成したものであって、自走車両(1)の光ビーム走査
手段(7)から発射された光ビームは、まず1方の反射
柱体(8)にて反射されて直ちに反射光受光手段JII
Iにて受光され、成る時間を経過したとぎ、他方の反射
柱体(8)にて反射されて直ちに反射光受光手段all
にて受光されるので、自走車両(1)の進行方向に対す
る左右夫々の反射柱体(8)+81が有している左右の
交角(A+ ) (Bt )は、上記の受光時間差に基
づいて交角算出手段■によって算出され、・このように
して上記交角(AI)(Bl)が走行目標点[F]O)
に向う目標交角(AI ) (Bt )に一致するよう
に走行方向制御部(ハ)の指令によって自走車両(1)
の走行方向が制御されることになり、このように地上に
反射柱体(8)(8)を所定位置に立設し、自走車両(
1)に光ビーム走査手段(力、反射光受光手段αB、走
行方向制御部(至)等の簡易な装置を設けるのみによっ
て安価で確実に走行方向制御が達成されることになった
。
構成したものであって、自走車両(1)の光ビーム走査
手段(7)から発射された光ビームは、まず1方の反射
柱体(8)にて反射されて直ちに反射光受光手段JII
Iにて受光され、成る時間を経過したとぎ、他方の反射
柱体(8)にて反射されて直ちに反射光受光手段all
にて受光されるので、自走車両(1)の進行方向に対す
る左右夫々の反射柱体(8)+81が有している左右の
交角(A+ ) (Bt )は、上記の受光時間差に基
づいて交角算出手段■によって算出され、・このように
して上記交角(AI)(Bl)が走行目標点[F]O)
に向う目標交角(AI ) (Bt )に一致するよう
に走行方向制御部(ハ)の指令によって自走車両(1)
の走行方向が制御されることになり、このように地上に
反射柱体(8)(8)を所定位置に立設し、自走車両(
1)に光ビーム走査手段(力、反射光受光手段αB、走
行方向制御部(至)等の簡易な装置を設けるのみによっ
て安価で確実に走行方向制御が達成されることになった
。
図はこの発明の一実施例を示し、第1図は自走車両の平
面図、第2図は第1図の側面図、第3図は第2図の要部
拡大断面図、@4図は第3図の要部平面図、第5図は制
御ブロック図、@6図と第7図は制鴫方法の説明図であ
る。 符号説明 (1)・・・・・・自走車両 (7)・・・・・・光ビーム走査手段 (8)・・・・・・反射柱体 flu・・・・・・反射光受光手段 −・・・・・・走行方向制御部 (As )、(B1)・・・・・・交角(AI)、(8
重)・・・用目標交角 特 許 出 願 人 井関農機株式会社(・ −:
面図、第2図は第1図の側面図、第3図は第2図の要部
拡大断面図、@4図は第3図の要部平面図、第5図は制
御ブロック図、@6図と第7図は制鴫方法の説明図であ
る。 符号説明 (1)・・・・・・自走車両 (7)・・・・・・光ビーム走査手段 (8)・・・・・・反射柱体 flu・・・・・・反射光受光手段 −・・・・・・走行方向制御部 (As )、(B1)・・・・・・交角(AI)、(8
重)・・・用目標交角 特 許 出 願 人 井関農機株式会社(・ −:
Claims (1)
- 自走車両に設けられて光ビームを回動して走査する光ビ
ーム走査手段と、自走車両の走行方向に対して左右に夫
々互に間隔をおいて配置され、上記光ビームを光ビーム
走査手段の方向に向つて反射するように設けられた反射
柱体と、夫々の反射柱体からの反射光を受光するように
上記光ビーム走査手段と共に回動するよう設けられた反
射光受光手段と、上記夫々の反射柱体からの反射光の受
光時間差を検出して、自走車両の走行方向に対する左右
夫々の反射柱体がなす夫々の交角を算出する交角算出手
段と、このようにして算出された夫々の交角を左右の反
射柱体間に位置する走行目標地点に対する目標交角に一
致させるべく、自走車両に舵取指令を出力する走行方向
制御部とを有していることを特徴とする自走車両の方向
制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP61058571A JPS62214408A (ja) | 1986-03-17 | 1986-03-17 | 自走車両の方向制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP61058571A JPS62214408A (ja) | 1986-03-17 | 1986-03-17 | 自走車両の方向制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPS62214408A true JPS62214408A (ja) | 1987-09-21 |
Family
ID=13088123
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP61058571A Pending JPS62214408A (ja) | 1986-03-17 | 1986-03-17 | 自走車両の方向制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS62214408A (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7000721B2 (en) * | 2001-04-27 | 2006-02-21 | Denso Corporation | Optical object detection apparatus designed to monitor front and lateral zones of vehicle |
-
1986
- 1986-03-17 JP JP61058571A patent/JPS62214408A/ja active Pending
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7000721B2 (en) * | 2001-04-27 | 2006-02-21 | Denso Corporation | Optical object detection apparatus designed to monitor front and lateral zones of vehicle |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US5377106A (en) | Process for navigating an unmanned vehicle and a vehicle for the same | |
US6317202B1 (en) | Automotive radar detecting lane mark and frontal obstacle | |
US4133404A (en) | Automatic lawn mower | |
DK169003B1 (da) | Fremgangsmåde til navigering af et førerløst køretøj | |
US5804942A (en) | Position determining apparatus and control method of robot | |
US4680148A (en) | Mobile pond aerating system | |
US20110040482A1 (en) | Lidars | |
JPH0378596B2 (ja) | ||
JPH09115093A (ja) | 自動車の自動誘導装置および自動誘導方法 | |
JP2910377B2 (ja) | 車両用レーダ装置 | |
JP2933284B2 (ja) | 超音波センサーつき自動走行作業車両 | |
JPS62214408A (ja) | 自走車両の方向制御装置 | |
JPH05322592A (ja) | 車両の車庫誘導装置 | |
JP2868847B2 (ja) | 自走車の操向制御装置 | |
EP2113790A1 (en) | Improvements in LIDARs | |
JP3729132B2 (ja) | 車両用レーダ装置の軸ずれ検出装置 | |
JP2996705B2 (ja) | 自動走行作業車両における操舵制御装置 | |
Sutiarso et al. | Trajectory control and its application to approach a target: Part II. Target approach experiments | |
JPS62214409A (ja) | 自走車両の方向制御装置 | |
JPH07244162A (ja) | 車両用距離検出装置 | |
JPH0463406B2 (ja) | ||
JPH0755610Y2 (ja) | 自走式無人車 | |
JP2802514B2 (ja) | 自走車の操向制御装置 | |
JP2984024B2 (ja) | 超音波センサーつき自動走行作業車両 | |
JPH03286310A (ja) | 自走車の操向制御装置 |