JPH08123547A - Method and device for generating track - Google Patents

Method and device for generating track

Info

Publication number
JPH08123547A
JPH08123547A JP6288777A JP28877794A JPH08123547A JP H08123547 A JPH08123547 A JP H08123547A JP 6288777 A JP6288777 A JP 6288777A JP 28877794 A JP28877794 A JP 28877794A JP H08123547 A JPH08123547 A JP H08123547A
Authority
JP
Japan
Prior art keywords
point
main
road
spline curve
trajectory
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
JP6288777A
Other languages
Japanese (ja)
Other versions
JP2651662B2 (en
Inventor
Yasuo Otsuki
康生 大築
Nobunao Nagai
信尚 永井
Koichi Yoshida
孝一 吉田
Tsuneyoshi Sawai
恒義 澤井
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.)
Kawasaki Heavy Industries Ltd
Original Assignee
Kawasaki Heavy Industries 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 Kawasaki Heavy Industries Ltd filed Critical Kawasaki Heavy Industries Ltd
Priority to JP6288777A priority Critical patent/JP2651662B2/en
Publication of JPH08123547A publication Critical patent/JPH08123547A/en
Application granted granted Critical
Publication of JP2651662B2 publication Critical patent/JP2651662B2/en
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Abstract

PURPOSE: To provide the method and device for generating track with which the number of points to be designated in the case of designing the shape of a course while using a spline curve can be irreducibly minimized. CONSTITUTION: Environment map information is read out of a memory, where the environment map information is stored, and the image of that information is displayed on an image display device 21 as an environment map. A start point, end point and passing crossings are instructed from an input device 22 to that environment map and based on those instructed start point, end point and passing crossings, main passing points are prepared. Next, the spline curve passing these main passing points is prepared. Further, the provided spline curve is evaluated and when there is no part protruded from a road, it is adopted as a track but when it is not suitable, the main passing point is added or corrected to generate the spline curve passing that added or corrected point again. This correction is repeated until the satisfactory spline curve is provided.

Description

【発明の詳細な説明】Detailed Description of the Invention

【0001】[0001]

【産業上の利用分野】本発明は軌道生成方法および軌道
生成装置に関する。さらに詳しくは、移動ロボットを無
人運転するために用いる軌道生成方法および軌道生成装
置に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a trajectory generation method and a trajectory generation device. More specifically, the present invention relates to a trajectory generation method and a trajectory generation device used for unmanned operation of a mobile robot.

【0002】[0002]

【従来の技術】従来より、産業用ロボットの稼動効率の
向上を図るために、ロボット自体を移動させることがな
されている。例えば、ロボットの一種である無人搬送車
においては、工場の床に貼付られた案内テープあるいは
床下に埋設された誘導ケーブルにより、無人搬送車を誘
導して移動させることがなされている。
2. Description of the Related Art Conventionally, in order to improve the operating efficiency of an industrial robot, the robot itself has been moved. For example, in an automatic guided vehicle that is a type of robot, the automatic guided vehicle is guided and moved by a guide tape attached to the floor of a factory or an induction cable buried under the floor.

【0003】しかしながら、かかる移動方法では工場の
床にテープを貼付る作業や、床下に誘導ケーブルを埋設
する作業が必要となる。この場合、工場のレーアウトを
変更すると、それに伴いテープの貼り代えや誘導ケーブ
ルの変更が必要となるという問題がある。
However, such a moving method requires an operation of attaching a tape to the floor of a factory and an operation of burying an induction cable under the floor. In this case, there is a problem that when the layout of the factory is changed, it is necessary to replace the tape or change the guide cable accordingly.

【0004】かかる誘導方式による問題を解決するため
に、移動ロボット自身により走行経路の設計をなさし
め、ロボットを自律的に移動させることが提案されかつ
実施されている。この走行経路の設計には大域的な設計
と経路形状の設計とがある。ここで、大域的な設計と
は、走行時間や距離、危険度(路面が悪いとか道幅が狭
く衝突しやすいといった状況)といったものを考慮し
て、最適な経路を見つけ出すというものである。なお、
この大域的な設計では移動ロボットを実際に制御すると
きのダイナミックスなどの問題は考慮されない。一方、
経路形状の設計とは、移動ロボットを精密に移動させる
ための詳細な軌道を設計するものである。この経路形状
の設計では、ダイナミックスを含めて最適な経路形状を
一度に生成することが困難であるところから、まず大域
的な設計の結果を反映するように滑らかな経路を作成
し、ついで誤差少なくその軌道を移動できるよう移動速
度を制御するという手法が採られている。この経路形状
の設計方法として、従来より直線と円弧を用いて設計す
る方法やスプライン曲線を用いて設計する方法(「スプ
ライン曲線による車輪型移動ロボットの軌道制御」ロボ
ット学会誌8巻2号1〜11頁参照)が採用されてい
る。
In order to solve the problem caused by the guidance system, it has been proposed and implemented that the mobile robot itself designs the traveling route to move the robot autonomously. There are a global design and a route shape design in the design of the travel route. Here, the global design is to find an optimum route in consideration of the traveling time, the distance, and the degree of danger (a situation where the road surface is bad or the road width is narrow and the vehicle easily collides). In addition,
In this global design, problems such as dynamics when actually controlling the mobile robot are not considered. on the other hand,
The design of the path shape is to design a detailed trajectory for precisely moving the mobile robot. In this path shape design, since it is difficult to generate the optimal path shape at once including dynamics, first create a smooth path to reflect the results of the global design, and then create an error A technique of controlling the moving speed so as to be able to move on the trajectory less is adopted. Conventionally, as a method of designing the path shape, a method using a straight line and a circular arc or a method using a spline curve (“trajectory control of a wheeled mobile robot using a spline curve”, Journal of the Robotics Society of Japan, Vol. 8, No. 2, 1- 1) (See page 11).

【0005】しかしながら、直線と円弧を用いて設計す
る方法では、経路形状の2次微分が不連続になるため
に、走行している移動ロボットの横方向の加速度等が不
連続になる。その結果、走行中の移動ロボットに横方向
の力がその不連続点で作用し、移動ロボットに横滑りが
生ずる。
However, in the method of designing using a straight line and a circular arc, since the second derivative of the path shape becomes discontinuous, the lateral acceleration and the like of the traveling mobile robot become discontinuous. As a result, a lateral force acts on the moving mobile robot at the discontinuous point, and the mobile robot skids.

【0006】一方、スプライン曲線を用いて設計する方
法では経路形状の2次微分の連続性は補償されている
が、移動ロボットを走行させる経路上に多数の点を指定
する必要がある。この場合、障害物のない平面上や特定
の経路を想定しない平面上を走行させるときには、経路
を設定するための点の指定は任意でよいので、それらの
点の指定において特段の問題を生じない。しかしなが
ら、道路のような制限された通行領域にスプライン曲線
を利用して経路設計を行う場合には、任意に点の指定を
行うと、移動ロボットが道路からはみ出してしまうの
で、オペレータが常にスプライン曲線を想定しながら点
の指定を行わなければならないという問題がある。しか
も、その経路が複雑である場合には、指定する点が飛躍
的に増大するという問題もある。
On the other hand, in the method of designing using a spline curve, the continuity of the second derivative of the path shape is compensated, but it is necessary to specify many points on the path on which the mobile robot travels. In this case, when traveling on a plane without obstacles or on a plane that does not assume a specific route, the points for setting the route may be specified arbitrarily, so there is no particular problem in specifying those points. .. However, when designing a route using a spline curve in a restricted traffic area such as a road, if a point is arbitrarily specified, the mobile robot will run off the road, so the operator will always spline the curve. There is a problem in that points must be specified while assuming. In addition, when the route is complicated, there is a problem that the number of points to be specified increases dramatically.

