JPH03177905A - 自動走行作業車の誘導装置 - Google Patents

自動走行作業車の誘導装置

Info

Publication number
JPH03177905A
JPH03177905A JP1318348A JP31834889A JPH03177905A JP H03177905 A JPH03177905 A JP H03177905A JP 1318348 A JP1318348 A JP 1318348A JP 31834889 A JP31834889 A JP 31834889A JP H03177905 A JPH03177905 A JP H03177905A
Authority
JP
Japan
Prior art keywords
vehicle
self
sensor
detected
distance
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
JP1318348A
Other languages
English (en)
Inventor
Masaaki Nakazawa
中沢 正明
Takeshi Yokouchi
横内 武史
Hiroshi Takahashi
浩 高橋
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.)
IHI Shibaura Machinery Corp
Original Assignee
IHI Shibaura Machinery Corp
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 IHI Shibaura Machinery Corp filed Critical IHI Shibaura Machinery Corp
Priority to JP1318348A priority Critical patent/JPH03177905A/ja
Publication of JPH03177905A publication Critical patent/JPH03177905A/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

【発明の詳細な説明】 産業上の利用分野 本発明は、無人の状態で自動走行する自動走行作業車の
誘導装置に関する。
従来の技術 従来、自動走行作業車の誘導装置としては、走行経路に
そって誘導ケーブルを埋設し、この誘導ケーブルに低周
波電流を流し、自動走行作業車に取付けた一対のピック
アップコイルにより磁界を検出しながら誘導するものが
一般的である。
また、特開昭59−135514号公報に記載されたよ
うに、走行経路上の定点に二個−組とした磁石を配設し
、これらの磁石を検出することにより走行位置の修正及
び走行方位の修正を行うものがある。
発明が解決しようとする課題 誘導ケーブルを埋設するものは、埋設工事に多大な費用
を要し、また、保守点検が大変である。
一方、特開昭59−135514号公報に記載されたも
のは、磁石を二個−組として設置するため、自動走行作
業車を広範囲で走行させる場合には磁石の数が非常に多
くなり、コスト高となっている。
課題を解決するための手段 走行経路上に多数の標識体を一個ずつ配設し、前記標識
体を検出するとともに検出した標識体と自動走行作業車
との位置ずれ量を検出する自己位置検出センサと、走行
方位を検出する方位センサと、走行距離を検出する距離
センサと、前記標識体の位置情報と前記標識体間の方位
情報とをティーチング情報として記憶する記憶装置とを
前記自動走行作業車に設け、前記自己位置検出センサが
検出した位置ずれ量と、前記記憶装置に記憶されている
方位情報と、前記方位センサが検出した方位情報と、前
記距離センサが検出した距離情報と、前記自動走行作業
車の仕様により定まる寸法及び係数とに基づいて、前記
自動走行作業車を走行経路にそって操向制御する制御ユ
ニットを設けた。
作用 自己位置検出センサが標識体を検出した際において、同
時に、検出した標識体と自動走行作業車との位置ずれ量
が検出され、この位置ずれ量と、記憶装置に記憶されて
いる方位情報と、方位センサが検出した方位情報と、距
離センサが検出した距離情報と、自動走行作業車の仕様
により定まる寸法及び係数とに基づき、制御ユニットが
ら操向制御信号が出力され、自動走行作業車は走行経路
にそって操向制御される。
実施例 本発明の一実施例を図面に基づいて説明する。
自動走行作業車である自動走行芝刈機1の腹部には、前
輪2と後輪3との間に位置してモア4が昇降自在に取付
けられている。
作業地域の地下には前記自動走行芝刈機1を走行させる
走行経路にそって標識体である磁石5が一個ずつ間欠的
に埋設されており、前記自動走行芝刈機1の前方下部に
は前記磁石5の磁力を検出するとともに検出した磁石5
と前記自動走行芝刈機lの中央位置との位置ずれ量を検
出する自己位置検出センサ6が取付けられている。また
、前記自動走行芝刈機1の中央上部には、地磁気を感知
することにより基準方位に対する前記自動走行芝刈機1
の走行方位を検出する方位センサ7が取付けられ、さら
に、前記自動走行芝刈機1の後方下部には、自動走行芝
刈機工の走行に伴って転動する計測輪8と、計測輪8の
回転軸上に設けられたギヤ9と、ギヤ9の歯数をカウン
トすることにより自動走行芝刈機1の走行距離を検出す
る距離センサ10とが取付けられている。なお、前記計
測輪8は、左右の後輪3の略中央部に配設されている。
つぎに、前記自動走行芝刈機1には、前記磁石5の位置
情報と走行経路上における隣合った磁石5間の方位情報
とをティーチング情報として記憶する記憶装置11が設
けられている。そして、前記自己位置センサ6と方位セ
ンサ7と距離センサ10と記憶装置11とが接続される
とともに、前記自己位置検出センサ6が検出した位置ず
れ量と、前記方位センサ7が検出した方位情報と、前記
距離センサ10が検出した距離情報と、前記記憶装置1
1に記憶されている方位情報とに基づいて、前記自動走
行芝刈機1を走行経路にそって操向制御する操向制御信
号を出力する制御ユニット12が設けられている。
なお、前記制御ユニット12には、前記センサ6.7.
10のほか、車速レバーがどの変速位置にあるかを検出
する車速レバー位置センサ13、前輪2の切れ角度を検
出するステアリング角度センサ14、超音波のドツプラ
ー効果により進行方向前方の障害物までの距離を検出す
る障害物センサ15、障害物に接触したか否かを検出す
る障害物接触センサ16、エンジンの回転数を検出する
エンジン回転センサ17、コントローラ電源チエツク、
断線検知、オーバーヒート検知、エンジン潤Wf抽圧チ
エツク等を行うセンサ18が接続されている。
このような構成において、自動走行芝刈機1を走行経路
にそって走行させる操向制御について説明する。まず、
自動走行芝刈機Iの仕様から、前輪2のトレッド′Q2
、後輪3のトレッド“Ql、ホイールベース“Qo、後
輪3がら自己位置検出センサ6までの寸法II L 1
1が得られる。
自動走行芝刈機上が第一の磁石5 a (X++V+)
から第二の磁石5 b (Xz+yg)に向かう走行経
路゛R1“にそって走行し、自己位置検出センサ6が磁
石5bを検出した際において、自動走行芝刈機1の走行
方位″″θv ”が方位センサ7により検出されるとと
もに、磁石5bと自動走行芝刈機1の中心位置との位置
ずれ量” X ”が自己位置検出センサ6により検出さ
れる。つぎに、磁石5bから次の磁石5cに向かう走行
経路“R2″の情報(θ、、L、)がティーチング情報
に基づいて与えられる。なお、°゛θ2θ2パ石5bが
ら磁石5cに向けての方位であり、L2”は、磁石5b
、5cの位置情報に基づいて演算された磁石5b、5c
間の距離である。また、自己位置検出センサ6が磁石5
bを検出した時から距離センサ10による走行距離II
 S”の計測が開始される。ついで、走行経路°゛R2
