JPS6170616A - Course run guidance system of automatic running body - Google Patents
Course run guidance system of automatic running bodyInfo
- Publication number
- JPS6170616A JPS6170616A JP59191336A JP19133684A JPS6170616A JP S6170616 A JPS6170616 A JP S6170616A JP 59191336 A JP59191336 A JP 59191336A JP 19133684 A JP19133684 A JP 19133684A JP S6170616 A JPS6170616 A JP S6170616A
- Authority
- JP
- Japan
- Prior art keywords
- course
- traveling
- transition
- steering angle
- section
- 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
- 230000007704 transition Effects 0.000 claims description 45
- 238000012937 correction Methods 0.000 claims description 6
- 238000001514 detection method Methods 0.000 claims description 5
- 230000003247 decreasing effect Effects 0.000 claims 2
- 238000006073 displacement reaction Methods 0.000 claims 2
- 230000005012 migration Effects 0.000 claims 1
- 238000013508 migration Methods 0.000 claims 1
- 230000007246 mechanism Effects 0.000 abstract description 10
- 238000013459 approach Methods 0.000 description 6
- 230000008859 change Effects 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 230000007423 decrease Effects 0.000 description 2
- 238000007562 laser obscuration time method Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 238000007796 conventional method Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000000034 method Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
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/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0272—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising means for registering the travel distance, e.g. revolutions of wheels
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
産業上の利用分野
この発明は、複数の連続する直線状の区間コースとして
設定（想定）された走行予定コースに追従して自動走行
する走行体が、追従中の区間コースから次に追従する区
間コースへ移行する場合の自己誘導システムに関する。Industrial Application Field The present invention is directed to a traveling body that automatically travels by following a scheduled travel course that is set (assumed) as a plurality of continuous linear section courses, and the next section to be followed from the section course that is currently being followed. Concerning a self-guidance system when transitioning to a course.
非誘導方式によって自動制御された走行体が直線状の区
間コースを移行する従来の条件式を第１図に基づき説明
する。
即ち、区間コース（ｎ）を追従している実線で示す走行
体Ｐ′が次に追従する区間コース（ｎ＋１）までの距離
をηとし、走行体Ｐが移行旋回を開始する距離をａとす
る。モしてηくａの領域に進入した時に次の区間コース
ｎ＋ｌに移行するものとする。
このときの距離ａの値は次の式より求めることができる
。
３＝ｒｘｔａｎ（（θｎ＋ｌ−〇ｎ）／２）ここでｒ・
・・・最小旋回半径
θｎ・・・走行体が追従中の区間コースｎの方位角
θｆｉ＋ｌ・走行体が次に追従（移行）する区間コース
ｎ＋ｌの方位角
このコース移行条件式は走行体が完全に走行予定コース
即ち追従中の区間コース上に完全にのっている状態での
移行を前提にしたものであって、走行体が追従中の区間
コースからズして走行している場合や移行直前の・走行
速度を全く考慮していない。
換言すると、走行体が追従中の区間コースから離脱して
いる場合には離脱距離に対応するズレ量が住しる。
また、更に旋回移行時の最小旋回半径（ｒ）を一定に設
定しておくと、走行速度が大きくなるのに比例してコー
ス移行時の走行体位置がコースから離脱する。
これは走行速度が大きいとアンダーステア傾向くステア
リング応答特性による）が顕著に走行軌跡に現れるから
と考えられる。
更に、走行体が追従中の区間コースに接近していても走
行体の方位角が追従中の区間コースの方位角と平行でな
い場合にもズレが生じ完全な移行旋回を行うことができ
ない。
本発明者らは、このようなコース移行時に生ずる走行体
のコース離脱傾向は、
ｉ）最小旋回半径を走行速度の関数とする。
ｉｉ）追従中の区間コースの方位データの代わりに走行
体の方位角データを用いる。
ｉｉｉ ）走行体の区間コースからの離脱に対する補正
を行う。
ｉｖ）必要に応じアンダーステア傾向の補正を行う。
という修正を施すことにより解消することができること
を創案し、鋭意研究の結果本発明を完成するに至ったも
のである。A conventional conditional expression in which a traveling body automatically controlled by a non-guidance method moves along a linear section course will be explained with reference to FIG. That is, let η be the distance to the next section course (n+1) of the traveling body P' shown by the solid line following the section course (n), and let a be the distance at which the traveling body P starts the transition turn. . It is assumed that when the vehicle enters the region η×a, the vehicle moves to the next section course n+l. The value of the distance a at this time can be obtained from the following formula. 3=rxtan((θn+l−〇n)/2) where r・
... Minimum turning radius θn ... Azimuth angle of the section course n that the traveling object is following θfi + l Azimuth of the section course n + l that the traveling object will next follow (transition) This course transition conditional expression indicates that the traveling object is completely This is based on the assumption that the traveling object will be completely on the planned course, that is, the section course that is being followed, and that the vehicle will be traveling deviated from the section course that it is following, or that it will be transferred. The previous running speed is not taken into consideration at all. In other words, when the traveling object departs from the section course it is following, there is a deviation amount corresponding to the departure distance. Further, if the minimum turning radius (r) at the time of transition to a turn is set constant, the position of the traveling body at the time of transition to the course will deviate from the course in proportion to the increase in traveling speed. This is thought to be because at high running speeds, the tendency for understeer (depending on the steering response characteristics) appears prominently in the running trajectory. Further, even if the traveling object approaches the section course that it is following, if the azimuth of the traveling object is not parallel to the azimuth of the section course that it is following, a deviation occurs and it is not possible to perform a complete transition turn. The present inventors have determined that the tendency of a traveling object to deviate from the course that occurs during such a course transition is as follows: i) The minimum turning radius is a function of the traveling speed. ii) The azimuth angle data of the traveling object is used instead of the azimuth data of the section course being followed. iii) Correcting the deviation of the traveling object from the section course. iv) Understeer tendency is corrected as necessary. We devised a solution to this problem by making the following modifications, and as a result of intensive research, we completed the present invention.
この発明は、複数の連続する直線状の区間コースからな
る走行予定コースに自己誘導して追従する走行体が、追
従中の区間コースから次に追従する区間コースへ移行す
る際のコース移行誘導システムにおいて、走行体の走行
速度および方位角に応じた移行開始距離を求め、これに
対し区間コースと離脱している場合には離脱に対する補
正を行い、また必要に応じアンダーステア傾向の補正を
行って、コース移行後の区間コースとのズレを解消する
ことを目的とする。This invention provides a course transition guidance system for when a traveling object that self-guides and follows a scheduled course consisting of a plurality of continuous linear section courses transitions from the section course it is following to the section course it is following next. In this step, the transition start distance is determined according to the traveling speed and azimuth of the traveling object, and if the vehicle deviates from the section course, it is corrected for the deviation, and if necessary, the understeer tendency is corrected. The purpose is to eliminate the discrepancy with the section course after the course transition.
この発明は上記目的を達成するために、複数の連続する
直線状の区間コースからなる走行予定コースに追従して
自動走行する走行体が追従中の区間コースから次に追従
する区間コースへ移行するシステムにおいて、
イ）追従中の走行体の走行速度データからそれに対応す
るコース移行時の最小旋回半径を設定する最小旋回半径
設定手段を設ける。
口）走行予定コースのコースデータから追従中の区間コ
ースの方位角データおよび移行（次に追従）する区間コ
ースの方位角データを演算するコース方位角検出手段を
設ける。
ハ）追従中の走行体の現在の位置及び方位角を検出する
位置検出手段を設ける。
二）追従中の走行体の現在の位置と、追従中の区間コー
スの位置との相対位置く離脱距離）を測定する相対位置
測定手段を設ける。
ホ）上記各手段から入力されたデータをもとにコース移
行（７ｉ２回開始）時における走行体位置を演算するコ
ース移行位置演算手段を設ける。
へ）追従中の区間コースを走行する走行体が上記コース
移行位置演算手段から出力されたコース移行位置の範囲
内に入ったか否かを判定するコース移行判定手段を設け
る。
ト）該コース移行判定手段によりコース移行開始と判定
された場合に走行体のコース移行旋回制御を行う制御手
段を設ける。
という技術手段を講じている。In order to achieve the above-mentioned object, the present invention allows a traveling body that automatically travels to follow a scheduled travel course consisting of a plurality of continuous linear section courses to transition from the section course it is currently following to the section course to be followed next. In the system, a) minimum turning radius setting means is provided for setting a minimum turning radius at the time of course transition corresponding to the traveling speed data of the following traveling object. (1) A course azimuth detecting means is provided which calculates azimuth data of a section course that is being followed and azimuth data of a section course to be transferred (followed next) from course data of the planned course. c) A position detection means is provided for detecting the current position and azimuth of the traveling object being followed. 2) Relative position measuring means is provided for measuring the relative position (disengagement distance) between the current position of the traveling object being followed and the position of the section course being followed. E) A course transition position calculation means is provided for calculating the position of the traveling body at the time of course transition (starting twice in 7i) based on the data input from each of the above-mentioned means. f) A course transition determination means is provided for determining whether or not the traveling object traveling on the section course being followed has entered the range of the course transition position output from the course transition position calculation means. g) A control means is provided which performs course change turning control of the traveling body when the course change determination means determines that the course change has started. We are taking technical measures.
第１図はこの発明の自動走行する走行体のコース移行誘
導システムの機能を示すブロック図である（誘導理論に
ついては第３図を基に説明する）。
この走行体のコース移行誘導システムは、本実施例の場
合、走行体に装備され或いは走行路に設置された各種セ
ンサ一群がら入力されたデータを基に演算処理を行うマ
イクロコンピュータ（以下、ＣＰＵとする）と、このＣ
ＰＵの出力する制御信号によって走行体のステアリング
機構部Ｓ、及び動力機構部りを制御する制御手段１５と
からなっている。
なお、この発明では走行予定コースのコースデータ（位
置）や、走行体の位置その他の位置データを表示するの
に、走行路等の所望位置に想定したＸ軸、Ｙ軸を基準に
して点座標（ｘ、 ｙ）に変換処理して行っている。
ここで、１は、ＣＰＵに設けられた走行予定コース記憶
部であって、点座標で表された走行予定コースデータが
ストアされている。
この走行予定コースは走行体の目的に応じて予め適宜手
段で設定されるものであって、例えば地図をもとに予定
コースを設定し、或いは実際にマニュアル又はラジオコ
ントロール制御等によって走行した走行体の走行軌跡デ
ータをもとに走行予定コースを設定したもの等適宜手段
により定められる。
この走行予定コースのコース設定は、実際の走行軌跡デ
ータを用いる場合は、直線コースが連続する走行予定コ
ースに修正し、その直線コース相互が交叉する各交叉点
を連続する点座標（ｘ、 ｙ）として読みとり走行予
定コース記憶部にストアするものである。
第２図に基づき説明すると、走行予定コースｐｃは、ス
タート点ＰＣＩ （５，０）−ＰＯ２（０，０）−Ｐ
Ｏ２（０，５）−ＰＯ２（４，７）−ＰＯ５（４，２）
−終点ＰＣ６（０，０）（７）連続する複数の点座標で
設定され、走行予定コース記憶部１に入力され記憶され
ている。
またこの走行予定コース記憶部１には、前記点座標で表
された直線状の区間コース、即ち２点の点座標間を走行
する際の区間コース走行速度および区間コース最低走行
速度を予め設定しておきストアしておく。
２は、走行体の位置検出手段であって、走行予定コース
に追従して走行している走行体が現在どの位置にあるか
を検出するもので、本実施例では走行体に搭載された図
示しないエンコーダおよびジャイロスコープ等を用いて
基点（スタート点）からの走行距離および走行体の方向
（方位角）θＰを算出し、且つ地上に設けられた図示し
ないゲートボール等の位置補正手段によって走行位置デ
ータの補正を行い、得られた走行位置データ即ち点座標
で表す走行体位置データと走行体方位角データとを連続
的に出力するものである。
この位置検出手段２から出力された点線で示す走行体の
位置Ｐ （Ｘ、 Ｙ） （第３図参照）のデータと、
前記コースデータ記憶部１から呼出されて、走行体が追
従している区間コースを表す２点の点座標Ｃ１（Ｘｉ、
Ｙｌ）とＣ２（Ｘ２．Ｙ２）とが相対位置測定手段３に
入力される。
この相対位置測定手段３は、前記走行体の位置データＰ
（Ｘ、Ｙ）と区間コースを表す点座標デーＩ’ＣＩ
（ＸＩ、Ｙｌ）及びＣ２（Ｘ２．Ｙ２）とから走行予
定コースと走行体とのズレ量、即ち走行体の現在位置か
ら該走行体が追従している直線状のコースへ下ろした垂
線の長さ１１を計測するものであり、
により算出される。
次に、１０は最小旋回半径設定手段であって、走行速度
検出センサ１１より検出された走行速度データを入力し
、その走行速度データに対応する最小旋回半径を設定す
るものであり、前記走行速度データを基に実験的に或い
は走行速度関数として最適（最小）旋回半径ｒ’ （Ｖ
）を求めるものである。
また、１２はアンダーステア補正値設定手段であって、
当該走行体のステアリング応答特性と走行中の走行速度
データとを基に実験的に或いは走行速度の関数として補
正値Ｃ１（Ｖ）を求めるものである。
以上の各手段によって求められたデータ即ち、最小旋回
半径ｒ”（Ｖ）データ、追従中の区間コースの方位角θ
ｎデータ、移行する区間コースの方位角θｎ＋１データ
、走行体方位角θｐデデー、相対位置ξデータ、アンダ
ーステア補正値Ｃ１（Ｖ）データが夫々コース移行位置
演算手段１３に入力される。
このコース移行位置演算手段１３では、下記の式に従い
コース移行開始距離ａ （Ｖ）を算出する。
ａ （Ｖ） ＝ｒ”（Ｖ） Ｘｔａｎ （（θ誉＋
１−θｐ）＋ξＸｔａｎ （θｎ−θｐ＋ｉ／２）＋
（１！これにより、第１項で従来式で追従中のコースの
方位角θｎの代わりに走行体方位角θｐを用いているの
で走行体が追従中のコースと平行でなく別の方位を向い
ているときでも誤差が生じない。
また、最小旋回半径ｒ”（Ｖ）は移行旋回直前の走行速
度に対応して変化するので走行速度が速い場合はより小
さい最適の最小旋回半径が与えられて、走行速度による
影響を抑えた。
次に第２項で追従中の区間コースからの離脱距離ξによ
る影響を補正した。
また第３項では速度制御によって十分減速しきれない場
合を想定し、速度に対するアンダーステア傾向の影響を
オフセットした。
このようにして算出されたコース移行開始距離ａ （Ｖ
）データは次に、コース移行判定手段１４に入力される
。
このコース移行判定手段１４では、走行中の走行体の位
置データから移行する区間コースｎ＋１との距離即ちＣ
２の点座標との距離ηを測定し、この距離ηがａ （Ｖ
）の範囲内か否か比較する。
この範囲内であればコース移行誘導が制御手段】５によ
って開始される。
制御手段１５では、コース移行制御信号に基づきアクチ
ュエータを介してステアリングを所定量切ってコース移
行旋回を行う。
この発明においては、コース移行誘導の際のステアリン
グ機構部Ｓ及び動力機構部りへの制御について特に躍定
するものではないので適宜制御を行うことができる。
ここで本実施例では、操舵角データに基づいて操舵時の
速度制御を行うと共に、操舵角データ自体も操舵角調整
手段８と、進入角度制限手段９とによって修正処理して
、ステアリング制御手段７と走行速度制御手段６とに制
御信号を出力しており、該ステアリング制御手段７と走
行速度制御手段６との制御によってステアリング機構部
Ｓと動力機構部りとがアクチュエータを介して所定動作
を行っている。
即ち、最小旋回半径設定手段１０によって決定された最
小旋回に必要な操舵角を操舵角決定手段４によって決定
し、走行速度決定手段５によって前記操舵角データと、
次に追従する区間コースの設定走行速度データとを基に
その操舵角に応じた操舵時の走行速度を決定するという
、ステアリングの空量に応じた速度制御を行っている。
これは、まづ走行予定コース記憶部１から、走行予定コ
ースで現在追従している区間コースにおける設定走行速
度Ｖｃと最低走行速度Ｖｍｉｎの各データを呼び出し走
行速度決定手段５に入力する。
ここで最低走行速度Ｖｍｉｎはステアリングの最大切れ
角時においてコース離脱が少ない最適な速度を実験的に
求めて設定されている。
次に、入力されたデータをもとに、走行速度決定手段５
は、下記の式に従って、出力走行速度■（φ）を決定す
る。
即ち、
■（φ） ＝Ｖｍｉｎ ＋ （Ｖ ｃ−Ｖｍｉｎ ）
Ｘ ｆ （φ）「 （φ） ＝１− （ＣＭＤ
（φ）／Ｒ）ＣＭＤ （φ）・・操舵角コマンド
Ｒ・・・・・・・ステアリングの最大切れ角辺上により
、操舵角が大きい程走行速度は減少し、操舵角が０のと
き、即ち直線走行の場合は区間設定走行速度Ｖｃに、操
舵角が最大の時には最低走行速度Ｖｍｉｎになり、操舵
角の大きさに応じてＶｃからＶｍｉｎまでの間で走行速
度が変化する。
このように操舵角に対応して走行体の速度制御を行う場
合に、ステアリングの空量が大きくなると走行速度は遅
くなる。
従って、急激にステアリング切量が増大するような場合
に、は走行速度が急激に低下してスリップ現象が生じる
ことがある。
そこで操舵角決定手段４には、該手段４によって演算処
理された操舵角データが、急激増大基準値を超えて増大
するときは操舵角を段階的に増加させ、逆に旋回から直
線走行になる場合のように操舵角の空量が急激減少基準
値を超えて減少する場合には操舵角を段階的に減少させ
るべく修正処理された操舵角コマンドをステアリング制
御手段７に出力する操舵角調整手段８を設けている。
このｆＪ！ｉｔ整制御手膜制御手段８御を用いれば走行
速度の減速は滑らかに行うことができるようになるので
スリップ現象を回避できて好適である。
また、進入角度制限手段９は、操舵角決定手段４によっ
て決定された操舵角コマンドの区間コース進入角度が進
入角上限基準値（α）を超える場合には、該進入角上限
基準値に置き替えて操舵角を修正し演算処理するもので
あり、該基準値は実験により最適のものが設定される。
コノコース移行誘導システムにより予定コース移行式を
移行誘導した場合の走行軌跡ＴＴを第２図に示す。
これにより、予定コースからのズレを最小に抑えること
ができたことがわかる。FIG. 1 is a block diagram showing the functions of the course transition guidance system for an automatically traveling vehicle according to the present invention (the guidance theory will be explained based on FIG. 3). In this embodiment, this course transition guidance system for a traveling object is a microcomputer (hereinafter referred to as CPU) that performs arithmetic processing based on data input from a group of various sensors equipped on the traveling object or installed on the traveling path. ) and this C
It consists of a control means 15 that controls the steering mechanism section S and the power mechanism section of the traveling body in accordance with the control signal output from the PU. In addition, in this invention, in order to display the course data (position) of the planned course, the position of the traveling object, and other position data, point coordinates are used based on the X-axis and Y-axis assumed at the desired position of the traveling route, etc. This is done by converting to (x, y). Here, 1 is a scheduled travel course storage section provided in the CPU, and stores scheduled travel course data expressed in point coordinates. This planned running course is set in advance by an appropriate means depending on the purpose of the vehicle. For example, the planned course is set based on a map, or the vehicle actually traveled by manual or radio control. The scheduled driving course is determined by an appropriate means such as setting the planned driving course based on the driving trajectory data of the vehicle. When using actual travel locus data, the course setting for this planned driving course is modified to a planned driving course with consecutive straight courses, and the continuous point coordinates (x, y ) is read and stored in the planned driving course storage unit. To explain based on FIG. 2, the planned running course pc is the starting point PCI (5,0)-PO2(0,0)-P
O2(0,5)-PO2(4,7)-PO5(4,2)
- End point PC6 (0, 0) (7) is set with the coordinates of a plurality of consecutive points, and is input and stored in the planned travel course storage section 1. Further, in this planned running course storage unit 1, the linear section course represented by the point coordinates, that is, the section course running speed and the section course minimum running speed when traveling between two point coordinates are preset. Store it aside. Reference numeral 2 denotes a position detecting means for the traveling body, which detects the current position of the traveling body following the planned travel course. The traveling distance from the base point (start point) and the direction (azimuth angle) θP of the traveling object are calculated using an encoder and gyroscope, etc., and the traveling position data is calculated using a position correction means such as a gate ball (not shown) installed on the ground. is corrected, and the obtained traveling position data, that is, the traveling body position data expressed in point coordinates and the traveling body azimuth data are continuously output. The data of the position P (X, Y) of the traveling body shown by the dotted line outputted from the position detection means 2 (see Fig. 3),
Two point coordinates C1 (Xi,
Yl) and C2 (X2.Y2) are input to the relative position measuring means 3. This relative position measuring means 3 includes position data P of the traveling body.
(X, Y) and point coordinate data I'CI representing the section course
(XI, Yl) and C2 (X2.Y2), the amount of deviation between the planned traveling course and the traveling object, that is, the length of the perpendicular line drawn from the current position of the traveling object to the linear course that the traveling object is following. It measures the distance 11, and is calculated by: Next, 10 is a minimum turning radius setting means, which inputs the traveling speed data detected by the traveling speed detection sensor 11 and sets the minimum turning radius corresponding to the traveling speed data. The optimum (minimum) turning radius r' (V
). Further, 12 is understeer correction value setting means,
The correction value C1 (V) is determined experimentally or as a function of the running speed based on the steering response characteristics of the running object and the running speed data during running. The data obtained by each of the above means, that is, the minimum turning radius r'' (V) data, the azimuth angle θ of the section course being followed
n data, azimuth angle θn+1 data of the section course to be transitioned, traveling body azimuth angle θp dedata, relative position ξ data, and understeer correction value C1(V) data are respectively input to the course transition position calculation means 13. This course transition position calculation means 13 calculates the course transition start distance a (V) according to the following formula. a (V) = r” (V)
1-θp)+ξXtan (θn-θp+i/2)+
(1! As a result, in the first term, the traveling object azimuth angle θp is used instead of the azimuth angle θn of the course being followed in the conventional method, so the traveling object is not parallel to the course being followed but points in a different direction. Also, since the minimum turning radius r'' (V) changes according to the traveling speed immediately before the transition turn, a smaller optimal minimum turning radius is given when the traveling speed is high. , the influence of traveling speed was suppressed.Next, in the second term, the influence of departure distance ξ from the section course being followed was corrected.In addition, in the third term, assuming the case where speed control could not sufficiently decelerate, Offset the influence of understeer tendency on the course transition start distance a (V
) The data is then input to the course transition determining means 14. This course transition determination means 14 calculates the distance from the section course n+1 to which the vehicle is moving based on the position data of the traveling object, that is, C.
The distance η to the point coordinates of 2 is measured, and this distance η is a (V
) is within the range. If it is within this range, course transition guidance is started by the control means [5]. The control means 15 turns the steering by a predetermined amount via an actuator based on the course change control signal to perform a course change turn. In the present invention, the control of the steering mechanism section S and the power mechanism section at the time of course transition guidance is not particularly critical, and therefore can be controlled as appropriate. Here, in this embodiment, the speed during steering is controlled based on the steering angle data, and the steering angle data itself is corrected by the steering angle adjusting means 8 and the approach angle limiting means 9. A control signal is output to the steering control means 7 and the traveling speed control means 6, and the steering mechanism section S and the power mechanism section perform predetermined operations via actuators under the control of the steering control means 7 and the traveling speed control means 6. ing. That is, the steering angle required for the minimum turning determined by the minimum turning radius setting means 10 is determined by the steering angle determining means 4, and the steering angle data is determined by the traveling speed determining means 5.
Next, based on the set traveling speed data of the section course to be followed, the traveling speed at the time of steering is determined according to the steering angle, and speed control is performed according to the free space of the steering wheel. To do this, first, each data of the set travel speed Vc and the minimum travel speed Vmin for the section course currently being followed in the scheduled travel course is called up from the scheduled travel course storage section 1 and input into the travel speed determining means 5. Here, the minimum running speed Vmin is set by experimentally determining the optimum speed at which the vehicle is less likely to deviate from the course when the steering wheel is at its maximum turning angle. Next, based on the input data, the traveling speed determining means 5
determines the output traveling speed ■(φ) according to the following formula. That is, ■(φ) = Vmin + (V c - Vmin)
X f (φ) “ (φ) =1− (CMD
(φ)/R) CMD (φ) Steering angle command R...Due to the maximum steering angle side, the larger the steering angle, the lower the traveling speed, and when the steering angle is 0, That is, when traveling in a straight line, the section set traveling speed is Vc, and when the steering angle is maximum, the minimum traveling speed is Vmin, and the traveling speed changes between Vc and Vmin depending on the magnitude of the steering angle. When controlling the speed of a traveling object in accordance with the steering angle in this way, the traveling speed becomes slower as the amount of space in the steering wheel increases. Therefore, if the steering angle suddenly increases, the traveling speed of the vehicle may suddenly decrease and a slip phenomenon may occur. Therefore, the steering angle determining means 4 increases the steering angle step by step when the steering angle data calculated by the means 4 increases beyond the rapid increase reference value, and conversely, the steering angle changes from turning to straight running. Steering angle adjustment means for outputting a corrected steering angle command to the steering control means 7 in order to reduce the steering angle in stages when the free space of the steering angle decreases by exceeding a rapid reduction reference value as in the case of the above case. There are 8. This fJ! It is preferable to use the IT adjustment control means 8 to smoothly reduce the traveling speed, thereby avoiding the slip phenomenon. Further, when the section course approach angle of the steering angle command determined by the steering angle determining means 4 exceeds the approach angle upper limit reference value (α), the approach angle limiting means 9 replaces it with the approach angle upper limit reference value. The steering angle is corrected and processed by calculation, and the optimum reference value is set through experiments. FIG. 2 shows the traveling trajectory TT when the scheduled course transition type is guided by the cono course transition guidance system. This shows that deviations from the planned course could be kept to a minimum.
第１図は機能ブロック図、第２図は走行軌跡を示す図、
第３図は、コース移行式を説明するための説明図である
。Figure 1 is a functional block diagram, Figure 2 is a diagram showing the running trajectory,
FIG. 3 is an explanatory diagram for explaining the course transition formula.
Claims (4)
定コースに自己誘導して追従する走行体が追従中の区間
コースから次に追従する区間コースへ移行するシステム
にして、 追従中の走行体の走行速度データからそれに対応するコ
ース移行時の最小旋回半径を設定する最小旋回半径設定
手段と、 走行予定コースのコースデータから追従中の区間コース
の方位角データおよび移行（次に追従）する区間コース
の方位角データを演算するコース方位角検出手段と、 追従中の走行体の現在の位置および方位角を検出する位
置検出手段と、 追従中の走行体の現在の位置と追従中の区間コースの位
置との相対位置（離脱距離）を測定する相対位置測定手
段と、 上記各手段から入力されたデータをもとにコース移行（
旋回開始）時における走行体位置を演算するコース移行
位置演算手段と、 追従中の区間コースを走行する走行体が、上記コース移
行位置演算手段から出力されたコース移行位置の範囲内
に入ったか否かを判定するコース移行判定手段と、 該コース移行判定手段によりコース移行開始と判定され
た場合に走行体のコース移行旋回制御を行う制御手段と
、 からなることを特徴とする自動走行体のコース移行誘導
システム。(1) A system in which a traveling object that self-guides itself to a planned course consisting of a plurality of consecutive linear courses and then transitions from the section course it is currently following to the section course that it will follow next, is used during the course it is following. Minimum turning radius setting means for setting the minimum turning radius at the time of course transition corresponding to the traveling speed data of the vehicle; course azimuth detection means for calculating azimuth data of a section course; position detection means for detecting the current position and azimuth of a traveling object being followed; and the current position of the traveling object being followed and the section being followed. A relative position measuring means for measuring the relative position (leaving distance) to the course position, and a course shift (
a course transition position calculation means for calculating the position of the traveling body at the time of the start of a turn; and whether the traveling body traveling on the section course being followed has entered the range of the course transition position output from the course transition position calculation means. A course for an automatic traveling object, comprising: a course transition determination means for determining whether the course transition has started, and a control means for controlling the course transition turning of the traveling object when the course transition determination means determines that the course transition has started. Migration guidance system.
データからそれに対応するアンダーステア傾向を補正す
る補正値を設定するアンダーステア補正値設定手段を有
していることを特徴とする特許請求の範囲第１項記載の
自動走行体のコース移行誘導システム。(2) The course transition position calculation means includes an understeer correction value setting means for setting a correction value for correcting the understeer tendency corresponding to the traveling speed data of the traveling object. The course transition guidance system for an automatic traveling body according to item 1.
から操舵時の走行速度を設定する走行速度決定手段を有
し、該走行速度決定手段によって決定された走行速度デ
ータに従って走行速度制御を行うことを特徴とする特許
請求の範囲第１項乃至第２項記載のいずれかの自動走行
体のコース移行誘導システム。(3) The control means has a traveling speed determining means for setting a traveling speed during steering from the steering angle data at the time of course transition turning, and controls the traveling speed in accordance with the traveling speed data determined by the traveling speed determining means. A course transition guidance system for an automatic traveling body according to any one of claims 1 to 2.
場合には操舵角を段階的に増加させて決定された操舵角
まで変位制御し、操舵角の切量が減少方向へ向かう場合
には操舵角を段階的に減少させて決定された操舵角まで
変位制御する調整制御手段を有することを特徴とする特
許請求の範囲第１項または第３項記載のいずれかの自動
走行体のコース移行誘導システム。(4) When the amount of steering angle turning is heading in the increasing direction, the control means increases the steering angle stepwise to perform displacement control until the determined steering angle, and the turning amount of the steering angle is heading in the decreasing direction. The automatic traveling object according to claim 1 or 3, further comprising adjustment control means for controlling the displacement by decreasing the steering angle stepwise in some cases until the determined steering angle is reached. course transition guidance system.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP59191336A JPS6170616A (en) | 1984-09-12 | 1984-09-12 | Course run guidance system of automatic running body |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP59191336A JPS6170616A (en) | 1984-09-12 | 1984-09-12 | Course run guidance system of automatic running body |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JPS6170616A true JPS6170616A (en) | 1986-04-11 |
Family
ID=16272862
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP59191336A Pending JPS6170616A (en) | 1984-09-12 | 1984-09-12 | Course run guidance system of automatic running body |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPS6170616A (en) |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6252614A (en) * | 1985-08-30 | 1987-03-07 | Shinko Electric Co Ltd | Method for controlling travel of autonomous traveling robot |
| JPS6280708A (en) * | 1985-10-04 | 1987-04-14 | Shinko Electric Co Ltd | Movil robot |
| JPH03175506A (en) * | 1989-12-04 | 1991-07-30 | Nippon Yusoki Co Ltd | Running control method for unattended carriage |
| JP2007002590A (en) * | 2005-06-27 | 2007-01-11 | Asahi Kasei Homes Kk | Water cut-off structure |
-
1984
- 1984-09-12 JP JP59191336A patent/JPS6170616A/en active Pending
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6252614A (en) * | 1985-08-30 | 1987-03-07 | Shinko Electric Co Ltd | Method for controlling travel of autonomous traveling robot |
| JPS6280708A (en) * | 1985-10-04 | 1987-04-14 | Shinko Electric Co Ltd | Movil robot |
| JPH0546565B2 (en) * | 1985-10-04 | 1993-07-14 | Shinko Electric Co Ltd | |
| JPH03175506A (en) * | 1989-12-04 | 1991-07-30 | Nippon Yusoki Co Ltd | Running control method for unattended carriage |
| JP2007002590A (en) * | 2005-06-27 | 2007-01-11 | Asahi Kasei Homes Kk | Water cut-off structure |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US8626365B2 (en) | Automatic steering control apparatus and autopilot | |
| JPH06300581A (en) | Control device for tracking vehicle course | |
| JPH0324605A (en) | Method for controlling travel of moving robot | |
| US20190171219A1 (en) | Automated guided vehicle | |
| JP3714269B2 (en) | Automatic steering device | |
| JPS6170616A (en) | Course run guidance system of automatic running body | |
| JPH06300580A (en) | Control device for tracking vehicle course | |
| JP2000298518A (en) | Automated guided vehicle | |
| JP2002108453A (en) | Unmanned vehicle | |
| JPH10105234A (en) | Unmanned carriage | |
| JPS6170617A (en) | Course run guidance system of automatic running body | |
| CN112947487A (en) | Automatic guide vehicle and curve path tracking method and control device thereof | |
| JP2950897B2 (en) | Vehicle lamp direction control device | |
| JPH03189805A (en) | Method and device for automatic steering vehicle | |
| JP3846829B2 (en) | Steering angle control device for moving body | |
| JPH03248210A (en) | Automatic running system for running vehicle | |
| JPS6170615A (en) | Self-guidance control method of automatic running body | |
| JPS61193211A (en) | Course guiding method for self-traveling object | |
| KR100199988B1 (en) | Steering method and device of agv | |
| JP2847673B2 (en) | Body guidance method for automatic guided vehicles | |
| JPH03282705A (en) | Steering angle controller for unmanned carrier vehicle | |
| JP2837985B2 (en) | Course guidance system for running objects | |
| KR970003505B1 (en) | Process and auto-steering device for railless crane | |
| JP2000122721A (en) | Steering angle controller for mobile object | |
| JPH01295312A (en) | Guiding device for unmanned vehicle |