【0007】[0007]

【発明が解決しようとする課題】本発明はかかる従来技
術の問題点に鑑みなされたものであって、スプライン曲
線を用いた経路形状の設計の際における指定する点の数
を必要最小限とすることのできる軌道生成方法および軌
道生成装置を提供することを目的としている。
SUMMARY OF THE INVENTION The present invention has been made in view of the problems of the prior art, and minimizes the number of points to be designated when designing a path shape using a spline curve. It is an object of the present invention to provide a trajectory generation method and a trajectory generation device capable of performing the same.

【0008】[0008]

【課題を解決するための手段】本発明の軌道生成方法
は、環境地図情報を読み取る手順と、始点と終点と通過
交差点とを指定する手順と、スプライン曲線生成のため
の主要通過点を生成する手順と、生成された主要通過点
を通るスプライン曲線を生成する手順と、生成されたス
プライン曲線を評価する手順と、前記評価結果により必
要に応じて前記スプライン曲線を修正する手順とを含ん
でなることを特徴とする。
A trajectory generation method according to the present invention includes a procedure for reading environment map information, a procedure for designating a start point, an end point, and a passing intersection, and a main passing point for generating a spline curve. And a step of generating a spline curve that passes through the generated main passage points, a step of evaluating the generated spline curve, and a step of correcting the spline curve as necessary according to the evaluation result. It is characterized by

【0009】本発明の軌道生成方法においては、前記主
要通過点を生成する手順において、例えば接点が主要通
過点とされてもよい。
In the trajectory generating method of the present invention, in the procedure for generating the main passing point, for example, a contact may be set as the main passing point.

【0010】また、本発明の軌道生成方法においては、
前記主要通過点を生成する手順において、例えば先に生
成された主要通過点の進行方向手前側に主要通過点を追
加することがなされ、あるいは、例えば生成された主要
通過点を進行方向手前側または内側に移動することがな
され、前記スプライン曲線の評価が、例えば主要通過点
の2点間を結ぶ線分と、生成されたスプライン関数で囲
まれる部分の面積が、線分を底辺とし道幅を高さとする
三角形の面積より大きいか否かでなされ、前記スプライ
ン曲線の修正が、例えば接点から道幅に比例した距離離
れた位置に主要通過点を追加することによりなされ、あ
るいは軌道がはみ出した道路領域を挾むそれぞれの交差
点の道路と接続している接点の中間位置に主要通過点を
追加することによりなされる。
Further, in the trajectory generation method of the present invention,
In the procedure of generating the main passing point, for example, the main passing point is added to the traveling direction front side of the previously generated main passing point, or, for example, the generated main passing point is the traveling direction front side or The inside of the spline curve is evaluated such that the area of the line segment connecting the two main passing points and the area surrounded by the generated spline function is the line segment as the base and the road width is high. Is larger than the area of the triangle, and the modification of the spline curve is made by, for example, adding a main passing point at a position distant from the contact point by a distance proportional to the road width, or This is done by adding a main transit point at the middle position of the contact point that is connected to the road at each intersection.

【0011】ここで、接点から道幅に比例した距離離れ
た位置における主要通過点の追加は、例えば、軌道がは
み出した道路領域の進行方向手前側の交差点において、
その交差点で主要通過点になっている2つの接点から、
それぞれ道幅に比例した距離離れた位置、軌道がはみ出
した道路領域の進行方向手前側の交差点において、その
道路と接続している接点から、道路幅に比例した距離離
れた位置、あるいは軌道がはみ出した道路領域を挾むそ
れぞれの交差点の道路と接続している接点から、道路幅
に比例した距離離れた位置になされる。
Here, the addition of the main passing point at a position distant from the contact point by a distance proportional to the road width is performed, for example, at an intersection on the front side in the traveling direction of the road area where the track extends.
From the two contact points that are the main passing points at the intersection,
At a position that is separated by a distance proportional to the width of the road, or at a crossing on the front side in the traveling direction of the road area where the track protrudes, a position that is separated by a distance proportional to the road width or the track protrudes from the contact point connected to the road. It is located at a position proportional to the width of the road from the contact point that is connected to the road at each intersection that crosses the road area.

【0012】一方、本発明の軌道生成装置は、環境地図
情報を記憶する手段と、環境地図情報を読み取る手段
と、始点と終点と通過交差点とを指定する手段と、スプ
ライン曲線生成のための主要通過点を生成する手段と、
生成された主要通過点を通るスプライン曲線を生成する
手段と、生成されたスプライン曲線を評価する手段と、
前記スプライン曲線を修正する手段とを備えてなること
を特徴とする。
On the other hand, the trajectory generating apparatus of the present invention is a means for storing environment map information, a means for reading environment map information, a means for designating a start point, an end point, and a passing intersection, and a main means for generating a spline curve. Means for generating a passing point,
Means for generating a spline curve passing through the generated main passage points, means for evaluating the generated spline curve,
And a means for modifying the spline curve.

【0013】本発明の軌道生成装置においては、前記主
要通過点を生成する手段において、例えば先に生成され
た主要通過点の進行方向手前側に主要通過点を追加する
ことがなされ、あるいは、例えば生成された主要通過点
を手前側または内側に移動することがなされ、前記生成
されたスプライン曲線を評価する手段において、前記ス
プライン曲線の評価が、例えば主要通過点の2点間を結
ぶ線分と、生成されたスプライン関数で囲まれる部分の
面積が、線分を底辺とし道幅を高さとする三角形の面積
より大きいか否かでなされ、前記スプライン曲線を修正
する手段において、前記スプライン曲線の修正が、接点
から道幅に比例した距離離れた位置に主要通過点を追加
することによりなされ、あるいは軌道がはみ出した道路
領域を挾むそれぞれの交差点の道路と接続している接点
の中間位置に主要通過点を追加することによりなされ
る。
In the trajectory generating apparatus of the present invention, in the means for generating the main passing point, for example, the main passing point is added on the front side in the traveling direction of the previously generated main passing point, or, for example, The generated main passing point is moved to the front side or the inside, and in the means for evaluating the generated spline curve, the evaluation of the spline curve is performed by, for example, a line segment connecting two points of the main passing points. , The area surrounded by the generated spline function is larger than the area of a triangle having a line segment as a base and a road width as a height, and in the means for modifying the spline curve, the modification of the spline curve is performed. , By adding a main passing point at a position distant from the contact point in proportion to the width of the road, or across the road area where the track protrudes. It is done by adding a major passing point at an intermediate position of contact that is connected to the intersection of the road.

【0014】ここで、接点から道幅に比例した距離離れ
た位置における主要通過点の追加は、例えば軌道がはみ
出した道路領域の進行方向手前側の交差点において、そ
の交差点で主要通過点になっている2つの接点から、そ
れぞれ道幅に比例した距離離れた位置、軌道がはみ出し
た道路領域の進行方向手前側の交差点において、その道
路と接続している接点から、道路幅に比例した距離離れ
た位置、あるいは軌道がはみ出した道路領域を挾むそれ
ぞれの交差点の道路と接続している接点から、道路幅に
比例した距離離れた位置になされる。
Here, the addition of the main passing point at a position distant from the contact point by a distance proportional to the road width is, for example, at the intersection on the front side in the traveling direction of the road area where the track extends, which is the main passing point. Positions distant from the two contact points by a distance proportional to the road width, positions distant from the contact points connected to the road by a distance proportional to the road width at the intersection on the front side in the traveling direction of the road area where the track protrudes, Alternatively, it is located at a position proportional to the width of the road from the contact point that is connected to the road at each intersection that crosses the road area where the track extends.