”における方位+10. l“と走行方位゛θ IIと
の方位差゛′Δθ″が求められる。さらに、走行経路°
“R2’“と自動走行芝刈機1の現在の走行軌跡との交
点′″P”と、後輪3の中間点II Al1との距離“
I L 、 IIが次式により求められる。
L0=L−x/lanΔθ ここで、交点“P”が第3図に示すように、後輪3の中
央点゛A Mより前方に位置する場合、即ち、Lo〉O
の場合は、後輪3の中央点゛A”を走行経路“” R2
”上におけるPA=PBとなる点It B IIに移動
させ、かつ、自動走行芝刈機1の走行方位を走行経路′
″R2″の方位“θ2”に一致させるための自動走行芝
刈機1の旋回半径“rと、この旋回半径を得るための操
舵角゛α”とが制御ユニット12において次式により演
算される。
r = L。/jan (ΔO/2) a =arc tan (Q、7 k、 1r )尚、
旋回半径“r”の旋回中心点“○′°は、後輪軸の延長
線と、点II B IIにおける走行経路“”R2”に
対する垂線との交点であり、“l k、 TIは、実際
操作時のタイム遅れや遊び等を考慮した係数である。ま
た、自己位置検出センサ6が磁石5bを検出した時点か
ら距離センサ10による走行距離の計測が開始され、走
行距離“Sパが、 S=に2・r・ΔO・π/18゜ に達した場合に後輪3の中央点“Aパが走行経路“R2
パ上の点゛B“に移動したこととなり、この時点で操舵
角を元に戻すことにより、自動走行芝刈機1は走行経路
“” R2”上を走行することとなる。尚、パに2”は
、実際操作時のタイム遅れや遊び等を考慮した係数であ
る。
一方、交点′″P“が第4図に示すように、後輪3の中
央点“A“より後方に位置する場合、即ち、L6≦Oの
場合は、次の走行経路゛R2″に一致させるための旋回
を行うのではなく、前輪2の中央点“CIIから次の磁
石5cに向けての新たな走行経路“R2”(θ2” +
  L2” )が制御ユニット12において生成される
。ここで、その方位゛θ2″“と距離“L2パとは、 θ2 =θ、 −arc tan x / L2L、 
  #L。
