JP2005041597A - Travel control method for unmanned vehicle and unmanned vehicle - Google Patents

Travel control method for unmanned vehicle and unmanned vehicle Download PDF

Info

Publication number
JP2005041597A
JP2005041597A JP2003200391A JP2003200391A JP2005041597A JP 2005041597 A JP2005041597 A JP 2005041597A JP 2003200391 A JP2003200391 A JP 2003200391A JP 2003200391 A JP2003200391 A JP 2003200391A JP 2005041597 A JP2005041597 A JP 2005041597A
Authority
JP
Japan
Prior art keywords
guide line
detection sensor
offset position
travel
guide
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.)
Granted
Application number
JP2003200391A
Other languages
Japanese (ja)
Other versions
JP4360138B2 (en
Inventor
Naotaka Hanji
直高 判治
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.)
Toyota Industries Corp
Original Assignee
Toyota Industries 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 Toyota Industries Corp filed Critical Toyota Industries Corp
Priority to JP2003200391A priority Critical patent/JP4360138B2/en
Publication of JP2005041597A publication Critical patent/JP2005041597A/en
Application granted granted Critical
Publication of JP4360138B2 publication Critical patent/JP4360138B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Landscapes

  • Platform Screen Doors And Railroad Systems (AREA)
  • Forklifts And Lifting Vehicles (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To provide a travel control method for an unmanned vehicle to travel without greatly meandering until a shift amount between the center of a vehicle body and a guide line is zero while gently converging it, and to provide the unmanned vehicle. <P>SOLUTION: When an unmanned forklift changes its moving direction, a travel control device calculates a shift amount between a center position of a guide line detecting sensor before stating travel and the guide line (S120), sets an offset position (S130) and starts the travel of the unmanned forklift (S140). The travel control device controls the unmanned forklift to travel while determining whether it travels a travel distance of 100 mm or not, and procedures are repeated for returning the offset position 1 mm to the side of the center position of the guide line detecting sensor each for the travel distance of 100 mm (S160-S190). The travel control device allows the travel of the unmanned forklift while controlling steering at a small steering angle, therefore preventing the unmanned forklift from travelling while greatly meandering. <P>COPYRIGHT: (C)2005,JPO&NCIPI

Description

【0001】
【発明の属する技術分野】
本発明は無人車の走行制御方法及び無人車に関するものである。
【0002】
【従来の技術】
無人フォークリフトは、床面に縦横に敷設された磁気棒等の誘導線に沿って走行し、荷取場所の荷をフォークに載置して荷置場所まで搬送する荷役作業を無人で行う。この種の無人フォークリフトは、車両の前後にガイドセンサが備えられ、そのガイドセンサにて誘導線と無人フォークリフトの中心とのずれ量を測定する。そして、その測定したずれ量に基づいてステアリングの角度を、誘導線と無人フォークリフトの中心とが一致するように制御することによって、無人フォークリフトを誘導線に沿って走行させるようにしている。この種の無人フォークリフトは、一般に、ずれ量が大きい場合、ステアリングの角度が大きくなり、無人フォークリフトの中心を誘導線に沿って走行させるまでの間、無人フォークリフトは大きく蛇行走行していた。
【0003】
無人フォークリフトの走行には、図9(a)〜(c)に示すスイッチバック走行がある。スイッチバック走行は、カーブの誘導線L1に沿って走行(後進走行)する無人フォークリフト61を直線の誘導線L2にのせたのち、一旦直線の誘導線L2で停止させる。そして、無人フォークリフト61を直線の誘導線L2に沿って走行(前進走行)させることによって、無人フォークリフト61をカーブの誘導線L1から直線の誘導線L2に移し、走行方向を変更する走行である。
【0004】
ところで、このスイッチバック走行において、無人フォークリフト61がカーブの誘導線L1から直線の誘導線L2に基づく走行制御に移る直前では、無人フォークリフト61の中心と直線の誘導線L2とのずれ量は非常に大きい。従って、無人フォークリフト61がカーブの誘導線L1から直線の誘導線L2に移る場合、無人フォークリフト61の中心と直線の誘導線L2とが一致するまで、かなりの距離で直線の誘導線L2に沿って無人フォークリフト61を走行(後進走行)させる必要があった。
【0005】
しかしながら、例えば、カーブの誘導線L1と直線の誘導線L2とが重なる近くに荷取場所や荷置場所が設けられている場合、無人フォークリフト61はその中心と直線の誘導線L2とのずれ量が非常に大きい状態で停止し、荷取り又は荷置き作業をしなければならなかった。そこで、無人フォークリフト61の中心と直線の誘導線L2とのずれ量が大きい場合、そのずれ量に基づいてフォークを幅方向にシフトさせて荷取り又は荷置き作業を可能にする技術が提案されている(例えば特許文献1)。
【0006】
【特許文献1】
特開2003−63790号公報
【0007】
【発明が解決しようとする課題】
しかしながら、荷取り又は荷置き作業を終了し、無人フォークリフト61を直線の誘導線L2に沿って走行(前進走行)させる場合、前記ずれ量が非常に大きいため、無人フォークリフト61は大きく蛇行しながら走行することになる。このようなことは、直線の誘導線L2がその無人フォークリフト61の後進走行方向に充分に長く敷設できない場合も同様に、無人フォークリフト61は大きく蛇行しながら走行していた。
【0008】
このように大きく蛇行する走行は、床面の走行経路上に設けた運行情報を指示する磁気マーク等の目印を読み落とし、荷役作業の効率を低下させる問題があった。
【0009】
本発明は上記問題点を解消させるためになされたものであって、その目的は、車体の中心と誘導線とのずれ量がゼロになるまで大きく蛇行することなく緩やかに収束しながら走行することができる無人車の走行制御方法及び無人車を提供することにある。
【0010】
【課題を解決するための手段】
請求項1に記載の発明では、床面に敷設された誘導線を車体に備えられた誘導線検出センサで検出し、前記誘導線と前記誘導線検出センサの基準位置とのずれ量を算出し、その算出したずれ量に基づいて前記誘導線と前記誘導線検出センサの基準位置とが一致するようにステアリング制御して走行するようにした無人車の走行制御方法において、前記算出したずれ量に基づいて、そのずれた位置と一致した位置又はそのずれた位置に近い位置を、前記誘導線検出センサの基準位置とみなすオフセット位置として設定し、そのオフセット位置と前記誘導線とのずれ量を算出しながらステアリング制御して走行するとともに、前記オフセット位置について予め定めた距離を走行する毎に前記誘導線検出センサの基準位置に近づけるようにして前記ずれ量を求めながら走行するようにしたことをその要旨とする。
【0011】
請求項2に記載の発明では、請求項1に記載の無人車の走行制御方法において、前記オフセット位置が前記誘導線検出センサの基準位置から予め定めた値以下となるとき、前記誘導線検出センサの基準位置と誘導線とのずれ量を算出するようにしたことを特徴とする。
【0012】
請求項3に記載の発明では、無人車において、駆動輪を駆動させる走行用モータと、駆動輪のステアリング角を調整するステアリングモータと、床面に敷設された誘導線を検出する誘導線検出センサと、走行距離を検出する走行距離検出手段と、誘導線検出センサに基づいて誘導線と前記誘導線検出センサの基準位置とのずれ量を算出する算出手段と、前記算出したずれ量に基づいて、そのずれた位置と一致した位置又はそのずれた位置に近い位置を前記誘導線検出センサの基準位置とみなすオフセット位置として設定する設定手段と、前記オフセット位置と前記誘導線とのずれ量を算出してステアリング走行制御するために前記ステアリングモータ及び走行用モータを駆動制御するモータ駆動手段と、前記オフセット位置を、予め定めた距離を走行する毎に前記誘導線検出センサの基準位置に近づけるように新たなオフセット位置に更新するオフセット位置更新手段とを備えている。
【0013】
請求項4に記載の発明では、請求項3に記載の無人車において、前記設定手段は、前記誘導線検出センサの基準位置から予め定めた値以下となるとき、オフセット位置を設定しないことを特徴とする。
【0014】
請求項5に記載の発明では、請求項3に記載の無人車において、前記オフセット位置更新手段は、更新するオフセット位置が前記誘導線検出センサの基準位置から予め定められた値以下となるとき、オフセット位置を設定しないことを特徴とする。
(作用)
請求項1に記載の発明によれば、誘導線検出センサの基準位置と誘導線とのずれ量が生じているとき、オフセット位置と前記誘導線とのずれ量を算出しながらステアリング制御して走行するため、誘導線検出センサの基準位置と誘導線とを一致させるための大きなステアリング角の制御は行われない。そして、前記オフセット位置は、予め定めた距離を走行する毎に誘導線検出センサの基準位置に近づくように更新するようにした。その結果、無人車は誘導線検出センサの基準位置と誘導線とのずれ量がゼロになるまで、大きく蛇行することなく緩やかに収束しながら走行する。
【0015】
請求項2に記載の発明によれば、オフセット位置が誘導線検出センサの基準位置に近い位置にある場合は、誘導線検出センサの基準位置と誘導線との間のずれ量に基づくステアリング制御を行っても、大きく蛇行してステアリング制御がなされることはない。その結果、速やかに誘導線検出センサの基準位置と誘導線とのずれ量をゼロにするためのステアリング制御を行うことができ、その時々でオフセット位置を更新しながらステアリング制御する負荷を軽減することができる。
【0016】
請求項3に記載の発明によれば、モータ駆動手段は、設定手段が設定したオフセット位置と誘導線とのずれ量を算出してステアリング走行制御するために前記ステアリングモータ及び走行用モータを駆動制御する。そして、オフセット位置は、オフセット位置更新手段にて、予め定めた距離を走行する毎に前記誘導線検出センサの基準位置に近づけるように新たなオフセット位置に更新される。その結果、無人車は誘導線検出センサの基準位置と誘導線とのずれ量がゼロになるまで大きく蛇行することなく緩やかに収束しながら走行する。
【0017】
請求項4に記載の発明によれば、オフセット位置を設定する際、オフセット位置が誘導線検出センサの基準位置に近い位置にある場合は、誘導線検出センサの基準位置と誘導線との間のずれ量に基づくステアリング制御を行っても、大きく蛇行してステアリング制御がなされることはない。その結果、速やかに誘導線検出センサの基準位置と誘導線とのずれ量をゼロにするためのステアリング制御を行うことができる。
【0018】
請求項5に記載の発明によれば、オフセット位置を更新する際、オフセット位置が誘導線検出センサの基準位置に近い位置にある場合は、誘導線検出センサの基準位置と誘導線との間のずれ量に基づくステアリング制御を行っても、大きく蛇行してステアリング制御がなされることはない。その結果、速やかに誘導線検出センサの基準位置と誘導線とのずれ量をゼロにするためのステアリング制御を行うことができる。
【0019】
【発明の実施の形態】
以下、本発明を具体化した一実施形態を図1〜図8に従って説明する。
図1及び図2に示すように、無人車としての無人フォークリフト1は、床面Rに敷設した誘導線Lに沿って走行する。また、無人フォークリフト1は、その誘導線Lに沿って走行する走行経路上の所定の位置に設置された磁気マークMを検知し、その検知した磁気マークMに基づいて前進、後進、停止、旋回等の走行制御を実行する。
【0020】
無人フォークリフト1の車体2の前側には、左右一対のリーチレグ3が設けられている。無人フォークリフト1は、車体2の下面に駆動輪4とキャスタ輪5が設けられ、リーチレグ3の先端部下面に従動輪6がそれぞれ設けられている。左右一対のリーチレグ3間には、左右一対のマスト7が前後方向に同リーチレグ3に沿って移動可能に設けられている。左右一対のマスト7間には、リフトブラケット10が配設され、そのリフトブラケット10にフォーク11が設けられている。そして、リフトブラケット10(フォーク11)は図示しないリフトシリンダの伸縮動作に基づいてマスト7に沿って昇降する。
【0021】
前記駆動輪4は走行用モータM1(図3参照)に駆動連結され、走行用モータM1の正逆回転によって回動し、無人フォークリフト1を前後進させる。又、駆動輪4は、ステアリングモータM2(図3参照)にて水平方向に回動されて、そのステアリング角が制御されるようになっている。
【0022】
車体2の下面中央には、誘導線検出センサとしての後部ガイドセンサ12が設けられている。車体2の前側下部中央には、センサ固定部材13が前方に延出形成され、そのセンサ固定部材13の先端部には誘導線検出センサとしての前部ガイドセンサ14が設けられている。この後部ガイドセンサ12及び前部ガイドセンサ14は、前記誘導線Lを検知する。又、車体2の下面には、後部ガイドセンサ12の両側方に一対のマーク検出センサ15が設けられ、前記走行経路上に設置した磁気マークMを検知する。そして、各センサ12,14,15が検知した検知信号は、車体2内に設けた算出手段、設定手段、モータ駆動手段、オフセット位置更新手段としての走行制御装置Cに出力される。
【0023】
次に、上記のように構成した無人フォークリフト1の電気的構成について説明する。
図3において、走行制御装置Cはマイクロコンピュータよりなり、前記後部ガイドセンサ12、前部ガイドセンサ14及びマーク検出センサ15と接続され、各センサ12,14,15から検出信号を入力する。走行制御装置Cは、各センサ12,14,15からの検出信号に基づいて、走行のための各種処理を予め用意されているプログラムに従って実行し、前記走行用モータM1及びステアリングモータM2を駆動制御するようになっている。
【0024】
詳述すると、走行制御装置Cは、無人フォークリフト1が後進走行するとき、後部ガイドセンサ12からの検出信号に基づいて、誘導線Lに対する同後部ガイドセンサ12の基準位置としての中心位置C1(車体2の中心と一致)のずれ量Dを算出する。又、走行制御装置Cは、無人フォークリフト1が前進走行するとき、前部ガイドセンサ14からの検出信号に基づいて、誘導線Lに対する同前部ガイドセンサ14の中心位置C1のずれ量Dを算出する。
【0025】
後部及び前部ガイドセンサ12,14は、図5に示すように、その中心位置(車体2の中心位置と一致)C1が床面Rに敷設された誘導線L上に位置するとき、誘導線Lが中心位置C1にある旨の検出信号を出力する。また、両ガイドセンサ12,14は、図6に示すように、その中心位置C1が床面Rに敷設された誘導線Lに対して左側又は右側にずれている場合、そのずれ量Dに相対した値の検出信号を出力する。そして、走行制御装置Cは、両ガイドセンサ12,14からのずれ量Dに相対した値の検出信号に基づいて誘導線Lに対して中心位置C1(車体2の中心)のずれ量Dを求める。
【0026】
そして、走行制御装置Cは、これら算出したずれ量Dに基づいてステアリングモータM2を回動制御してずれ量Dがゼロになるようにステアリング角を調整(ステアリング走行制御)するようになっている。このステアリング走行制御は、走行制御装置Cに予め記憶されたステアリング走行制御プログラムに従って実行される。
【0027】
さらに、走行制御装置Cは、マーク検出センサ15から磁気マークMを検出した検出信号を入力すると、その検出信号に基づいて次に無人フォークリフト1が実行するのは例えば前進、後進、停止、旋回かを判断し、その判断した走行制御を実行する。
【0028】
また、走行制御装置Cは走行距離検出手段としての走行距離センサ20と接続され、同走行距離センサ20からの検出信号に基づいて、その時々の無人フォークリフト1の走行距離を算出するようになっている。走行距離センサ20は、ロータリエンコーダよりなり、前記駆動輪4の回転に相対してパルス信号(検出信号)を出力する。そして、走行制御装置Cはパルス信号(検出信号)の数をカウントすることによって、走行距離を算出するようになっている。
【0029】
次に、無人フォークリフト1のステアリング走行制御動作について説明する。
いま、図7に示すように、無人フォークリフト1がカーブの誘導線L1に沿って後進走行し直線の誘導線L2まで走行して、後部ガイドセンサ12の中心位置C1が同誘導線L2と一致した状態で停止している。この時、無人フォークリフト1は、直線の誘導線L2に対して前部ガイドセンサ14の中心位置C1がずれた状態で停止している。図7では、無人フォークリフト1は、前部ガイドセンサ14の中心位置C1が直線の誘導線L2に対して左側にずれ量Dだけずれた状態にある。
【0030】
この状態で、無人フォークリフト1が、誘導線L2に沿って矢印方向に前進走行を開始する。この時、走行制御装置Cは、図4に示すフローチャートにしたがったステアリング走行制御プログラムを実行する。
【0031】
走行制御装置Cは、まず、誘導線L1に基づく後進走行モードから誘導線L2に基づく前進走行モードに切替える(ステップS110)。走行制御装置Cは、誘導線L2に基づく前進走行モードに切替えると、前部ガイドセンサ14からの検出信号を有効化し、以後、前部ガイドセンサ14の検出信号に基づいてずれ量Dを算出する。そして、走行制御装置Cは、前部ガイドセンサ14の検出信号を使って停止状態にある無人フォークリフト1のずれ量Dを算出する(ステップS120)。つまり、前部ガイドセンサ14の中心位置C1に対する誘導線L2のずれ量Dを算出する。
【0032】
走行制御装置Cは、ずれ量Dを算出すると、オフセット位置を設定する処理を行う(ステップS130)。この処理は、まず、ずれ量Dが予め定めた値(本実施形態では10mm)を超えているかどうか判断する。この予め定めた値は、この値のずれ量からずれる量ゼロにステアリング制御して走行させると、無人フォークリフト1が大きく蛇行して磁気マークMが検出できないおそれが生じる値に設定している。そして、算出したずれ量Dが予め定めた値以下の場合には、走行制御装置Cは通常のステアリング走行制御を実行する。一方、算出したずれ量Dが予め定めた値を超える場合には、走行制御装置Cはずれ量Dが大きいと判断してオフセット位置を設定する。
【0033】
走行制御装置Cは、本実施形態では、以下のように設定する。まず、算出したずれ量Dをオフセット量として、図6に示すようにその前部ガイドセンサ14の中心位置C1からずれ量Dだけずれた位置を、前記誘導線とのずれ量を算出するための新たな基準位置(オフセット位置C2)と設定する。
【0034】
オフセット位置C2が設定されると、走行制御装置Cは、走行用モータM1を駆動して無人フォークリフト1を前進走行、即ち走行を開始させる(ステップS140)。走行制御装置Cは、走行開始すると内蔵しているカウンタの内容をリセットし、新たな走行距離センサ20からの検出信号(パルス信号)のカウントを開始し、走行距離の計測を開始する(ステップS150)。
【0035】
そして、走行制御装置Cは、走行距離100mmを走行したか否かを判断しながら無人フォークリフト1を走行制御させる(ステップS160)。この間、走行制御装置Cは、走行開始前に設定した前部ガイドセンサ14のオフセット位置と誘導線L1とのずれ量を算出しながら、そのずれ量がゼロになるようにステアリングモータM2を駆動してステアリングを制御している。従って、誘導線L2に対して車体2に中心位置(前部ガイドセンサ14の中心位置C1)はずれ量Dだけずれた位置にあるが、走行制御装置Cはオフセット位置C2を基準にずれ量を算出するため、算出されるずれ量が小さくなる。その結果、走行制御装置Cは、ステアリング角度の小さなステアリング制御をする。
【0036】
走行制御装置Cは、無人フォークリフト1が100mm走行すると(ステップS160でYES)、前記オフセット位置を前記中心位置C1側に1mm近づけた位置を新たなオフセット位置C2として更新する(ステップS170)。続いて、走行制御装置Cは前記カウンタの内容をリセットし、新たな走行距離の計測を開始する(ステップS180)。次に、走行制御装置Cは、更新したオフセット位置C2が中心位置C1から10mm以下の位置にあるかどうか判断する(ステップS190)。そして、走行制御装置Cは、更新したオフセット位置C2が前部ガイドセンサ14の中心位置C1から10mm以下になるまで、ステップS160〜ステップS190の処理動作を繰り返す。従って、走行制御装置Cは、オフセット位置C2が前部ガイドセンサ14の中心位置C1から10mmまでステアリング角度の小さなステアリング制御をしながら無人フォークリフト1を走行させる。その結果、無人フォークリフト1は、大きく蛇行しながら走行することはない。
【0037】
走行制御装置Cは、更新したオフセット位置が前部ガイドセンサ14の中心位置C1から10mm以下になると(ステップS190でYES)、そのオフセット位置C2を無効(ゼロ)にする(ステップS200)。そして、走行制御装置Cは、以後、前部ガイドセンサ14の中心位置C1と直線の誘導線L2のずれ量Dを求めながら通常のステアリング走行制御を実行する。すなわち、図8に示すように、無人フォークリフト1はその車体の中心が直線の誘導線L2上にくるように、ステアリング制御されながら走行する。
【0038】
尚、無人フォークリフト1を後進走行させる場合も同様に走行制御装置Cは実行し、ステアリング走行制御を行う。この後進走行の場合、前部ガイドセンサ14に替えて後部ガイドセンサ12と誘導線Lとのずれ量Dに基づくステアリング走行制御が行われる。また、スイッチバック走行以外の走行であっても、走行開始前のずれ量Dが予め定めた量以上であれば、走行制御装置Cは上記と同様なステアリング走行制御を行う。
【0039】
次に、上記のように構成した無人フォークリフトの効果について説明する。
(1)本実施形態では、走行開始前の前部ガイドセンサ14の中心位置C1と誘導線L2のずれ量Dが予め定めた値(10mm)を超えたとき、そのずれた位置をオフセット位置とし、そのオフセット位置と直線の誘導線L2とのずれ量を算出してステアリング走行制御する。そして、予め定めた距離(100mm)を走行する毎に、オフセット位置C2を、前部ガイドセンサ14の中心位置C1に近づくように更新するようにした。その結果、無人フォークリフト1は前部ガイドセンサ14の中心位置C1(車体2の中心)と直線の誘導線L2とのずれ量Dがゼロになるまで大きく蛇行することなく緩やかに収束しながら走行することができる。
(2)本実施形態では、走行開始前のずれ量Dが予め定めた値(10mm)以下のとき、中心位置C1と直線の誘導線L2とのずれ量Dに基づく通常のステアリング制御を行うようにした。従って、蛇行することなく速やかに誘導線検出センサの基準位置と誘導線とのずれ量をゼロにするためのステアリング制御を行うことができる。
(3)本実施形態では、オフセット位置が更新されて中心位置C1から予め定めた値(10mm)以下になるとき、中心位置C1と直線の誘導線L2とのずれ量Dに基づく通常のステアリング制御を行うようにした。従って、蛇行することなく速やかに誘導線検出センサの基準位置と誘導線とのずれ量をゼロにするためのステアリング制御を行うことができる。
【0040】
なお、発明の実施の形態は、上記実施形態に限定されるものではなく、以下のように実施してもよい。
○上記実施形態では、オフセット位置C2を1mmずつ中心位置C1に近づく位置に更新させたが、それ以外の値で更新してもよい。また、一定の間隔(1mm)でオフセット位置C2を更新したが、一定でなくともよい。例えば、最初は大きく中心位置C1に近づけた位置にオフセット位置C2を設定し、更新する毎に中心位置C1に近づける割合を小さくする。
【0041】
○上記実施形態では、走行開始する際のオフセット位置C2は、開始前に算出したずれ量Dの位置としたが、これに限定されるものではない。例えば、ずれ量Dより小さく中心位置C1から近い位置をオフセット位置C2に設定してもよい。この場合、無人フォークリフト1は前部ガイドセンサ14の中心位置C1(車体2の中心)と直線の誘導線L2とのずれ量Dがゼロになるまで収束時間が速くなる。
【0042】
○上記実施形態では、走行開始する際、ずれ量Dが10mm以下のとき、中心位置C1と直線の誘導線L2とのずれ量Dに基づく通常のステアリング制御になるようにしたが、10mmに限定されず適宜変更してもよい。例えば、走行速度との関係で5mm、15mm等適宜変更する。
【0043】
○上記実施形態では、更新するオフセット位置C2が中心位置C1から10mm以下になったとき、オフセット位置C2から中心位置C1と直線の誘導線L2とのずれ量Dに基づく通常のステアリング制御になるようにしたが、10mmに限定されず適宜変更してもよい。例えば、走行速度との関係で5mm、15mm等適宜変更する。
【0044】
○上記実施形態では、100mm走行する毎に、オフセット位置C2を更新するようにしたが、50mm、150mm、200mm、又はそれ以上、適宜変更して実施してもよい。
【0045】
○上記実施形態では、無人車として無人フォークリフト1に具体化したが、例えば無人搬送車等、誘導線に沿って走行する無人車に具体化してもよい。
○上記実施形態では、前部ガイドセンサ14の中心位置C1を基準位置としたがこれに限定されるものではない。要は車体2の中心位置との関係が特定できれば基準位置を適宜変更してもよい。
【0046】
【発明の効果】
本発明によれば、車体の中心と誘導線とのずれ量がゼロになるまで大きく蛇行することなく緩やかに収束しながら走行することができる。
【図面の簡単な説明】
【図1】一実施形態の無人フォークリフトの側面図。
【図2】無人フォークリフトの平面図。
【図3】無人フォークリフトの電気的構成を示すブロック図。
【図4】ステアリング走行制御プログラムのフローチャート。
【図5】ガイドセンサと誘導線との関係を説明するための模式図。
【図6】オフセット位置設定を説明するための模式図。
【図7】無人フォークリフトのオフセット位置設定時の説明図。
【図8】無人フォークリフトのオフセット位置がゼロになった時の説明図。
【図9】従来の無人フォークリフトの進行方向切替え時の説明図。
【符号の説明】
1…無人フォークリフト、2…車体、12…誘導線検出センサとしての後部ガイドセンサ、14…誘導線検出センサとしての前部ガイドセンサ、15…マーク検出センサ、20…走行距離検出手段としての走行距離センサ、C…算出手段、設定手段、モータ駆動手段、オフセット位置更新手段としての走行制御装置、D…ずれ量、L…誘導線、M…磁気マーク、C1…中心位置、C2…オフセット位置、L1…カーブの誘導線、L2…直線の誘導線、M1…走行用モータ、M2…ステアリングモータ。
[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a driving control method for an unmanned vehicle and an unmanned vehicle.
[0002]
[Prior art]
An unmanned forklift travels along a guide wire such as a magnetic bar laid vertically and horizontally on a floor surface, and unloads the load handling work by placing the load at the loading place on the fork and transporting it to the loading place. This type of unmanned forklift is provided with a guide sensor in front of and behind the vehicle, and the guide sensor measures the amount of deviation between the guide wire and the center of the unmanned forklift. Then, the unmanned forklift is caused to travel along the guide line by controlling the steering angle so that the guide line and the center of the unmanned forklift coincide with each other based on the measured deviation amount. In general, this type of unmanned forklift has a large meandering angle until the steering angle increases and the center of the unmanned forklift travels along the guide line when the deviation amount is large.
[0003]
The traveling of the unmanned forklift includes the switchback traveling shown in FIGS. 9 (a) to 9 (c). In the switchback traveling, an unmanned forklift 61 that travels (reverse travel) along a curved guide line L1 is placed on a straight guide line L2, and then temporarily stopped at the straight guide line L2. Then, the unmanned forklift 61 travels (moves forward) along the straight guide line L2 to move the unmanned forklift 61 from the curved guide line L1 to the straight guide line L2, thereby changing the travel direction.
[0004]
By the way, in this switchback running, the amount of deviation between the center of the unmanned forklift 61 and the straight guide line L2 is very large immediately before the unmanned forklift 61 moves from the curved guide line L1 to the running control based on the straight guide line L2. large. Therefore, when the unmanned forklift 61 moves from the curved guide line L1 to the straight guide line L2, the center of the unmanned forklift 61 and the straight guide line L2 are aligned along the straight guide line L2 at a considerable distance until they coincide with each other. It was necessary to run the unmanned forklift 61 (reverse running).
[0005]
However, for example, when a loading place or a loading place is provided in the vicinity where the curved guide line L1 and the straight guide line L2 overlap, the unmanned forklift 61 has a deviation amount between the center and the straight guide line L2. Stopped in a very large state and had to carry out loading or loading work. Therefore, when the amount of deviation between the center of the unmanned forklift 61 and the straight guide line L2 is large, a technique has been proposed that enables loading or loading work by shifting the fork in the width direction based on the amount of deviation. (For example, Patent Document 1).
[0006]
[Patent Document 1]
Japanese Patent Laid-Open No. 2003-63790
[Problems to be solved by the invention]
However, when the unloading or loading operation is finished and the unmanned forklift 61 travels (moves forward) along the straight guide line L2, the unmanned forklift 61 travels in a meandering manner because the displacement is very large. Will do. This is because the unmanned forklift 61 travels in a meandering manner even when the straight guide line L2 cannot be laid sufficiently long in the reverse travel direction of the unmanned forklift 61.
[0008]
In such a meandering manner, there is a problem that a mark such as a magnetic mark for instructing operation information provided on the traveling route on the floor is read out and the efficiency of the cargo handling work is lowered.
[0009]
The present invention has been made to solve the above problems, and its purpose is to travel while slowly converging without greatly meandering until the amount of deviation between the center of the vehicle body and the guide line becomes zero. It is an object of the present invention to provide an unmanned vehicle traveling control method and an unmanned vehicle.
[0010]
[Means for Solving the Problems]
According to the first aspect of the present invention, the guide line laid on the floor surface is detected by the guide line detection sensor provided in the vehicle body, and the deviation amount between the guide line and the reference position of the guide line detection sensor is calculated. In the driving control method for an unmanned vehicle that is controlled by steering so that the guide line and the reference position of the guide line detection sensor coincide with each other based on the calculated deviation amount, Based on this, a position coincident with the displaced position or a position close to the displaced position is set as an offset position which is regarded as a reference position of the guide line detection sensor, and a deviation amount between the offset position and the guide line is calculated. The steering control is performed while the vehicle is traveling, and the offset position is brought closer to the reference position of the guide wire detection sensor every time a predetermined distance is traveled. As its gist that is weight was adapted to run while determined.
[0011]
According to a second aspect of the present invention, in the driving control method for an unmanned vehicle according to the first aspect, when the offset position is not more than a predetermined value from a reference position of the guiding line detection sensor, the guiding line detection sensor The amount of deviation between the reference position and the guide line is calculated.
[0012]
In the invention according to claim 3, in the unmanned vehicle, a traveling motor for driving the drive wheels, a steering motor for adjusting the steering angle of the drive wheels, and a guide wire detection sensor for detecting a guide wire laid on the floor surface A travel distance detection means for detecting a travel distance, a calculation means for calculating a shift amount between the guide line and the reference position of the guide line detection sensor based on the guide line detection sensor, and a calculation based on the calculated shift amount. A setting means for setting a position that coincides with the shifted position or a position close to the shifted position as an offset position that is regarded as a reference position of the guide line detection sensor, and calculates a shift amount between the offset position and the guide line Motor drive means for driving and controlling the steering motor and the travel motor for steering travel control, and the offset position with a predetermined distance. And a offset position updating means for updating to a new offset position so close to the reference position of the guide line detecting sensor every time the traveling.
[0013]
According to a fourth aspect of the present invention, in the unmanned vehicle according to the third aspect, the setting means does not set an offset position when the setting means is equal to or less than a predetermined value from a reference position of the guide wire detection sensor. And
[0014]
According to a fifth aspect of the present invention, in the unmanned vehicle according to the third aspect, the offset position updating means is configured such that the offset position to be updated is equal to or less than a predetermined value from a reference position of the guide line detection sensor. The offset position is not set.
(Function)
According to the first aspect of the present invention, when there is a deviation amount between the reference position of the guide line detection sensor and the guide line, the steering control is performed while calculating the deviation amount between the offset position and the guide line. Therefore, a large steering angle control for matching the reference position of the guide line detection sensor with the guide line is not performed. The offset position is updated so as to approach the reference position of the guide line detection sensor every time the vehicle travels a predetermined distance. As a result, the unmanned vehicle travels while slowly converging without greatly meandering until the amount of deviation between the reference position of the guide line detection sensor and the guide line becomes zero.
[0015]
According to the second aspect of the present invention, when the offset position is close to the reference position of the guide line detection sensor, the steering control based on the amount of deviation between the reference position of the guide line detection sensor and the guide line is performed. Even if it goes, it does not meander and the steering control is not performed. As a result, it is possible to quickly perform steering control to zero the deviation between the reference position of the guide line detection sensor and the guide line, and reduce the load of steering control while updating the offset position from time to time. Can do.
[0016]
According to a third aspect of the present invention, the motor driving means drives and controls the steering motor and the traveling motor in order to calculate a deviation amount between the offset position set by the setting means and the guide wire and to perform steering traveling control. To do. The offset position is updated to a new offset position by the offset position updating means so as to approach the reference position of the guide line detection sensor every time the vehicle travels a predetermined distance. As a result, the unmanned vehicle travels while slowly converging without greatly meandering until the amount of deviation between the reference position of the guide line detection sensor and the guide line becomes zero.
[0017]
According to the fourth aspect of the present invention, when the offset position is set, if the offset position is close to the reference position of the guide line detection sensor, the offset position is between the reference position of the guide line detection sensor and the guide line. Even if the steering control based on the deviation amount is performed, the steering control is not performed by meandering greatly. As a result, it is possible to quickly perform steering control for making the amount of deviation between the reference position of the guide line detection sensor and the guide line zero.
[0018]
According to the fifth aspect of the present invention, when the offset position is updated, if the offset position is close to the reference position of the guide line detection sensor, the offset position is between the reference position of the guide line detection sensor and the guide line. Even if the steering control based on the deviation amount is performed, the steering control is not performed by meandering greatly. As a result, it is possible to quickly perform steering control for making the amount of deviation between the reference position of the guide line detection sensor and the guide line zero.
[0019]
DETAILED DESCRIPTION OF THE INVENTION
Hereinafter, an embodiment embodying the present invention will be described with reference to FIGS.
As shown in FIGS. 1 and 2, the unmanned forklift 1 as an unmanned vehicle travels along a guide line L laid on the floor surface R. Further, the unmanned forklift 1 detects a magnetic mark M installed at a predetermined position on a travel route that travels along the guide line L, and moves forward, backward, stop, and turn based on the detected magnetic mark M. The traveling control such as is executed.
[0020]
A pair of left and right reach legs 3 are provided on the front side of the vehicle body 2 of the unmanned forklift 1. The unmanned forklift 1 is provided with drive wheels 4 and caster wheels 5 on the lower surface of the vehicle body 2, and driven wheels 6 on the lower surface of the front end of the reach leg 3. A pair of left and right masts 7 are provided between the pair of left and right reach legs 3 so as to be movable along the reach leg 3 in the front-rear direction. A lift bracket 10 is disposed between the pair of left and right masts 7, and a fork 11 is provided on the lift bracket 10. The lift bracket 10 (fork 11) moves up and down along the mast 7 based on the expansion and contraction operation of a lift cylinder (not shown).
[0021]
The drive wheel 4 is drivingly connected to a traveling motor M1 (see FIG. 3), and is rotated by forward and reverse rotation of the traveling motor M1 to move the unmanned forklift 1 forward and backward. The drive wheels 4 are rotated in the horizontal direction by a steering motor M2 (see FIG. 3), and the steering angle is controlled.
[0022]
In the center of the lower surface of the vehicle body 2, a rear guide sensor 12 as a guide line detection sensor is provided. A sensor fixing member 13 is formed to extend forward at the front lower center of the vehicle body 2, and a front guide sensor 14 as a guide wire detection sensor is provided at the tip of the sensor fixing member 13. The rear guide sensor 12 and the front guide sensor 14 detect the guide wire L. A pair of mark detection sensors 15 are provided on both sides of the rear guide sensor 12 on the lower surface of the vehicle body 2 to detect the magnetic marks M installed on the travel route. The detection signals detected by the sensors 12, 14, 15 are output to the travel control device C as calculation means, setting means, motor driving means, and offset position updating means provided in the vehicle body 2.
[0023]
Next, the electrical configuration of the unmanned forklift 1 configured as described above will be described.
In FIG. 3, the travel control device C is composed of a microcomputer and is connected to the rear guide sensor 12, the front guide sensor 14 and the mark detection sensor 15, and receives detection signals from the sensors 12, 14 and 15. The traveling control device C executes various processes for traveling according to a program prepared in advance based on detection signals from the sensors 12, 14, and 15 to drive-control the traveling motor M1 and the steering motor M2. It is supposed to be.
[0024]
More specifically, the traveling control device C, when the unmanned forklift 1 travels backward, based on a detection signal from the rear guide sensor 12, a center position C1 (vehicle body) as a reference position of the rear guide sensor 12 with respect to the guide line L. 2) (which coincides with the center of 2). Further, when the unmanned forklift 1 travels forward, the travel control device C calculates a deviation amount D of the center position C1 of the front guide sensor 14 with respect to the guide line L based on a detection signal from the front guide sensor 14. To do.
[0025]
As shown in FIG. 5, the rear and front guide sensors 12, 14 are guided when the center position (coincides with the center position of the vehicle body 2) C 1 is positioned on the guide line L laid on the floor surface R. A detection signal indicating that L is at the center position C1 is output. Further, as shown in FIG. 6, when the center position C1 is shifted to the left side or the right side with respect to the guide line L laid on the floor surface R, the both guide sensors 12 and 14 are relative to the shift amount D. The detection signal with the specified value is output. Then, the traveling control device C obtains a deviation amount D of the center position C1 (the center of the vehicle body 2) with respect to the guide line L based on a detection signal having a value relative to the deviation amount D from both the guide sensors 12 and 14. .
[0026]
The traveling control device C adjusts the steering angle (steering traveling control) so that the deviation amount D becomes zero by controlling the steering motor M2 to rotate based on the calculated deviation amount D. . This steering travel control is executed according to a steering travel control program stored in advance in the travel control device C.
[0027]
Further, when the traveling control device C receives a detection signal for detecting the magnetic mark M from the mark detection sensor 15, the unmanned forklift 1 performs next based on the detection signal, for example, forward, reverse, stop, or turn. And the determined traveling control is executed.
[0028]
The travel control device C is connected to a travel distance sensor 20 as travel distance detection means, and calculates the travel distance of the unmanned forklift 1 at that time based on a detection signal from the travel distance sensor 20. Yes. The travel distance sensor 20 is composed of a rotary encoder, and outputs a pulse signal (detection signal) relative to the rotation of the drive wheel 4. The traveling control device C calculates the traveling distance by counting the number of pulse signals (detection signals).
[0029]
Next, the steering travel control operation of the unmanned forklift 1 will be described.
Now, as shown in FIG. 7, the unmanned forklift 1 travels backward along the curve guide line L1 to the straight guide line L2, and the center position C1 of the rear guide sensor 12 coincides with the guide line L2. Stopped in a state. At this time, the unmanned forklift 1 is stopped in a state where the center position C1 of the front guide sensor 14 is deviated from the straight guide line L2. In FIG. 7, the unmanned forklift 1 is in a state where the center position C1 of the front guide sensor 14 is shifted to the left by a shift amount D with respect to the straight guide line L2.
[0030]
In this state, the unmanned forklift 1 starts traveling forward in the arrow direction along the guide line L2. At this time, the traveling control device C executes a steering traveling control program according to the flowchart shown in FIG.
[0031]
The travel control device C first switches from the reverse travel mode based on the guide line L1 to the forward travel mode based on the guide line L2 (step S110). When the traveling control device C switches to the forward traveling mode based on the guide line L2, the traveling control device C validates the detection signal from the front guide sensor 14, and thereafter calculates the shift amount D based on the detection signal of the front guide sensor 14. . Then, the traveling control device C calculates the deviation amount D of the unmanned forklift 1 in the stopped state using the detection signal of the front guide sensor 14 (step S120). That is, the shift amount D of the guide line L2 with respect to the center position C1 of the front guide sensor 14 is calculated.
[0032]
When calculating the deviation amount D, the traveling control device C performs a process of setting an offset position (step S130). In this process, first, it is determined whether or not the deviation amount D exceeds a predetermined value (10 mm in the present embodiment). The predetermined value is set to a value that may cause the unmanned forklift 1 to meander greatly and cause the magnetic mark M to be undetectable when the vehicle is driven by steering control to an amount that deviates from the deviation amount of the value. And when the calculated deviation | shift amount D is below a predetermined value, the traveling control apparatus C performs normal steering traveling control. On the other hand, when the calculated deviation amount D exceeds a predetermined value, the traveling control device C determines that the deviation amount D is large and sets the offset position.
[0033]
The travel control device C is set as follows in the present embodiment. First, using the calculated shift amount D as an offset amount, as shown in FIG. 6, a position shifted by the shift amount D from the center position C1 of the front guide sensor 14 is used to calculate the shift amount from the guide line. A new reference position (offset position C2) is set.
[0034]
When the offset position C2 is set, the traveling control device C drives the traveling motor M1 to start the unmanned forklift 1 traveling forward, that is, traveling (step S140). The travel control device C resets the content of the built-in counter when the travel starts, starts counting the detection signal (pulse signal) from the new travel distance sensor 20, and starts measuring the travel distance (step S150). ).
[0035]
Then, the traveling control device C controls traveling of the unmanned forklift 1 while determining whether or not the traveling distance is 100 mm (step S160). During this time, the traveling control device C drives the steering motor M2 so that the amount of deviation is zero while calculating the amount of deviation between the offset position of the front guide sensor 14 set before the start of traveling and the guide line L1. The steering is controlled. Therefore, although the center position of the vehicle body 2 (the center position C1 of the front guide sensor 14) is shifted by the shift amount D with respect to the guide line L2, the traveling control device C calculates the shift amount based on the offset position C2. Therefore, the calculated shift amount becomes small. As a result, the traveling control device C performs steering control with a small steering angle.
[0036]
When the unmanned forklift 1 travels 100 mm (YES in step S160), the traveling control device C updates the position where the offset position is closer to the central position C1 by 1 mm as a new offset position C2 (step S170). Subsequently, the traveling control device C resets the contents of the counter and starts measuring a new traveling distance (step S180). Next, the traveling control device C determines whether or not the updated offset position C2 is 10 mm or less from the center position C1 (step S190). Then, the traveling control device C repeats the processing operations of Step S160 to Step S190 until the updated offset position C2 becomes 10 mm or less from the center position C1 of the front guide sensor 14. Accordingly, the traveling control device C causes the unmanned forklift 1 to travel while performing steering control with a small steering angle from the center position C1 of the front guide sensor 14 to the offset position C2 of 10 mm. As a result, the unmanned forklift 1 does not travel while meandering.
[0037]
When the updated offset position is 10 mm or less from the center position C1 of the front guide sensor 14 (YES in step S190), the traveling control device C invalidates (zeros) the offset position C2 (step S200). Subsequently, the traveling control device C executes normal steering traveling control while obtaining a deviation amount D between the center position C1 of the front guide sensor 14 and the straight guide line L2. That is, as shown in FIG. 8, the unmanned forklift 1 travels while being controlled by the steering so that the center of the vehicle body is on the straight guide line L2.
[0038]
In addition, also when making the unmanned forklift 1 drive backward, the traveling control device C executes similarly and performs steering traveling control. In the case of this reverse travel, steering travel control is performed based on a deviation amount D between the rear guide sensor 12 and the guide wire L instead of the front guide sensor 14. Even in travel other than switchback travel, the travel control device C performs the same steering travel control as described above if the deviation amount D before the start of travel is greater than or equal to a predetermined amount.
[0039]
Next, the effect of the unmanned forklift constructed as described above will be described.
(1) In this embodiment, when the deviation amount D between the center position C1 of the front guide sensor 14 and the guide line L2 before the start of traveling exceeds a predetermined value (10 mm), the displaced position is set as an offset position. Then, the amount of deviation between the offset position and the straight guide line L2 is calculated to control the steering travel. Each time the vehicle travels a predetermined distance (100 mm), the offset position C2 is updated so as to approach the center position C1 of the front guide sensor 14. As a result, the unmanned forklift 1 travels while slowly converging without greatly meandering until the deviation D between the center position C1 (center of the vehicle body 2) of the front guide sensor 14 and the straight guide line L2 becomes zero. be able to.
(2) In this embodiment, when the deviation amount D before the start of traveling is equal to or less than a predetermined value (10 mm), normal steering control is performed based on the deviation amount D between the center position C1 and the straight guide line L2. I made it. Accordingly, it is possible to quickly perform steering control for making the amount of deviation between the reference position of the guide line detection sensor and the guide line zero without meandering.
(3) In the present embodiment, when the offset position is updated to be equal to or less than a predetermined value (10 mm) from the center position C1, normal steering control based on the deviation amount D between the center position C1 and the straight guide line L2 To do. Accordingly, it is possible to quickly perform steering control for making the amount of deviation between the reference position of the guide line detection sensor and the guide line zero without meandering.
[0040]
In addition, embodiment of invention is not limited to the said embodiment, You may implement as follows.
In the above embodiment, the offset position C2 is updated to a position approaching the center position C1 by 1 mm, but may be updated with other values. Further, although the offset position C2 is updated at a constant interval (1 mm), it may not be constant. For example, the offset position C2 is initially set at a position that is largely close to the center position C1, and the ratio of approaching the center position C1 is reduced each time it is updated.
[0041]
In the above embodiment, the offset position C2 when starting traveling is the position of the deviation amount D calculated before the start, but is not limited to this. For example, a position smaller than the shift amount D and close to the center position C1 may be set as the offset position C2. In this case, the unmanned forklift 1 has a faster convergence time until the deviation amount D between the center position C1 of the front guide sensor 14 (the center of the vehicle body 2) and the straight guide line L2 becomes zero.
[0042]
In the above embodiment, when starting the running, when the deviation amount D is 10 mm or less, the normal steering control based on the deviation amount D between the center position C1 and the straight guide line L2 is performed. However, it is limited to 10 mm. It may be changed as appropriate. For example, 5 mm, 15 mm, etc. are appropriately changed in relation to the traveling speed.
[0043]
In the above embodiment, when the offset position C2 to be updated becomes 10 mm or less from the center position C1, normal steering control is performed based on the deviation amount D between the center position C1 and the straight guide line L2 from the offset position C2. However, it is not limited to 10 mm and may be changed as appropriate. For example, 5 mm, 15 mm, etc. are appropriately changed in relation to the traveling speed.
[0044]
In the above-described embodiment, the offset position C2 is updated every time the vehicle travels 100 mm. However, the offset position C2 may be appropriately changed to 50 mm, 150 mm, 200 mm, or more.
[0045]
In the above embodiment, the unmanned forklift 1 is embodied as an unmanned vehicle, but may be embodied as an unmanned vehicle that travels along a guide line, such as an unmanned transport vehicle.
In the above embodiment, the center position C1 of the front guide sensor 14 is the reference position, but the present invention is not limited to this. In short, the reference position may be appropriately changed as long as the relationship with the center position of the vehicle body 2 can be specified.
[0046]
【The invention's effect】
According to the present invention, the vehicle can travel while slowly converging without greatly meandering until the amount of deviation between the center of the vehicle body and the guide line becomes zero.
[Brief description of the drawings]
FIG. 1 is a side view of an unmanned forklift according to an embodiment.
FIG. 2 is a plan view of an unmanned forklift.
FIG. 3 is a block diagram showing an electrical configuration of an unmanned forklift.
FIG. 4 is a flowchart of a steering travel control program.
FIG. 5 is a schematic diagram for explaining a relationship between a guide sensor and a guide wire.
FIG. 6 is a schematic diagram for explaining offset position setting.
FIG. 7 is an explanatory diagram when setting an offset position of an unmanned forklift.
FIG. 8 is an explanatory diagram when the offset position of the unmanned forklift becomes zero.
FIG. 9 is an explanatory diagram when switching the traveling direction of a conventional unmanned forklift.
[Explanation of symbols]
DESCRIPTION OF SYMBOLS 1 ... Unmanned forklift, 2 ... Vehicle body, 12 ... Rear guide sensor as guide line detection sensor, 14 ... Front guide sensor as guide line detection sensor, 15 ... Mark detection sensor, 20 ... Travel distance as travel distance detection means Sensor, C: calculating means, setting means, motor driving means, travel control device as offset position updating means, D: deviation amount, L: guide wire, M ... magnetic mark, C1 ... center position, C2 ... offset position, L1 ... curve induction line, L2 ... straight induction line, M1 ... travel motor, M2 ... steering motor.