【0015】また、本発明の軌道生成装置においては、
始点と終点と通過交差点とを指定する手段および/また
は前記スプライン曲線を修正する手段が、残りの他の手
段を備える軌道生成装置本体と分離され、前記分離され
た手段と軌道生成装置本体との入出力が無線によりなさ
れてもよい。
Further, in the trajectory generating device of the present invention,
The means for designating a start point, an end point and a passing intersection and / or the means for modifying the spline curve are separated from the trajectory generator body provided with the remaining other means. Input and output may be performed wirelessly.

【0016】[0016]

【作用】例えば軌道生成装置のメモリには環境地図情報
が格納されており、同装置は格納されている環境地図情
報を読み取る。この読み取られた環境地図情報に対応し
た図形(環境地図)が同装置の表示部に表示される。こ
の状態で、出発点(始点)および終点ならびに通過しな
ければならない交差点(以下、通過交差点という)が指
定される。ついで、同装置は指定された始点および終点
ならびに通過交差点に基づいてスプライン曲線生成のた
めの主要通過点を生成した後、生成された主要通過点を
通るスプライン曲線を生成する。しかるのち、同装置は
生成されたスプライン曲線の評価、すなわち生成された
スプライン曲線において道路領域からはみ出している箇
所がないかをチェックする。そして、前記評価により道
路領域からはみ出している箇所があると判定されると、
その箇所に関係する主要通過点の付近に新たに通過点を
生成し、ついでこの新たに生成された通過点をも通るよ
うにスプライン曲線を修正する。しかるのち、この修正
されたスプライン曲線を再度評価し、道路領域からはみ
出している箇所がなければ、それを軌道として採用す
る。もし、道路領域からはみ出している箇所があれば、
再度新たな通過点を生成して前記スプライン曲線の生成
および評価手順を繰り返す。
For example, environmental map information is stored in the memory of the trajectory generating device, and the device reads the stored environmental map information. A graphic (environment map) corresponding to the read environment map information is displayed on the display unit of the device. In this state, a starting point (starting point), an ending point, and an intersection that must pass through (hereinafter referred to as a passing intersection) are designated. Next, the apparatus generates a main pass point for spline curve generation based on the specified start point and end point and the passing intersection, and then generates a spline curve passing through the generated main pass point. After that, the device evaluates the generated spline curve, that is, checks whether or not there is a portion of the generated spline curve that is out of the road area. Then, when it is determined that there is a portion protruding from the road area by the evaluation,
A new passing point is generated in the vicinity of the main passing point related to the location, and then the spline curve is modified so as to pass through the newly generated passing point. Thereafter, the corrected spline curve is evaluated again, and if there is no portion that protrudes from the road area, it is adopted as a trajectory. If there is any part that goes out of the road area,
A new passing point is generated again, and the generation and evaluation procedure of the spline curve is repeated.

【0017】[0017]

【実施例】以下、添付図面を参照しながら本発明を実施
例に基づいて説明するが、本発明はかかる実施例のみに
限定されるものではない。
DESCRIPTION OF THE PREFERRED EMBODIMENTS The present invention will now be described based on embodiments with reference to the accompanying drawings, but the present invention is not limited to such embodiments.

【0018】本発明の軌道生成方法に用いる軌道生成装
置の機能ブロック図を図1に示し、同軌道生成装置A
は、環境地図情報記憶手段1と、環境地図情報読み取り
手段2と、順路指示手段3と、主要通過点作成手段4
と、スプライン軌道生成手段5と、軌道評価手段6と、
主要通過点修正手段7とを主要構成要素としてなる。
FIG. 1 shows a functional block diagram of a trajectory generation device used in the trajectory generation method of the present invention.
Are environmental map information storage means 1, environmental map information reading means 2, route instructing means 3, and main passage point creating means 4
A spline trajectory generating means 5, a trajectory evaluating means 6,
The main passing point correcting means 7 is a main component.

【0019】環境地図情報記憶手段1は、環境地図(図
2参照)に対応した図形、交差点および道路の位置、交
差点と道路のつながり具合、道幅、通行可能領域などの
環境地図情報を、例えばデータ形式で記憶しておくもの
である。ここで、交差点とは、2以上の通路の共通領域
(図2の斜線部参照)をいい、そして道路とは交差点と
交差点をつなぐ部分をいう。したがって、本明細書中に
使用されている「交差点」および「道路」は、一般的に
使用されている交差点および道路とは異なる意味で使用
されている。なお、環境地図情報の内容については後述
する。
The environmental map information storage means 1 stores environmental map information such as a figure corresponding to an environmental map (see FIG. 2), the position of an intersection and a road, the degree of connection between an intersection and a road, the width of a road, and a passable area, for example, as data. It is stored in a format. Here, an intersection refers to a common area of two or more passages (see a shaded portion in FIG. 2), and a road refers to a portion connecting intersections. Therefore, the terms “intersection” and “road” used in the present specification have different meanings from the commonly used intersections and roads. The contents of the environmental map information will be described later.

【0020】環境地図情報読み取り手段2は、前記環境
地図情報記憶手段1に記憶されている環境地図情報を読
み取り、それを順路指示手段3および主要通過点作成手
段4に入力するものである。なお、環境地図情報記憶手
段1に複数の環境地図情報が格納されている場合には、
必要な環境地図情報を選択的に読み取る。かかる選択
は、例えば環境地図情報にコード番号を付与しておき、
そのコード番号を選択することによりなし得る。
The environmental map information reading means 2 reads the environmental map information stored in the environmental map information storage means 1 and inputs the information to the route instructing means 3 and the main passage point creating means 4. When a plurality of pieces of environmental map information are stored in the environmental map information storage means 1,
Selectively read necessary environmental map information. For such selection, for example, a code number is assigned to the environmental map information,
This can be done by selecting the code number.

【0021】順路指示手段3は、前記環境地図情報読み
取り手段2から入力された図形(環境地図)をその表示
部に表示させて、その表示された環境地図上に順路が指
示できるとともに(図3参照)、その指示された順路を
主要通過点作成手段4に入力するものである。
The route instruction means 3 can display a graphic (environment map) input from the environment map information reading means 2 on its display portion and can indicate a route on the displayed environment map (see FIG. 3). The reference route is input to the main passing point creating means 4.

【0022】主要通過点作成手段4は、前記順路指示手
段3から入力された始点、通過交差点、終点および前記
環境地図情報読み取り手段2から入力された環境地図情
報から指定経路上の接点、すなわち交差点および道路の
接続関係を示す点を生成する(図4参照)。
The main passing point creating means 4 is a contact point on a designated route, that is, an intersection, based on the starting point, the passing intersection, the ending point inputted from the route indicating means 3 and the environmental map information inputted from the environmental map information reading means 2. And a point indicating a road connection relationship is generated (see FIG. 4).