となる。よって、自動走行芝刈機1を新たに生成された
走行経路“R2’”にそって走行させるために、 Δ0=θ、  −0v L 、 = I。
として、旋回半径゛r”とその旋回半径を得るための操
舵角゛α”とを演算する。さらに、自己位置検出センサ
6が磁石5bを検出した時点から距離センサ10による
走行距離の計測が開始され、走行距離゛S”が、 S=に2・r・Δθ・π/180 に達した場合に後輪3の中央点″A I+が走行経路“
’R2”’におけるCA=CDとなる点II D 11
に移動したこととなり、この時点で操舵角を元に戻すこ
とにより、自動走行芝刈機lは走行経路゛R2′”上を
走行することとなる。
発明の効果 本発明は、上述のように構成したので、走行経路上に間
欠的に配設する標識体が一個ずつでよく、配設する標識
体の個数を少なくすることによってコストの低減を図る
ことができ、さらに、自動走行作業車を操向制御するた
めの演算式において用いる係数を選択することにより、
誤差を考慮した精度の高い操向制御を行うことができる
等の効果を有する。
【図面の簡単な説明】
図面は本発明の一実施例を示すもので、第を図は自動走
行芝刈機の全体を示す側面図、第2図は制御ユニットに
よる制御構成を示すブロック図、第3図及び第4図は操
向制御状態を説明する説明図、第5図は走行経路にそっ
て走行させるためのフローチャートである。 1・・・自動走行作業車、5・・・標識体、6・・・自
己位置検出センサ、7・・・方位センサ、50・距離セ
ンサ、11・・・記憶装置、12・・・制御ユニット1
3図

Claims (1)

    【特許請求の範囲】
  1. 走行経路上に多数の標識体を一個ずつ配設し、前記標識
    体を検出するとともに検出した標識体と自動走行作業車
    との位置ずれ量を検出する自己位置検出センサと、走行
    方位を検出する方位センサと、走行距離を検出する距離
    センサと、前記標識体の位置情報と前記標識体間の方位
    情報とをティーチング情報として記憶する記憶装置とを
    前記自動走行作業車に設け、前記自己位置検出センサが
    検出した位置ずれ量と、前記記憶装置に記憶されている
    方位情報と、前記方位センサが検出した方位情報と、前
    記距離センサが検出した距離情報と、前記自動走行作業
    車の仕様により定まる寸法及び係数とに基づいて、前記
    自動走行作業車を走行経路にそって操向制御する制御ユ
    ニットを設けたことを特徴とする自動走行作業車の誘導
    装置。
JP1318348A 1989-12-07 1989-12-07 自動走行作業車の誘導装置 Pending JPH03177905A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP1318348A JPH03177905A (ja) 1989-12-07 1989-12-07 自動走行作業車の誘導装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP1318348A JPH03177905A (ja) 1989-12-07 1989-12-07 自動走行作業車の誘導装置

Publications (1)

Publication Number Publication Date
JPH03177905A true JPH03177905A (ja) 1991-08-01

Family

ID=18098157

Family Applications (1)

Application Number Title Priority Date Filing Date
JP1318348A Pending JPH03177905A (ja) 1989-12-07 1989-12-07 自動走行作業車の誘導装置

Country Status (1)

Country Link
JP (1) JPH03177905A (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08196105A (ja) * 1995-01-24 1996-08-06 Yanmar Agricult Equip Co Ltd 自動薬剤散布機の回行角度検出装置
US5970433A (en) * 1996-06-24 1999-10-19 Mitsui Engineering & Shipbuilding Co. Ltd. Laser obstacle detection method and sensor

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08196105A (ja) * 1995-01-24 1996-08-06 Yanmar Agricult Equip Co Ltd 自動薬剤散布機の回行角度検出装置
US5970433A (en) * 1996-06-24 1999-10-19 Mitsui Engineering & Shipbuilding Co. Ltd. Laser obstacle detection method and sensor

Similar Documents

Publication Publication Date Title
EP3692337B1 (en) Map information provision system
CN105612403B (zh) 车辆用行驶引导装置以及方法
EP2437131B1 (en) Control apparatus for autonomous operating vehicle
JPH09319430A (ja) 自動誘導車両の航行操舵制御システム
CN103019240A (zh) 一种agv小车平面定位导航系统及方法
JP2007219960A (ja) 位置偏差検出装置
JPS6233612B2 (ja)
JPH02287708A (ja) 無人移動体の移動制御方法
JPH03177905A (ja) 自動走行作業車の誘導装置
JPH0827652B2 (ja) 地点追従方式による無人移動機械の誘導方法
Iida et al. Automatic following control for agricultural vehicle
JP3128455B2 (ja) 搬送台車の自動運転制御装置
WO1994018615A1 (en) Method of guiding driving of golf cart
JPS61294512A (ja) 無人搬送車
JPS62111306A (ja) S字形走行搬送車
JP2934770B2 (ja) 移動ロボットの車輪径計測方法及びその装置
JP2758460B2 (ja) 自動走行作業車の誘導装置
JP6921168B2 (ja) 車輪パルス信号に基づく隊列走行方法
JP2758461B2 (ja) 自動走行作業車の操向制御装置
US20240183661A1 (en) Integrated pipe locating and marking system
JPH03136110A (ja) 自動走行作業車の操向制御装置
JPS59117611A (ja) 無人搬送車の位置、方位検知方法
JPH03148708A (ja) 自動走行作業車の操向制御装置
JPH03135607A (ja) 自動走行作業車の誘導装置
JPH03148710A (ja) 自動走行作業車の制御装置