Claims (5)

床面に敷設された誘導線を車体に備えられた誘導線検出センサで検出し、前記誘導線と前記誘導線検出センサの基準位置とのずれ量を算出し、その算出したずれ量に基づいて前記誘導線と前記誘導線検出センサの基準位置とが一致するようにステアリング制御して走行するようにした無人車の走行制御方法において、
前記算出したずれ量に基づいて、そのずれた位置と一致した位置又はそのずれた位置に近い位置を、前記誘導線検出センサの基準位置とみなすオフセット位置として設定し、そのオフセット位置と前記誘導線とのずれ量を算出しながらステアリング制御して走行するとともに、前記オフセット位置について予め定めた距離を走行する毎に前記誘導線検出センサの基準位置に近づけるようにして前記ずれ量を求めながら走行するようにした無人車の走行制御方法。
A guide line laid on the floor is detected by a guide line detection sensor provided in the vehicle body, and a deviation amount between the guide line and a reference position of the guide line detection sensor is calculated, and based on the calculated deviation amount. In the traveling control method of the unmanned vehicle, the steering control is performed so that the guide line and the reference position of the guide line detection sensor coincide with each other.
Based on the calculated displacement amount, a position that coincides with the displaced position or a position close to the displaced position is set as an offset position that is regarded as a reference position of the guiding line detection sensor, and the offset position and the guiding line are set. The vehicle travels with steering control while calculating the deviation amount, and calculates the deviation amount so as to approach the reference position of the guide line detection sensor every time the offset position travels a predetermined distance. The unmanned vehicle traveling control method.
請求項1に記載の無人車の走行制御方法において、
前記オフセット位置が前記誘導線検出センサの基準位置から予め定めた値以下となるとき、前記誘導線検出センサの基準位置と誘導線とのずれ量を算出するようにしたことを特徴とする無人車の走行制御方法。
In the driving control method of the unmanned vehicle according to claim 1,
An unmanned vehicle characterized in that when the offset position is equal to or less than a predetermined value from the reference position of the guide line detection sensor, a deviation amount between the reference position of the guide line detection sensor and the guide line is calculated. Driving control method.
駆動輪を駆動させる走行用モータと、
駆動輪のステアリング角を調整するステアリングモータと、
床面に敷設された誘導線を検出する誘導線検出センサと、
走行距離を検出する走行距離検出手段と、
誘導線検出センサに基づいて誘導線と前記誘導線検出センサの基準位置とのずれ量を算出する算出手段と、
前記算出したずれ量に基づいて、そのずれた位置と一致した位置又はそのずれた位置に近い位置を前記誘導線検出センサの基準位置とみなすオフセット位置として設定する設定手段と、
前記オフセット位置と前記誘導線とのずれ量を算出してステアリング走行制御するために前記ステアリングモータ及び走行用モータを駆動制御するモータ駆動手段と、
前記オフセット位置を、予め定めた距離を走行する毎に前記誘導線検出センサの基準位置に近づけるように新たなオフセット位置に更新するオフセット位置更新手段と
を備えた無人車。
A traveling motor for driving the drive wheels;
A steering motor for adjusting the steering angle of the drive wheels;
A guide wire detection sensor for detecting a guide wire laid on the floor;
Mileage detecting means for detecting the mileage;
Calculating means for calculating a deviation amount between the guide line and the reference position of the guide line detection sensor based on the guide line detection sensor;
Based on the calculated displacement amount, a setting means for setting a position that coincides with the displaced position or a position close to the displaced position as an offset position that is regarded as a reference position of the guide line detection sensor;
Motor driving means for driving and controlling the steering motor and the traveling motor in order to calculate a deviation amount between the offset position and the guide wire and to perform steering traveling control;
An unmanned vehicle comprising offset position updating means for updating the offset position to a new offset position so as to approach the reference position of the guide line detection sensor every time the vehicle travels a predetermined distance.
請求項3に記載の無人車において、前記設定手段は、前記誘導線検出センサの基準位置から予め定めた値以下となるとき、オフセット位置を設定しないことを特徴とする無人車。4. The unmanned vehicle according to claim 3, wherein the setting means does not set an offset position when the setting means falls below a predetermined value from a reference position of the guide wire detection sensor. 請求項3に記載の無人車において、前記オフセット位置更新手段は、更新するオフセット位置が前記誘導線検出センサの基準位置から予め定められた値以下となるとき、オフセット位置を設定しないことを特徴とする無人車。The unmanned vehicle according to claim 3, wherein the offset position update means does not set the offset position when the offset position to be updated is equal to or less than a predetermined value from a reference position of the guide wire detection sensor. Unmanned vehicle to do.
JP2003200391A 2003-07-23 2003-07-23 Unmanned vehicle travel control method and unmanned vehicle Expired - Fee Related JP4360138B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2003200391A JP4360138B2 (en) 2003-07-23 2003-07-23 Unmanned vehicle travel control method and unmanned vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2003200391A JP4360138B2 (en) 2003-07-23 2003-07-23 Unmanned vehicle travel control method and unmanned vehicle