【0023】なお、図5にこの軌道生成装置Aの概略図
を示してある。図5に示す軌道生成装置Aにおいては、
環境地図情報記憶手段1は、例えばRAMにより実現さ
れ、順路指示手段3は、例えばCRTなどの画像表示装
置21とキーボード、マウス、ライトペンなどの入力装
置22とを組み合わせることにより実現され、その他の
環境地図情報読み取り手段2、主要通過点作成手段4、
スプライン軌道生成手段5、軌道評価手段6および主要
通過点修正手段7は、演算処理装置20に前記各機能に
対応させたプログラムを格納することにより実現され
る。なお、主要通過点修正手段7は、画像表示装置21
と入力装置22とを組み合わせることにより実現されて
もよい。その上、順路指示手段3が、例えば残りの手段
を備えた軌道生成装置本体から遠隔地に配置されて、同
本体と無線により交信できるようにされてもよい。ま
た、主要通過点修正手段7も同様にされてもよい。かか
る構成とすれば、リモートコントロールにより順路の指
示や軌道の修正がなしえる。なお、無線交信のための装
置については特に限定はない。
FIG. 5 is a schematic diagram of the trajectory generator A. In the trajectory generator A shown in FIG. 5,
The environmental map information storage unit 1 is realized by, for example, a RAM, and the route instructing unit 3 is realized by combining an image display device 21 such as a CRT and an input device 22 such as a keyboard, a mouse, and a light pen. Environmental map information reading means 2, major passage point creation means 4,
The spline trajectory generating means 5, the trajectory evaluating means 6, and the main passage point correcting means 7 are realized by storing programs corresponding to the respective functions in the arithmetic processing unit 20. It should be noted that the main passing point correcting means 7 is provided in the image display device 21.
And the input device 22 may be combined. In addition, the route instructing means 3 may be arranged, for example, at a location remote from the main body of the trajectory generating device provided with the remaining means so as to be able to wirelessly communicate with the main body. Further, the main passage point correcting means 7 may be similarly configured. With such a configuration, a route can be instructed and the trajectory can be corrected by the remote control. The device for wireless communication is not particularly limited.

【0024】次に、環境地図情報の内容について、図面
を参照しながら具体的に説明する。
Next, the contents of the environmental map information will be specifically described with reference to the drawings.

【0025】環境地図情報は、ここでは理解を容易にす
るために、例えば図6に示すような図形の形式で表現さ
れている。このように環境地図情報を図形で表現したも
のを地図データということにする。図6から明らかなよ
うに、地図データは、交差点に関する情報、すなわち交
差点データと、道路に関する情報、すなわち道路データ
と、接点に関する情報、すなわち接点データとからなっ
ている。
The environment map information is expressed in the form of a graphic as shown in FIG. 6, for example, to facilitate understanding. A representation of the environmental map information in a graphic form is referred to as map data. As is clear from FIG. 6, the map data is composed of information on intersections, ie, intersection data, information on roads, ie, road data, and information on contact points, ie, contact data.

