JPH0324606A - 移動ロボットの経路指定方法 - Google Patents

移動ロボットの経路指定方法

Info

Publication number
JPH0324606A
JPH0324606A JP1158251A JP15825189A JPH0324606A JP H0324606 A JPH0324606 A JP H0324606A JP 1158251 A JP1158251 A JP 1158251A JP 15825189 A JP15825189 A JP 15825189A JP H0324606 A JPH0324606 A JP H0324606A
Authority
JP
Japan
Prior art keywords
route
curvature
cubic
curve
mobile robot
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
JP1158251A
Other languages
English (en)
Inventor
Yutaka Kanayama
金山　裕
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.)
Shinko Electric Co Ltd
Sohgo Security Services Co Ltd
Original Assignee
Shinko Electric Co Ltd
Sohgo Security Services Co Ltd
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 Shinko Electric Co Ltd, Sohgo Security Services Co Ltd filed Critical Shinko Electric Co Ltd
Priority to JP1158251A priority Critical patent/JPH0324606A/ja
Priority to US07/540,152 priority patent/US5109340A/en
Priority to FR9007833A priority patent/FR2648934A1/fr
Publication of JPH0324606A publication Critical patent/JPH0324606A/ja
Pending legal-status Critical Current

Links

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • 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/0259—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
    • G05D1/0263—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means using magnetic strips

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)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 〔産業上の利用分野］ 本発明は、無人搬送車などの移動ロボットの経路、特に
カーブ走行経路を指定する指定方法に関する． 〔従来の技術〕 無人搬送車には、路面に布設した磁気テープあるいは誘
導線等で走行経路を指定され、無人車の車体下部に取着
したガイドセンサにより誘導線に対する車体のずれを修
正しつつ走行する誘導線方式のものと、自律形無人車と
呼ばれるものがある．この自律形無人車は、例えば、指
令部と走行部を有し、指令部から通信手段を介して所定
時間間隔で車上の走行部へコマンドを送ることにより、
走行経路を指定する型のものである． この自律形無人搬送車のシステムでは、全体の走行経路
を区分し、各区分に対して区分走行経路を指定し、この
区分走行経路を複数点に分割して各分割点に参照姿勢を
与え、分割点の座標と参照姿勢に基づき作威した速度指
令と角速度指令を目目標値として無人搬送車をフィード
バック制御する． 〔発明が解決しようとする課題〕 この種の移動ロボットシステムにおいて、上記区分走行
経路がカーブ走行経路である場合、従来は、主として円
弧もしくは円弧の組合せで指定しているが、円弧は、そ
の両端を含む任意の点において、０でない曲率を有する
から、この円弧経路部分に接線方向を等しくして他の円
弧もしくは直線経路を接続しても、接続部において曲率
が不連続に変化する． このため、従来の移動ロボットシステムでは、直線経路
は問題は無いが、上記カーブ経路とこれに連続する経路
との接続部分では、瞬時に不連続な曲率変化に追随させ
ることは不可能なので、移動ロボットの走行が乱れてオ
ーバーシュートが起こりやすいという問題があった。
本発明は上記問題を解消するためになされたもので、従
来に比して、滑らかなカーブ走行を行わせることができ
る上、カーブ走行経路と他の走行経路間の乗り移りも滑
らかに行わせることができる移動ロボットの経路指定方
法を提供することを目的とする． 〔課題を解決するための手段〕 本発明は上記目的を達戒するため、移動ロボットを第１
の姿勢と第２の姿勢で区画されるカーブ走行経路を、ｌ
もしくは複数の３次螺線で指定する構威としたものであ
り、この３次螺線は、曲率が経路に沿った距離に関する
２次関数である有限長の曲線であって、かつ両端におけ
る曲率が零となるような曲線である． 〔作用〕 本発明では、複数の３次螺線をつなぐことによって移動
ロボットの経路を生威する．このとき、隣り合う３次螺
線の接線方向は等しくとられる．それらの接続点におい
ては、曲率はＯとなり、生成された経路全域において曲
率の変化率の２乗の積分が最小になるように設計される
．移動ロボットの加速度の変化率は走行経路の曲率の変
化率に比例するので、本発明のように、曲率の変化率が
最小となる走行経路を指定すれば、移動ロボットにとっ
て非常に滑らかな動きが達威される。
〔実施例〕
以下、本発明の１実施例を図面を参照して説明する。
まず、１つの３次螺線による経路生戒について説明する
． 第ｌ図において、Ｍは移動ロボットである自律形の無人
搬送車を示し、Ｐ１は第１の姿勢、Ｐ８は第２の姿勢を
示している．Ｐｌは位置Ｘ＋　％　）’１と方向θ，を
持ち、Ｐ８は位置Ｘオ、ｅｘと方向θ．を持ち、かつ次
式の関係を満足するものとすこのとき、姿勢Ｐ１と姿勢
Ｐ！は対称であるといわれる． 本発明者は曲率ｋ　（Ｓ）の評価関数ｃｏｓｔとして、
・　・　・　・　・　・（２） ゜ここで、ｌ：曲線の長さ、Ｓ：距離 この（２）式を最小にする関数を求めて、下記の解を得
た． ２ ・（４） Ｋ　（Ｓｔ）は第２図に示すような２次関数であり．か
つ、このθ（Ｓ）は３次関数となる。全体としては第３
図に示すような曲線を描く。この曲線上で曲率がＯとな
る２点Ｐ．　、Ｐ．間を切り取ったものを３次螺線と呼
ぶ。この３次螺綿の長をｌとし、その上での距離Ｓの変
域を、 −　ｌ　／　２　＜　ｓ≦−１　／　２・・・・・・・
・・・（５）とし、かつ角度α（姿勢Ｐ，から姿勢Ｐ！
への方向の変化）を、 α一θ２−θ．・・・・・・・・・・・・・（６）と定
義すると、曲率Ｋ　（ｓ）は次式で与えられる。
従って、３次螺線を決定するには、その長さｌを求める
必要があるので、その前段階として、長さが「１」であ
る単位長の３次螺線の両端間距離Ｄ（α）をあらゆる角
度差について求め、これをテーブルのかたちでメモリに
格納しておく．その値は、 によって、求められる。このＤ（α）の値はα＝０°〜
２７００の範囲で必要な細かさであらかじめ求めておく
．例えは、ｔｘ＝ｏ”　、９０’　　１８０”の場合、
Ｄ（α）は、 Ｄ（０”）　　　　＝１．０ Ｄ（９０’）　　−０．８５８ Ｄ　（１８０”　）＝０．４８６１ 第４図にさまざまなαに対する３次螺線を示す。
この準備を行ったのちに、第５図の流れ図に従う。
まず、第５図の流れ図に示すように、角度αを（６）式
により演算する。
この角度αは移動ロボッｌ−Ｍの移動方向の変化すべき
量を意味する。次いで、Ｐ，とＰ！のスカラー距離ｄを
演算する。
・　・　・　・　・（９） 次いで、αの関数であるＤ（α）を前記したテーブルか
ら求める．これを用いて、解となる３次螺線の長さｌ（
無人搬送車Ｍの走行距離）は次式により求められる。
このｒｌ，が求まると、曲率Ｋ　（ｓ）は、前記（７）
式から求めることができる。この曲率Ｋ　（Ｓ）によっ
て、接線方向θ（Ｓ）と各点［　Ｘ　（Ｓ）、ｙ　（ｓ
）　）は次のよ螺線に対して１回だけ行なわれるが、０
０、０２）式の演算は一定時間毎に繰り返し実行される
。
次にｓ　ＰＩ　　（ＸＩ　％　）’ｌ　、θ．）とＰｇ
　　（Ｘｚ、ｙ！、θｔ）が対称でなく、（１）式を満
足しない場合を考える、この場合は、１個ではなく、２
個の３次螺線により経路を合威する。中間の姿勢として
、ｑ　（ｘ，ｙ、θ）を、Ｐ，とｑが対称であり、かつ
、Ｐ，と４が対称であるように選ぶ。このようなｑが第
６図に示すように無限に多くある。各々のｑに対して、
Ｐ，とｑを結ぶ３次螺線およびｑとＰ２を結ぶ３次螺線
を求め、かつ両者の（２）式による滑らかさの評価関数
ｃｏｓｔの和を求め、その和が最小になるような中間姿
勢を求める。これによりＰ１とＰｔを２個の３次螺線で
結ぶ経路が得られたことになる。両３次螺線について、
第５図に示されるプログラムが実行される。
第６図に対する最良の解は第７図の一番下の経路である
。異なるＰ２に対する他の解もこの図中にある．第７図
および第８図は２個の３次螺線で解を求めた例である。
この方式が全域的な経路決定にどのように寄与するかを
第９図に示す。第９図において、求められた部分経路の
両端の姿勢は相隣る部分経路の姿勢に一致し、かつ曲率
の値（０であるから）も一致する． 本実施例では、カーブ走行経路を３次螺線で指定するか
ら、円弧で指定する場合に比して、曲率が連続的に変化
し、無人搬送車Ｍを滑らかに動かすことができ、位置精
度が向上する。
また、上記実施例は自律形無人搬送車の経路指定につい
て述べたが、本発明は誘導方式のシステムにおける誘導
線の布設パターンに利用することもできる。
〔発明の効果〕
本発明は以上説明した通り、カーブ走行経路を曲率の変
化が連続的である３次螺線曲線で指定するので、カーブ
走行を滑らかに行わせることができ、このカーブ走行経
路に連続する他の走行経路との接続部における曲率の変
化も、円弧で走行経路を指定した場合に比して連続的に
なるので、該接続部におけるオーバシュート走行を抑制
することができ、１つのカーブ走行経路から他の走行経
路への乗り移りが従来に比して滑らかになり、かつ位置
制御性が向上するという利点がある．
【図面の簡単な説明】
第ｌ図は本発明の経路決定の原理を説明するための移動
ロボット走行経路図、第２図は３次螺線の距離に対する
曲事変化を示す図、第３図は３次螺線を示す図、第４図
は３次螺線を示す図、第５図は本発明の実施例を説明す
るための移動ロボットの走行経路を指定するための演算
フローを示す図、第６図〜第８図は複数３次螺線により
経路指定を行う場合の手法を説明するための図、第９図
はこの発明により決定した走行経路の全体を示す図であ
る。 Ｍ・一移動ロボット。