Publications (2)

Publication Number Publication Date
JP2005041597A true JP2005041597A (en) 2005-02-17
JP4360138B2 JP4360138B2 (en) 2009-11-11

Family

ID=34260811

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2003200391A Expired - Fee Related JP4360138B2 (en) 2003-07-23 2003-07-23 Unmanned vehicle travel control method and unmanned vehicle

Country Status (1)

Country Link
JP (1) JP4360138B2 (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2014088081A (en) * 2012-10-30 2014-05-15 Alpine Electronics Inc Automatic parking device and automatic parking control method
CN109160453A (en) * 2018-09-29 2019-01-08 杭叉集团股份有限公司 A kind of fork truck
WO2022021525A1 (en) * 2020-07-31 2022-02-03 安徽泗州拖拉机制造有限公司 Automatic navigation and steering system for unmanned tractor

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2014088081A (en) * 2012-10-30 2014-05-15 Alpine Electronics Inc Automatic parking device and automatic parking control method
CN109160453A (en) * 2018-09-29 2019-01-08 杭叉集团股份有限公司 A kind of fork truck
CN109160453B (en) * 2018-09-29 2023-12-12 杭叉集团股份有限公司 Fork truck
WO2022021525A1 (en) * 2020-07-31 2022-02-03 安徽泗州拖拉机制造有限公司 Automatic navigation and steering system for unmanned tractor

Also Published As

Publication number Publication date
JP4360138B2 (en) 2009-11-11

Similar Documents

Publication Publication Date Title
JP2014137710A (en) Control method of automatic guided vehicle
JP4360138B2 (en) Unmanned vehicle travel control method and unmanned vehicle
JP4318167B2 (en) Forklift cargo handling assist device
JP2000330635A (en) Automatic guided vehicle
JP3275364B2 (en) Reverse traveling control method for automatic guided vehicles
JP4168895B2 (en) Travel control device for mobile body and mobile body
JP3804142B2 (en) Unmanned vehicle steering control method
JP5882130B2 (en) Transport device
JP2011243129A (en) Transportation vehicle system
JP3613547B2 (en) Control method of automatic guided vehicle
JP2002338010A (en) Rail-less movable rack
JP2005330076A (en) Combined system of moving shelf and unmanned forklift
JP4159435B2 (en) Auto guidance vehicle
JP2001022442A (en) Control method for automatic guided vehicle
JP2002123315A (en) Magnetic guide line
JP3941176B2 (en) Driving control method and driving control device for unmanned vehicles
JP3134551B2 (en) Travel control method for automatic guided vehicles
JP2005250574A (en) Automatic guided vehicle and driving method for it
JPH08305439A (en) Guiding method for unmanned vehicle
JP3022503B2 (en) Transport trolley
JP2002123316A (en) Unmanned carriage and its operation control method
JP2004078703A (en) Turning controller
JPH09269820A (en) Vehicle guiding device
JPH0748164B2 (en) Method and device for automatically raising and lowering a sensor in an automatic vehicle steering system
JP2996009B2 (en) Driving control method for unmanned vehicles

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20051213

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20080930

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20081125

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20090126

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20090721

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20090803

R151 Written notification of patent or utility model registration

Ref document number: 4360138

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120821

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130821

Year of fee payment: 4

LAPS Cancellation because of no payment of annual fees