【0026】この交差点データは2つの情報からなり、
第1の情報は他の交差点との接続情報(以下、第1交差
点情報という)であり、第2の情報は各交差点内におけ
る接点間の接続情報(以下、第2交差点情報という)で
ある(図7参照)。この第1交差点情報は、単に交差点
間の接続を示すものである。そのため、この第1交差点
情報は方向性を有しない。第2交差点情報は交差点のあ
る接点から向かうことのできる接点を示すものである。
そのため、この第2交差点情報は方向性を有する。した
がって、この第2交差点情報により、一方通行や通行禁
止などが設定できる。
This intersection data consists of two pieces of information,
The first information is connection information with another intersection (hereinafter, referred to as first intersection information), and the second information is connection information between contact points in each intersection (hereinafter, referred to as second intersection information) ( (See FIG. 7). The first intersection information simply indicates a connection between the intersections. Therefore, this first intersection information has no directionality. The second intersection information indicates a contact point that can be reached from a certain contact point at the intersection.
Therefore, this second intersection information has directionality. Therefore, one-way traffic or prohibition of traffic can be set based on the second intersection information.

【0027】道路データは2つの主要情報とその他の情
報からなり、2つの主要情報のうちの1つは他交差点と
の接続情報(以下、第1道路情報という)であり、この
第1道路情報は、注目する道路の両端で共有する接点を
介して、接続する交差点がどれとどれなのかを示すもの
である。そのため、この第1道路情報は方向性を有しな
い。また、他の1つは道路内における接点から向かうこ
とのできる接点を示すものである(以下、第2道路情報
という)。そのため、この第2道路情報は方向性を有す
る(図8参照)。また、その他の情報には、道路の幅、
長さ、横方向あるいは縦方向といった方向などがある。
The road data is composed of two pieces of main information and other information. One of the two pieces of main information is connection information with another intersection (hereinafter referred to as first road information). Indicates which intersection is to be connected and which is connected via a contact shared by both ends of the road of interest. Therefore, the first road information has no direction. The other one indicates a contact point that can be reached from the contact point on the road (hereinafter referred to as second road information). Therefore, the second road information has directionality (see FIG. 8). Other information includes road width,
There are directions such as length, horizontal direction or vertical direction.

【0028】接点データは、交差点や道路内にある点に
関するデータであって、交差点や道路の接続関係を示す
ものである。例えば、交差点内にある接点データと道路
内にある接点データが同一、すなわち接点の座標が同一
であれば、その交差点と道路が接続していることを意味
している。また、この接点データは、例えば「接点ラベ
ル(x座標値,y座標値)」の形式で表される。ここ
で、指定経路上の接点は、指定された始点、通過交差点
および終点から導きだされる。すなわち、交差点と道路
のつながりがわかれば、共有している接点がわかり、そ
れにより指定経路上の接点が特定される。
The contact data is data on an intersection or a point on a road, and indicates a connection relationship between the intersection or the road. For example, if the contact data in the intersection and the contact data in the road are the same, that is, if the coordinates of the contact are the same, it means that the intersection and the road are connected. The contact data is represented in the form of “contact label (x coordinate value, y coordinate value)”, for example. Here, the contact point on the designated route is derived from the designated start point, passing intersection, and end point. That is, if the connection between the intersection and the road is known, the shared contact point is known, and thereby the contact point on the designated route is specified.

【0029】なお下記に図9に示す識別番号(交差点番
号)がK10の交差点に関する環境地図情報の一例が示
されている。なお、この交差点K10は、図9に示すよ
うに、識別番号がK4,K9,K11,K14の交差点
に接続し、また識別番号(接点番号)がS33,S4
5,S46,S54という接点を有している。
FIG. 9 shows an example of environmental map information relating to an intersection having an identification number (intersection number) K10 shown in FIG. As shown in FIG. 9, the intersection K10 is connected to the intersection of the identification numbers K4, K9, K11 and K14, and the identification numbers (contact numbers) are S33 and S4.
5, S46 and S54 are provided.

【0030】 交差点K10の環境地図情報(交差点データ) ・・・・・・・K,010・・・・・・・ K,010 ;交差点名 M,010 ;交差点ID名 2000 ;交差点幅 4 ;交差点内の接点数 S,033,3 ;接点番号,接点と接続する接点数 S,045 ;接続する接点番号 S,054 ;接続する接点番号 S,046 ;接続する接点番号 S,045,3 ;接点番号,接点と接続する接点数 S,033 ;接続する接点番号 S,054 ;接続する接点番号 S,046 ;接続する接点番号 S,054,3 ;接点番号,接点と接続する接点数 S,045 ;接続する接点番号 S,033 ;接続する接点番号 S,046 ;接続する接点番号 S,046,3 ;接点番号,接点と接続する接点数 S,033 ;接続する接点番号 S,054 ;接続する接点番号 S,045 ;接続する接点番号 4 ;接続する交差点数 K,009 ;接続する交差点 K,014 ;接続する交差点 K,011 ;接続する交差点 K,004 ;接続する交差点 Environmental map information of the intersection K10 (intersection data) ... K, 010... K, 010; intersection name M, 010; intersection ID name 2000; intersection width 4; Number of contacts in S, 033, 3; contact number, number of contacts to connect to contacts S, 045; contact number to connect S, 054; contact number to connect S, 046; contact number to connect S, 045, 3; contact Number, number of contacts connected to contacts S, 033; number of contacts to connect S, 054; number of contacts to connect S, 046; number of contacts to connect S, 054, 3; number of contacts, number of contacts to connect to contacts S, 045 Contact number S, 033 to be connected; contact number S, 046 to be connected; contact number S, 046,3 to be connected; contact number, number of contacts to be connected to a contact S, 033; contact number S to be connected 054; connecting contact number S, 045; connecting contact number 4; connecting intersection number K, 009; connecting intersection K, 014; connecting intersection K, 011; connecting intersection K, 004; connecting intersection.

【0031】なお、前記データ中、;は;以降がコメン
トであることを示している。
It should be noted that, in the above data,; indicates that the following is a comment.

【0032】しかして、この特定された接点に基づいて
主要通過点の作成がなされる。この主要通過点は、スプ
ライン関数(曲線)を生成するための必要な座標値であ
って、例えば(x座標値,y座標値)により表される。
そして、主要通過点の生成は、この指定経路上の接点を
もとに、交差点の中心から一定距離離れた点、交差点で
通過させたい点、交差点の複数の点などの交差点を代表
するような点を選択することによりなされ、ついで道路
データの道幅や道路の長さ、移動ロボットの幅、長さ、
特性、例えば旋回半径などを考慮して次のようになされ
る。例えば、道幅からはみ出さないようにするときに
は、例えば図10に示すように、生成された主要通過点
の手前に主要通過点の追加がなされる。また、旋回半径
や特性を考慮したときには、例えば図11や図12に示
すように、主要通過点を手前に移動させたり、あるいは
道路の内側に移動させたりすることがなされる。
Then, the main passing point is created on the basis of the specified contact points. The main passing point is a coordinate value necessary for generating a spline function (curve), and is represented by, for example, (x coordinate value, y coordinate value).
Then, the generation of the main passing point is based on the contact point on the designated route, such as representing a point at a certain distance from the center of the intersection, a point to be passed at the intersection, a plurality of points of the intersection, and the like. This is done by selecting points, then the width and length of the road data, the width and length of the mobile robot,
The following is performed in consideration of characteristics such as a turning radius. For example, when the vehicle does not run off the road width, as shown in FIG. 10, for example, a main pass point is added before the generated main pass point. Further, when the turning radius and the characteristics are taken into consideration, the main passing point is moved to the front or moved to the inside of the road as shown in FIGS. 11 and 12, for example.

【0033】しかるのち、この主要通過点を通るように
スプライン関数の作成がなされる。しかしながら、主要
通過点の作成を簡略化するために、通常の場合は、接点
を主要通過点としてスプライン関数の作成がなされる
(図13参照)。なお、ここで作成されるスプライン関
数は、主要通過点の間を、主要通過点において1次微分
および2次微分が一致する多項式でつないだものであ
る。そのため、主要通過点の決め方でスプライン曲線の
形状や曲率が決定される。
Thereafter, a spline function is created so as to pass through the main passing point. However, in order to simplify the creation of the main passing point, a spline function is usually created with the contact as the main passing point (see FIG. 13). It should be noted that the spline function created here connects the main passage points with a polynomial in which the primary and secondary derivatives match at the main passage points. Therefore, the shape and curvature of the spline curve are determined by the way of determining the main passing point.

【0034】以下、軌道の生成方法について説明する。Hereinafter, a method of generating a trajectory will be described.

【0035】ステップ1:接点を主要通過点として選定
してスプライン関数を作成し、得られたスプライン関数
を軌道(スプライン軌道)として採用する。
Step 1: A spline function is created by selecting a contact point as a main passing point, and the obtained spline function is adopted as a trajectory (spline trajectory).

【0036】ステップ2:採用された軌道を評価し、評
価条件を満足すれば軌道生成作業を終了し、逆に満足し
なければステップ3に進む。
Step 2: The adopted trajectory is evaluated. If the evaluation conditions are satisfied, the trajectory generation operation is terminated.

【0037】ステップ3:主要通過点を追加または変更
してスプライン関数作成し、得られたスプライン関数を
軌道として採用してステップ2に戻る。
Step 3: A spline function is created by adding or changing a main passing point, and the obtained spline function is adopted as a trajectory, and the process returns to step 2.

【0038】軌道の評価 (1)道路の直線走行部で道幅からはみ出している箇所
があるか否かで評価し、該当箇所があれば不適当と判定
する(図14参照)。
Evaluation of the trajectory (1) It is evaluated whether or not there is a portion that runs off the road width in a straight running portion of the road, and if there is a corresponding portion, it is determined that it is inappropriate (see FIG. 14).

【0039】(2)主要通過点の2点間を結ぶ線分と、
生成されたスプライン関数で囲まれる部分の面積が、線
分を底辺とし道幅を高さとする三角形の面積より大きい
か否かで評価する。そして、三角形の面積の方が小さけ
れば不適当と判定する。例えば、3次スプライン関数を yi(x)=ai(x-xi)3+bi(x-xi)2+ci(x-xi)+di とし、主要通過点(xi,yi),(xi+1,yi+1)を結ぶ直線をs yi(x)=m(x-xi)+yi (ここにm=(yi+1-yi)/(xi+1-
xi)) としたとき(ただし、i=0,1,…,n)、道幅の半分をhi
すると、評価は下記評価関数Jによりなされる。
(2) A line segment connecting two main passing points,
The evaluation is made based on whether or not the area of the portion surrounded by the generated spline function is larger than the area of the triangle having the line segment as the base and the road width as the height. If the area of the triangle is smaller, it is determined to be inappropriate. For example, let the cubic spline function be y i (x) = a i (xx i ) 3 + b i (xx i ) 2 + c i (xx i ) + d i , and the main passing points (x i , y i ) , (x i + 1 , y i + 1 ) is represented by s y i (x) = m (xx i ) + y i (where m = (y i + 1 -y i ) / (x i + 1-
x i )) (where i = 0, 1,..., n), and if half of the road width is h i , the evaluation is performed by the following evaluation function J.

【0040】(3)生成されたスプライン軌道のすべて
が道路から出ていないかで評価し、1ヶ所でも出ていれ
ば不適当と判定する。
(3) An evaluation is made as to whether all of the generated spline trajectories do not protrude from the road, and if any of the spline trajectories protrudes, it is determined to be inappropriate.

【0041】主要通過点の追加方法 (1)接点から道幅に比例した距離離れた位置に追加す
る方法 例えば、図15に示すように、軌道がはみ出した道路
領域の図中左側の交差点(進行方向に対して手前の交差
点)に着目し、その交差点で主要通過点になっている2
つの接点から、それぞれ道幅に比例した距離、例えば道
幅分離れた距離の位置に主要通過点を追加する(2点追
加)。
Method of adding main passing point (1) Method of adding at a position distant from the contact point by a distance proportional to the road width For example, as shown in FIG. To the intersection before this), which is the main transit point at that intersection 2
From each of the two contact points, a main passage point is added at a position proportional to the road width, for example, at a distance separated by the road width (addition of two points).

【0042】例えば、図16に示すように、軌道が道
路からはみ出した部分の道路領域の図中左側の接点か
ら、道幅に比例した距離、例えば道幅分離れた距離の位
置に主要通過点を追加する(1点追加)。
For example, as shown in FIG. 16, a main passage point is added at a position proportional to the road width, for example, at a distance separated by the road width, from the left contact point in the figure of the road area where the track protrudes from the road. Yes (1 point added).

【0043】例えば、図17に示すように、軌道が道
路からはみ出した部分の道路領域の左側および右側の接
点から、それぞれ道幅に比例した距離、例えば道幅分離
れた距離に主要通過点を追加する(2点追加)。
For example, as shown in FIG. 17, a main passage point is added to a distance proportional to the road width, for example, a distance separated from the road width, from a contact point on the left and right sides of the road area where the track protrudes from the road. (2 points added).