Claims (3)

    【特許請求の範囲】
  1. （１）移動ロボットを第１の姿勢から第２の姿勢へ走行
    させる場合において、曲率が経路に沿った距離に関する
    ２次関数である有限長の曲線であって、かつ両端におけ
    る曲率が零となる１個もしくは複数個の３次螺線を用い
    て経路を指定することを特徴とする移動ロボットの経路
    指定方法。
  2. （２）２個の３次螺線で経路指定を行う場合において、
    第１の姿勢と第２の姿勢の両者に対して対称である中間
    点を求め、該中間点と上記第１の姿勢を結ぶ第１の３次
    螺線および該中間点と上記第２の姿勢を結ぶ第２の３次
    螺線を用いて経路指定を行うことを特徴とする請求項１
    記載の移動ロボットの経路指定方法。
  3. （３）第１の姿勢と第２の姿勢との角度差αを演算し、
    次いで第１の姿勢と第２の姿勢との間のスカラー距離ｌ
    を演算したのち、両端曲率が共に零である単位３次螺線
    の上記両端間距離と上記スカラー量から移動ロボット走
    行距離となる３次螺線の両端間ｌを演算し、下記式によ
    り演算した曲率ｋに基づき、 ｋ＝［６α（ｌ＾２／４−ｓ＾２）］／ｌ＾３但し、−
    ｌ／２≦ｓ≦ｌ／２ 移動ロボットの姿勢を演算して経路指定を行うことを特
    徴とする請求項１または２記載の移動ロボットの経路指
    定方法。