【0044】(2)道幅からはみ出した部分の2つの接
点の中間位置に追加する方法(図18参照)
(2) A method of adding a portion protruding from the road width to an intermediate position between two contact points (see FIG. 18).

【0045】このように、本実施例の軌道生成装置によ
れば、指定する点の数を必要最小限に押えながら、問題
のない軌道、スプライン軌道を生成できる。
As described above, according to the trajectory generating apparatus of this embodiment, it is possible to generate a trajectory and a spline trajectory with no problem while keeping the number of designated points to a necessary minimum.

【0046】しかして、かかる軌道生成装置を搭載した
移動ロボットの走行は、例えば次のようにしてなされ
る。
The traveling of the mobile robot equipped with such a trajectory generator is performed, for example, as follows.

【0047】移動ロボットに搭載されている制御装置
は、同じく移動ロボットに搭載されている水平方向の回
転を検出する装置、例えば光ファイバージャイロ、およ
び走行距離を測定する装置、例えばエンコーダからの入
力に基づいて移動ロボットの現在位置を推定し、この推
定位置をスプライン軌道と照合してそのずれを求め、つ
いでこのずれがゼロとなるように移動ロボットの走行を
制御する。このようにすることにより、移動ロボットは
生成されたスプライン軌道に乗って移動することができ
る。なお、軌道生成装置をロボットに搭載することな
く、軌道生成装置により得られた軌道を、例えば無線に
よりロボットの制御装置に入力するようにしてもよい。
なお、無線交信のための装置については特に限定はな
い。
The control device mounted on the mobile robot is based on an input from a device for detecting rotation in the horizontal direction, for example, an optical fiber gyro, and a device for measuring the traveling distance, for example, an encoder, also mounted on the mobile robot. Then, the current position of the mobile robot is estimated, the estimated position is collated with the spline trajectory to determine the deviation, and the traveling of the mobile robot is controlled so that the deviation becomes zero. By doing so, the mobile robot can move on the generated spline trajectory. Note that the trajectory obtained by the trajectory generating device may be input to the control device of the robot wirelessly, for example, without mounting the trajectory generating device on the robot.
The device for wireless communication is not particularly limited.

【0048】以上、本発明を実施例に基づいて説明して
きたが、本発明はかかる実施例のみに限定されるもので
はなく、種々改変が可能である。例えば、本実施例にお
いては道路上を1台の移動ロボットを走行させるための
スプライン軌道を生成したが、道幅を適宜調整すること
により、複数台が対面しながら走行できるように軌道を
生成することもできる。
Although the present invention has been described based on the embodiments, the present invention is not limited to only the embodiments, and various modifications are possible. For example, in the present embodiment, a spline trajectory for running one mobile robot on the road is generated. However, by appropriately adjusting the road width, a trajectory is generated so that a plurality of vehicles can run while facing each other. Can also.

【0049】[0049]

【発明の効果】以上詳述したように、本発明によれば指
定する点を最小限に押えながら、道路の通行可能領域か
らはみ出すことのないスプライン軌道を生成することが
できるという優れた効果が得られる。そのため、本発明
の軌道生成装置を移動ロボットに搭載すれば、移動ロボ
ットの無人走行を円滑になし得るという優れた効果が得
られる。
As described above in detail, according to the present invention, there is an excellent effect that a spline trajectory that does not protrude from a traversable area of a road can be generated while minimizing a designated point. can get. Therefore, if the trajectory generating apparatus of the present invention is mounted on a mobile robot, an excellent effect that the unmanned traveling of the mobile robot can be smoothly achieved is obtained.

【図面の簡単な説明】[Brief description of drawings]

【図1】本発明の軌道生成方法に用いる軌道生成装置の
機能ブロック図である。
FIG. 1 is a functional block diagram of a trajectory generation device used in a trajectory generation method of the present invention.

【図2】環境地図の一例を示す図である。FIG. 2 is a diagram showing an example of an environment map.

【図3】順路表示手段に表示されている環境地図に対し
て順路を指示した状態を示す説明図である。
FIG. 3 is an explanatory diagram showing a state in which a route is instructed on the environment map displayed on the route display means.

【図4】主要通過点作成手段により指定経路上に接点が
生成された状態を示す説明図である。
FIG. 4 is an explanatory diagram illustrating a state in which a contact point is generated on a designated route by a main passing point creation unit.

【図5】図1に示す軌道生成装置の概略図である。FIG. 5 is a schematic diagram of the trajectory generation device shown in FIG.

【図6】地図データの説明図である。FIG. 6 is an explanatory diagram of map data.

【図7】交差点データの説明図である。FIG. 7 is an explanatory diagram of intersection data.

【図8】道路データの説明図である。FIG. 8 is an explanatory diagram of road data.

【図9】交差点K10における交差点データの説明図で
ある。
FIG. 9 is an explanatory diagram of intersection data at an intersection K10.

【図10】道幅からはみ出さないように生成された主要
通過点を修正する場合の説明図である。
FIG. 10 is an explanatory diagram in the case of correcting a main pass point generated so as not to run off a road width.

【図11】旋回半径や特性を考慮して生成された主要通
過点を修正する場合の説明図である。
FIG. 11 is an explanatory diagram in the case of correcting a main passing point generated in consideration of a turning radius and characteristics.

【図12】旋回半径や特性を考慮して生成された主要通
過点を修正する場合の他の例の説明図である。
FIG. 12 is an explanatory diagram of another example of correcting a main pass point generated in consideration of a turning radius and characteristics.

【図13】接点を主要通過点とした場合の説明図であ
る。
FIG. 13 is an explanatory diagram in a case where a contact is set as a main passage point.

【図14】軌道が直線走行部で道幅からはみ出した状態
の説明図である。
FIG. 14 is an explanatory diagram illustrating a state in which a track protrudes from a road width in a straight running section.

【図15】接点から道幅に比例した距離離れた位置に主
要通過点を追加した状態の説明図である。
FIG. 15 is an explanatory diagram showing a state in which a main passing point is added at a position distant from the contact point by a distance proportional to the road width.

【図16】接点から道幅に比例した距離離れた位置に主
要通過点を追加した状態の他の例の説明図である。
FIG. 16 is an explanatory diagram of another example of a state in which a main passage point is added to a position separated from the contact point by a distance proportional to the road width.

【図17】接点から道幅に比例した距離離れた位置に主
要通過点を追加した状態のさらに他の例の説明図であ
る。
FIG. 17 is an explanatory diagram of still another example of a state where a main passage point is added at a position separated from the contact point by a distance proportional to the road width.

【図18】接点の中央に主要通過点を追加した状態の説
明図である。
FIG. 18 is an explanatory diagram showing a state where a main passing point is added to the center of the contact.

【符号の説明】[Explanation of symbols]

1 環境地図情報記憶手段 2 環境地図情報読み取り手段 3 順路指示手段 4 主要通過点作成手段 5 スプライン軌道生成手段 6 軌道評価手段 7 主要通過点修正手段 20 演算処理装置 21 画像表示装置 22 入力装置 A 軌道生成装置 DESCRIPTION OF SYMBOLS 1 Environmental map information storage means 2 Environmental map information reading means 3 Route indication means 4 Major passage point creation means 5 Spline trajectory generation means 6 Trajectory evaluation means 7 Major passage point correction means 20 Arithmetic processing unit 21 Image display device 22 Input device A Trajectory Generator

───────────────────────────────────────────────────── フロントページの続き (72)発明者 吉田 孝一 明石市川崎町1番1号 川崎重工業株式会 社明石工場内 (72)発明者 澤井 恒義 明石市川崎町1番1号 川崎重工業株式会 社明石工場内 ─────────────────────────────────────────────────── ─── Continuation of the front page (72) Inventor Koichi Yoshida 1-1 Kawasaki-cho, Akashi City Kawasaki Heavy Industries Ltd. Akashi Factory (72) Inventor Tsuneyoshi Sawai 1-1, Kawasaki-cho Akashi-shi Kawasaki Heavy Industries Ltd. Akashi Factory

Claims (22)

【特許請求の範囲】[Claims] 【請求項1】 環境地図情報を読み取る手順と、始点と
終点と通過交差点とを指定する手順と、スプライン曲線
生成のための主要通過点を生成する手順と、生成された
主要通過点を通るスプライン曲線を生成する手順と、生
成されたスプライン曲線を評価する手順と、前記評価結
果により、必要に応じて前記スプライン曲線を修正する
手順とを含んでなることを特徴とする軌道生成方法。
1. A procedure for reading environmental map information, a procedure for designating a start point, an end point, and a passing intersection, a procedure for generating a main passing point for generating a spline curve, and a spline passing through the generated main passing point. A trajectory generation method comprising: a step of generating a curve; a step of evaluating the generated spline curve; and a step of correcting the spline curve as necessary according to the evaluation result.
【請求項2】 前記主要通過点を生成する手順におい
て、接点が主要通過点とされることを特徴とする請求項
1記載の軌道生成方法。
2. The trajectory generation method according to claim 1, wherein in the procedure of generating the main passing point, a contact point is set as the main passing point.
【請求項3】 前記主要通過点を生成する手順におい
て、先に生成された主要通過点の進行方向手前側に主要
通過点を追加することがなされることを特徴とする請求
項1記載の軌道生成方法。
3. The trajectory according to claim 1, wherein, in the procedure of generating the main passing point, the main passing point is added on the front side in the traveling direction of the previously generated main passing point. Generation method.
【請求項4】 前記主要通過点を生成する手順におい
て、生成された主要通過点を進行方向手前側または内側
に移動することがなされることを特徴とする請求項1記
載の軌道生成方法。
4. The trajectory generation method according to claim 1, wherein in the procedure of generating the main passing point, the generated main passing point is moved to the front side or the inner side in the traveling direction.
【請求項5】 前記スプライン曲線の評価が、主要通過
点の2点間を結ぶ線分と、生成されたスプライン関数で
囲まれる部分の面積が、線分を底辺とし道幅を高さとす
る三角形の面積より大きいか否かでなされることを特徴
とする請求項1記載の軌道生成方法。
5. The evaluation of the spline curve is such that a line segment connecting two main passing points and an area of a portion surrounded by the generated spline function are a triangle having a line segment as a base and a road width as a height. 2. The trajectory generation method according to claim 1, wherein the trajectory generation is performed based on whether the area is larger than the area.
【請求項6】 前記スプライン曲線の修正が、接点から
道幅に比例した距離離れた位置に主要通過点を追加する
ことによりなされることを特徴とする請求項1記載の軌
道生成方法。
6. The trajectory generation method according to claim 1, wherein the spline curve is modified by adding a main passing point at a position distant from the contact point by a distance proportional to the road width.
【請求項7】 前記主要通過点の追加が、軌道がはみ出
した道路領域の進行方向手前側の交差点において、その
交差点で主要通過点になっている2つの接点から、それ
ぞれ道幅に比例した距離離れた位置になされることを特
徴とする請求項6記載の軌道生成方法。
7. The method according to claim 1, wherein the addition of the main passage point is performed at an intersection on the front side in the traveling direction of the road area where the track protrudes, away from two junctions that are the main passage points at the intersection at a distance proportional to the road width. 7. The trajectory generation method according to claim 6, wherein the trajectory generation is performed at a shifted position.
【請求項8】 前記主要通過点の追加が、軌道がはみ出
した道路領域の進行方向手前側の交差点において、その
道路と接続している接点から、道路幅に比例した距離離
れた位置になされることを特徴とする請求項6記載の軌
道生成方法。
8. The addition of the main passage point is performed at a crossing point on the near side in the traveling direction of the road area where the trajectory protrudes, at a position away from a contact point connected to the road by a distance proportional to the road width. 7. The trajectory generation method according to claim 6, wherein:
【請求項9】 前記主要通過点の追加が、軌道がはみ出
した道路領域を挾むそれぞれの交差点の道路と接続して
いる接点から、道路幅に比例した距離離れた位置になさ
れることを特徴とする請求項6記載の軌道生成方法。
9. The method according to claim 9, wherein the addition of the main passing point is performed at a position that is a distance proportional to the road width from a contact point connected to a road at each intersection sandwiching the road area where the track protrudes. The trajectory generation method according to claim 6, wherein
【請求項10】 前記スプライン曲線の修正が、軌道が
はみ出した道路領域を挾むそれぞれの交差点の道路と接
続している接点の中間位置に主要通過点を追加すること
によりなされることを特徴とする請求項1記載の軌道生
成方法。
10. The modification of the spline curve is performed by adding a main passing point at an intermediate position of a contact point which is connected to a road at each intersection crossing a road area where a track extends. The trajectory generation method according to claim 1.
【請求項11】 環境地図情報を記憶する手段と、環境
地図情報を読み取る手段と、始点と終点と通過交差点と
を指定する手段と、スプライン曲線生成のための主要通
過点を生成する手段と、生成された主要通過点を通るス
プライン曲線を生成する手段と、生成されたスプライン
曲線を評価する手段と、前記スプライン曲線を修正する
手段とを備えてなることを特徴とする軌道生成装置。
11. A means for storing environment map information, a means for reading the environment map information, a means for designating a start point, an end point and a passing intersection, and means for generating a main passing point for generating a spline curve. A trajectory generation device comprising: a means for generating a spline curve passing through the generated main passage points; a means for evaluating the generated spline curve; and a means for correcting the spline curve.
【請求項12】 前記主要通過点を生成する手段におい
て、先に生成された主要通過点の進行方向手前側に主要
通過点を追加することがなされることを特徴とする請求
項11記載の軌道生成装置。
12. The track according to claim 11, wherein the means for generating the main passing point is configured to add the main passing point on the front side in the traveling direction of the previously generated main passing point. Generator.
【請求項13】 前記主要通過点を生成する手段におい
て、生成された主要通過点を進行方向手前側または内側
に移動することがなされることを特徴とする請求項11
記載の軌道生成装置。
13. The means for generating the main passing point is configured to move the generated main passing point forward or inward in the traveling direction.
The orbit generation device described.
【請求項14】 前記生成されたスプライン曲線を評価
する手段において、前記スプライン曲線の評価が、主要
通過点の2点間を結ぶ線分と、生成されたスプライン関
数で囲まれる部分の面積が、線分を底辺とし道幅を高さ
とする三角形の面積より大きいか否かでなされることを
特徴とする請求項11記載の軌道生成装置。
14. The means for evaluating the generated spline curve, wherein the evaluation of the spline curve is such that a line segment connecting two main passing points and an area of a portion surrounded by the generated spline function are: 12. The trajectory generation device according to claim 11, wherein the trajectory generation is performed based on whether or not the area is larger than a triangle having a line segment as a base and a road width as a height.
【請求項15】 前記スプライン曲線を修正する手段に
おいて、前記スプライン曲線の修正が、接点から道幅に
比例した距離離れた位置に主要通過点を追加することに
よりなされることを特徴とする請求項11記載の軌道生
成装置。
15. The means for modifying the spline curve is characterized in that the modification of the spline curve is performed by adding a main passing point at a position distant from the contact point by a distance proportional to the road width. The orbit generation device described.
【請求項16】 前記主要通過点の追加が、軌道がはみ
出した道路領域の進行方向手前側の交差点において、そ
の交差点で主要通過点になっている2つの接点から、そ
れぞれ道幅に比例した距離離れた位置になされることを
特徴とする請求項15記載の軌道生成装置。
16. The addition of the main passage point is a method in which, at the intersection on the front side in the traveling direction of the road area where the track protrudes, a distance proportional to the width of the road is separated from two junctions that are the main passage points at the intersection. 16. The trajectory generation device according to claim 15, wherein the trajectory generation is performed at a different position.
【請求項17】 前記主要通過点の追加が、軌道がはみ
出した道路領域の進行方向手前側の交差点において、そ
の道路と接続している接点から、道路幅に比例した距離
離れた位置になされることを特徴とする請求項15記載
の軌道生成装置。
17. The addition of the main passage point is made at a crossing point on the near side in the traveling direction of the road area where the track protrudes, at a position away from a contact point connected to the road by a distance proportional to the road width. The trajectory generation device according to claim 15, wherein:
【請求項18】 前記主要通過点の追加が、軌道がはみ
出した道路領域を挾むそれぞれの交差点の道路と接続し
ている接点から、道路幅に比例した距離離れた位置にな
されることを特徴とする請求項15記載の軌道生成装
置。
18. The method according to claim 18, wherein the addition of the main passage point is performed at a position that is a distance proportional to the road width from a contact point connected to a road at each intersection sandwiching the road area where the track protrudes. The trajectory generation device according to claim 15, wherein
【請求項19】 前記スプライン曲線を修正する手段に
おいて、前記スプライン曲線の修正が、軌道がはみ出し
た道路領域を挾むそれぞれの交差点の道路と接続してい
る接点の中間位置に主要通過点を追加することによりな
されることを特徴とする請求項11記載の軌道生成装
置。
19. The means for correcting a spline curve, wherein the correction of the spline curve includes adding a main passing point at an intermediate position between contact points connected to roads at respective intersections sandwiching a road region where a track protrudes. The trajectory generation device according to claim 11, wherein the trajectory generation is performed.
【請求項20】 始点と終点と通過交差点とを指定する
手段および/または前記スプライン曲線を修正する手段
が、残りの他の手段を備える軌道生成装置本体と分離さ
れ、前記分離された手段と軌道生成装置本体との入出力
が無線によりなされることを特徴とするする請求項11
記載の軌道生成装置。
20. A means for designating a start point, an end point, and a passing intersection and / or a means for modifying the spline curve is separated from a main body of a trajectory generating device including the remaining other means, and the separated means and the trajectory. 12. Input / output to / from the generator main body is performed wirelessly.
The orbit generation device described.
【請求項21】 請求項1ないし請求項10のいずれか
に記載の方法により生成された軌道を用いて移動ロボッ
トを制御することを特徴とする移動ロボットの制御方
法。
21. A control method for a mobile robot, comprising controlling the mobile robot using a trajectory generated by the method according to claim 1. Description:
【請求項22】 請求項11ないし20のいずれかに記
載の軌道生成装置を備えてなることを特徴とするする移
動ロボット。
22. A mobile robot comprising the trajectory generating device according to any one of claims 11 to 20.
JP6288777A 1994-10-28 1994-10-28 Trajectory generation method and trajectory generation device Expired - Lifetime JP2651662B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP6288777A JP2651662B2 (en) 1994-10-28 1994-10-28 Trajectory generation method and trajectory generation device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP6288777A JP2651662B2 (en) 1994-10-28 1994-10-28 Trajectory generation method and trajectory generation device