JP1158251A 1989-06-22 1989-06-22 移動ロボットの経路指定方法 Pending JPH0324606A (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP1158251A JPH0324606A (ja) 1989-06-22 1989-06-22 移動ロボットの経路指定方法
US07/540,152 US5109340A (en) 1989-06-22 1990-06-19 Path planning method for mobile robots
FR9007833A FR2648934A1 (fr) 1989-06-22 1990-06-22 Procede de planification de trajets pour des robots mobiles

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP1158251A JPH0324606A (ja) 1989-06-22 1989-06-22 移動ロボットの経路指定方法

Publications (1)

Publication Number Publication Date
JPH0324606A true JPH0324606A (ja) 1991-02-01

Family

ID=15667549

Family Applications (1)

Application Number Title Priority Date Filing Date
JP1158251A Pending JPH0324606A (ja) 1989-06-22 1989-06-22 移動ロボットの経路指定方法

Country Status (3)

Country Link
US (1) US5109340A (ja)
JP (1) JPH0324606A (ja)
FR (1) FR2648934A1 (ja)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1997005534A1 (fr) * 1995-08-01 1997-02-13 Komatsu Ltd. Generateur de trajectoire de mobile
JPH09146639A (ja) * 1995-11-24 1997-06-06 Nippon Yusoki Co Ltd 自律式無人搬送車のステアリング制御方法
WO2000033152A1 (fr) * 1998-12-03 2000-06-08 Komatsu Ltd. Systeme de guidage de vehicule
US6539294B1 (en) 1998-02-13 2003-03-25 Komatsu Ltd. Vehicle guidance system for avoiding obstacles stored in memory
JP2010211827A (ja) * 1998-02-13 2010-09-24 Komatsu Ltd 車両の誘導装置
JP2021501921A (ja) * 2018-09-28 2021-01-21 バイドゥ ドットコム タイムス テクノロジー （ベイジン） カンパニー リミテッド 自動運転車両のための螺旋経路に基づく３ポイントターン計画

Families Citing this family (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5276618A (en) * 1992-02-26 1994-01-04 The United States Of America As Represented By The Secretary Of The Navy Doorway transit navigational referencing system
US5752207A (en) * 1995-09-29 1998-05-12 Caterpillar Inc. Method and apparatus for determining a path for a machine between a predetermined route and a final position
US5999866A (en) * 1996-11-05 1999-12-07 Carnegie Mellon University Infrastructure independent position determining system
US5908458A (en) * 1997-02-06 1999-06-01 Carnegie Mellon Technical Transfer Automated system and method for control of movement using parameterized scripts
US6134486A (en) * 1998-04-20 2000-10-17 The United States Of America As Represented By The Secretary Of The Navy Robot and method of control for an autonomous vehicle to track a path consisting of directed straight lines and circles with positional feedback and continuous curvature
US6314341B1 (en) * 1999-11-26 2001-11-06 Yutaka John Kanayama Method of recording trajectory data and sensor data for a manually-driven vehicle
DE10055156A1 (de) * 2000-11-07 2002-05-16 Harman Becker Automotive Sys Verfahren zur Erzeugung einer Navigationskarte und Navigationskarte
AUPR733701A0 (en) * 2001-08-29 2001-09-20 Beeline Technologies Apparatus and method for assisted navigation of a land vehicle
AU2002325645B2 (en) * 2001-08-29 2007-05-31 Agjunction Llc Vehicle guidance software, method and system
US7089162B2 (en) * 2001-11-07 2006-08-08 Harman International Industries, Incorporated Navigation map creation system
JP5148619B2 (ja) * 2006-10-18 2013-02-20 ユタカ・ジェイ・カナヤマ 移動ロボットによる地図作成方法
DE102009023307A1 (de) * 2009-05-29 2010-12-02 Kuka Roboter Gmbh Verfahren und Vorrichtung zur Steuerung eines Manipulators
CN101739027B (zh) * 2009-12-01 2015-02-18 蒋平 基于分布式视觉传感网络的移动导航系统
US8224516B2 (en) * 2009-12-17 2012-07-17 Deere & Company System and method for area coverage using sector decomposition
US8635015B2 (en) * 2009-12-17 2014-01-21 Deere & Company Enhanced visual landmark for localization
US20110153338A1 (en) * 2009-12-17 2011-06-23 Noel Wayne Anderson System and method for deploying portable landmarks
CN102854888A (zh) * 2012-09-10 2013-01-02 北京东进记录科技有限公司 飞机航线规划方法及装置
US9816822B1 (en) 2016-09-30 2017-11-14 X Development Llc Assisted roadmap generation
US10260890B2 (en) 2017-04-21 2019-04-16 X Development Llc Aisle-based roadmap generation
US10591915B2 (en) * 2017-08-03 2020-03-17 Mitsubishi Electric Research Laboratories, Inc. Motion controller for real-time continuous curvature path planning
CN109407658B (zh) * 2017-08-18 2022-06-14 厦门雅迅网络股份有限公司 无人车的行车轨迹规划方法及计算机可读存储介质
WO2020191709A1 (en) * 2019-03-28 2020-10-01 Baidu.Com Times Technology (Beijing) Co., Ltd. A qp spline path and spiral path based reference line smoothing method for autonomous driving
CN114791288B (zh) * 2022-06-27 2022-09-30 青岛慧拓智能机器有限公司 矿区车辆的行驶路径规划方法、装置及计算机设备

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6180410A (ja) * 1984-09-28 1986-04-24 Yutaka Kanayama 移動ロボツトの走行指令方式
NL8500529A (nl) * 1985-02-25 1986-09-16 Ind Contractors Holland Bv Stelsel voor het bepalen van de positie van een niet aan een vaste baan gebonden voertuig.
JPH06104455B2 (ja) * 1985-03-15 1994-12-21 日産自動車株式会社 車両運動状態推定装置
US4777416A (en) * 1986-05-16 1988-10-11 Denning Mobile Robotics, Inc. Recharge docking system for mobile robot
US4821192A (en) * 1986-05-16 1989-04-11 Denning Mobile Robotics, Inc. Node map system and method for vehicle
US4890233A (en) * 1986-10-27 1989-12-26 Pioneer Electronic Corporation Vehicle bearing detection and data processing methods applicable to vehicle navigation system
US4761595A (en) * 1987-05-01 1988-08-02 General Motors Corporation Motion control system having adaptive feedforward path tracking
US4835710A (en) * 1987-07-17 1989-05-30 Cincinnati Milacron Inc. Method of moving and orienting a tool along a curved path

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1997005534A1 (fr) * 1995-08-01 1997-02-13 Komatsu Ltd. Generateur de trajectoire de mobile
GB2318430A (en) * 1995-08-01 1998-04-22 Komatsu Mfg Co Ltd Course generator of moving body
AU716465B2 (en) * 1995-08-01 2000-02-24 Komatsu Limited Course generator of moving body
JPH09146639A (ja) * 1995-11-24 1997-06-06 Nippon Yusoki Co Ltd 自律式無人搬送車のステアリング制御方法
US6539294B1 (en) 1998-02-13 2003-03-25 Komatsu Ltd. Vehicle guidance system for avoiding obstacles stored in memory
JP2010211827A (ja) * 1998-02-13 2010-09-24 Komatsu Ltd 車両の誘導装置
WO2000033152A1 (fr) * 1998-12-03 2000-06-08 Komatsu Ltd. Systeme de guidage de vehicule
JP2021501921A (ja) * 2018-09-28 2021-01-21 バイドゥ ドットコム タイムス テクノロジー （ベイジン） カンパニー リミテッド 自動運転車両のための螺旋経路に基づく３ポイントターン計画
US11267471B2 (en) 2018-09-28 2022-03-08 Baidu Usa Llc Spiral path based three-point turn planning for autonomous driving vehicles

Also Published As

Publication number Publication date
US5109340A (en) 1992-04-28
FR2648934A1 (fr) 1990-12-28

Similar Documents

Publication Publication Date Title
JPH0324606A (ja) 移動ロボットの経路指定方法
CN107390691B (zh) 一种agv路径跟踪方法
US6092010A (en) Method and system for describing, generating and checking non-wire guidepaths for automatic guided vehicles
US5758298A (en) Autonomous navigation system for a mobile robot or manipulator
CN108052102B (zh) 机器人行进路线的确定方法、装置及机器人
EP0346538A1 (en) Control method for an unmanned vehicle
JPH10320026A (ja) 数値制御装置及び方法
Digani et al. Obstacle avoidance for industrial AGVs
CN109656250A (zh) 一种激光叉车的路径跟踪方法
WO2023036044A1 (zh) 全局路径规划方法、运动控制方法及计算机程序产品
Wang et al. Steering behaviors for autonomous vehicles in virtual environments
JP4577247B2 (ja) 移動体及びその制御方法
JPH09319433A (ja) 最適経路探索方法
Brock et al. Coordination and control of multiple autonomous vehicles.
WO2023124339A1 (zh) 路径规划方法、运动控制方法及计算机程序产品
JP2651662B2 (ja) 軌道生成方法および軌道生成装置
CN112947487B (zh) 一种自动引导车辆及其曲线路径跟踪方法、控制装置
JPS62274313A (ja) 無人者の障害物回避動作指令装置
CN114089730B (zh) 机器人的运动规划方法和自动引导车
CN114721363A (zh) 车辆的控制方法、自动引导车及计算机可读存储介质
JPS6233607B2 (ja)
JPH04340607A (ja) 最適経路決定装置
Charifa et al. Adaptive boundary-following algorithm guided by artificial potential field for robot navigation
CN111830980A (zh) 一种激光导航路径跟随方法
JP2712523B2 (ja) 自律走行車両