Publications (2)

Publication Number Publication Date
JPH08123547A true JPH08123547A (en) 1996-05-17
JP2651662B2 JP2651662B2 (en) 1997-09-10

Family

ID=17734586

Family Applications (1)

Application Number Title Priority Date Filing Date
JP6288777A Expired - Lifetime JP2651662B2 (en) 1994-10-28 1994-10-28 Trajectory generation method and trajectory generation device

Country Status (1)

Country Link
JP (1) JP2651662B2 (en)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB2378433B (en) * 2001-06-08 2004-03-10 Quin Systems Ltd Robotic devices
US7191060B2 (en) 2003-03-25 2007-03-13 Sandvik Tamrock Oy Method for automatically guiding a mining machine
JP2010211827A (en) * 1998-02-13 2010-09-24 Komatsu Ltd Vehicle guidance system
JP2015111463A (en) * 2015-03-11 2015-06-18 日本電気株式会社 Travel support apparatus, travel support method, and program
JP2017165156A (en) * 2016-03-14 2017-09-21 本田技研工業株式会社 Vehicle control system, vehicle control method and vehicle control program
JP2021089776A (en) * 2021-03-09 2021-06-10 ヤンマーパワーテクノロジー株式会社 Travel region specification system and travel region specification method
US11181920B2 (en) 2018-08-28 2021-11-23 Denso Corporation Travel assistance method and travel assistance apparatus

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
AU769593B2 (en) * 1998-12-03 2004-01-29 Komatsu Limited Vehicle guidance system

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010211827A (en) * 1998-02-13 2010-09-24 Komatsu Ltd Vehicle guidance system
GB2378433B (en) * 2001-06-08 2004-03-10 Quin Systems Ltd Robotic devices
US7191060B2 (en) 2003-03-25 2007-03-13 Sandvik Tamrock Oy Method for automatically guiding a mining machine
JP2015111463A (en) * 2015-03-11 2015-06-18 日本電気株式会社 Travel support apparatus, travel support method, and program
JP2017165156A (en) * 2016-03-14 2017-09-21 本田技研工業株式会社 Vehicle control system, vehicle control method and vehicle control program
US11181920B2 (en) 2018-08-28 2021-11-23 Denso Corporation Travel assistance method and travel assistance apparatus
JP2021089776A (en) * 2021-03-09 2021-06-10 ヤンマーパワーテクノロジー株式会社 Travel region specification system and travel region specification method

Also Published As

Publication number Publication date
JP2651662B2 (en) 1997-09-10

Similar Documents

Publication Publication Date Title
US10598505B2 (en) Travel route generation apparatus and method for generating travel route
JP7016214B2 (en) Travelable area setting device and travelable area setting method
AU737693B2 (en) Method and system for describing, generating and checking non-wire guidepaths for automatic guided vehicles
JP3621569B2 (en) Vehicle automatic travel control system
JP6104715B2 (en) Route generation method and apparatus
JPH02260000A (en) Method and device for searching movement route
JP2000512016A (en) A navigation method for transport means intended to change the heading, and its application to zone side detours
Wang et al. Action annotated trajectory generation for autonomous maneuvers on structured road networks
EP3239657B1 (en) Information processing device
JP2651662B2 (en) Trajectory generation method and trajectory generation device
CN115079702B (en) Intelligent vehicle planning method and system under mixed road scene
US20210003410A1 (en) Route generation device, route generation method and travel control device
JP2007328486A (en) Moving robot
JP7047659B2 (en) Control device and control method for automatic guided vehicle
US20190227552A1 (en) Vehicle control device
JP3715420B2 (en) Driving program creation device for automated guided vehicles
De Lima et al. Sensor-based control with digital maps association for global navigation: a real application for autonomous vehicles
JP2021169234A (en) Vehicle motion control device and vehicle operation control method
JP2816706B2 (en) Driving instruction creation device for automatic guided vehicles
JPH01187607A (en) Operation program automatic generation device for automatically guided truck
JP5010833B2 (en) In-vehicle information terminal
JP2928658B2 (en) Optimal route search device for mobile robots
JP2711690B2 (en) Driving instruction creation device for automatic guided vehicles
CN113436455A (en) Driving support system and driving support program
JP2663442B2 (en) Driving control device for unmanned vehicles

Legal Events

Date Code Title Description
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 19970408