JPH11175151A - Method and device for controlling moving robot and recording medium - Google Patents

Method and device for controlling moving robot and recording medium

Info

Publication number
JPH11175151A
JPH11175151A JP9338333A JP33833397A JPH11175151A JP H11175151 A JPH11175151 A JP H11175151A JP 9338333 A JP9338333 A JP 9338333A JP 33833397 A JP33833397 A JP 33833397A JP H11175151 A JPH11175151 A JP H11175151A
Authority
JP
Japan
Prior art keywords
control
mobile robot
map information
law
control rule
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.)
Withdrawn
Application number
JP9338333A
Other languages
Japanese (ja)
Inventor
Akira Takagi
昭 高木
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.)
Fuji Electric Co Ltd
Original Assignee
Fuji Electric 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 Fuji Electric Co Ltd filed Critical Fuji Electric Co Ltd
Priority to JP9338333A priority Critical patent/JPH11175151A/en
Publication of JPH11175151A publication Critical patent/JPH11175151A/en
Withdrawn legal-status Critical Current

Links

Landscapes

  • Manipulator (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

PROBLEM TO BE SOLVED: To enable a robot to adapt itself flexibly to different work places and to increase the readout speed of a control rule. SOLUTION: Control rule numbers corresponding to a control rule one to one for enery pixel are determined and read in a control rule data array for every pixel, to generate map information wherein the control rules regarding movement for every specified area are described (S2). The command position of a moving robot is generated (S3) from its current position and an operation instruction to the moving robot, coordinates of the command position on an X-Y coordinate system are found, and a control rule is read out (S4) by matching the control rule number of the corresponding coordinates in the control rule data array against a number-control rule corresponding table showing the corresponding relation between the control rule numbers and control rules corresponding to the control rule numbers, thereby controlling the movement of the robot according to the control rule.

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【発明の属する技術分野】本発明は、所定の領域毎に移
動に関する制御則を定めた地図情報を有し、地図情報に
基づき移動制御を行なう移動ロボットの移動制御技術に
関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a movement control technique for a mobile robot which has map information defining a control rule for movement for each predetermined area and performs movement control based on the map information.

【0002】[0002]

【従来の技術】移動ロボットの移動制御装置として、幾
何学的な図形として領域を定義し、領域毎の制御則を定
めた地図情報を有し、領域を定義する図形の数学的な特
徴に基づいて進入判定(図形内に入っているか否かを解
析的に判定する)を行なう移動ロボットの移動制御装置
等がある。
2. Description of the Related Art As a movement control device for a mobile robot, a region is defined as a geometrical figure, the map has map information defining a control rule for each area, and is based on mathematical characteristics of the figure defining the area. For example, there is a movement control device of a mobile robot that performs an approach determination (analytically determines whether or not a figure is included in a figure).

【0003】この移動ロボットの移動制御装置では、移
動ロボットのテレビカメラで捕えられた進行方向の画像
の画像データを処理して幾何学的な特徴を抽出し、この
幾何学的な特徴と予め設定された幾何学的な図形の特徴
毎に制御則を定めた地図情報とを比較して、最も近い幾
何学的な図形の制御則を、そのテレビカメラで捕えられ
た進行方向の制御則とする。
In this mobile robot movement control apparatus, geometric data is extracted by processing image data of an image in the traveling direction captured by a television camera of the mobile robot, and the geometric data is extracted and set in advance. The control rule of the closest geometrical figure is compared with the map information that defines the control rule for each feature of the geometrical figure thus obtained, and the control rule of the traveling direction captured by the television camera is determined as the closest control law of the geometrical figure. .

【0004】[0004]

【発明が解決しようとする課題】上述したように、従来
は、複数の作業場所に対応させる場合、移動ロボットの
テレビカメラで捕えられた進行方向の画像データを処理
して幾何学的な特徴を抽出し、この幾何学的な特徴と予
め設定された幾何学的な図形の特徴毎に制御則を定めた
地図情報とを比較して、最も近い幾何学的な図形の制御
則を、そのテレビカメラで捕えられた進行方向の制御則
としていた。そのため、移動ロボットのテレビカメラで
捕えられた進行方向の画像データを処理して幾何学的な
特徴を抽出するのに時間がかかり、更に、この幾何学的
な特徴と予め設定された幾何学的な図形の特徴毎に制御
則を定めた地図情報とを比較する処理に時間がかかって
いた。
As described above, conventionally, when corresponding to a plurality of work places, image data in a traveling direction captured by a television camera of a mobile robot is processed to form a geometric feature. The extracted geometric features are compared with the map information in which control rules are set for each of the geometric features set in advance, and the control rules of the closest geometric shapes are determined by the TV. It was a control law for the direction of travel captured by the camera. Therefore, it takes time to process the image data in the traveling direction captured by the television camera of the mobile robot to extract the geometric feature, and further, it is necessary to further process the geometric feature and the preset geometric feature. It takes a long time to perform a process of comparing the map information with a control rule for each characteristic of a simple figure.

【0005】また、多くの異なる作業現場に対応できる
ようにするためには、幾何学的な図形の特徴に対する制
御則の設定を増やすしかなかった。そのため、より多く
の幾何学的な図形の特徴を有する地図情報と進行方向の
画像データの幾何学的な特徴とを比較して制御則の判定
の処理を行なければならず、更に、制御則の判定の処理
に時間がかかった。
Further, in order to be able to cope with many different work sites, it is necessary to increase the setting of control rules for the features of geometric figures. Therefore, it is necessary to compare the map information having more geometrical features with the geometrical features of the image data in the traveling direction to perform the control rule determination process. It took time to perform the judgment.

【0006】このように、時間のかかる処理を行なう
と、常時制御則を適用するために十分な読み出し速度を
得にくいという問題点があった。また、幾何学的な図形
の特徴を複数有する地図情報と進行方向の画像データの
幾何学的な特徴とを比較して制御則の判定の処理を行な
うので、定義された領域の数が増えると、更に、制御則
の判定の処理に時間がかり、更に、読み出し速度が遅く
なってしまうという問題点があった。
[0006] As described above, there is a problem that it is difficult to obtain a sufficient reading speed for applying the control rule at all times when performing a time-consuming process. In addition, since map information having a plurality of geometric figure features is compared with the geometric features of the image data in the traveling direction to perform the control rule determination process, when the number of defined regions increases, In addition, there is a problem that it takes time to determine the control law, and the reading speed is reduced.

【0007】本発明の課題は、異なる複数の作業場所に
柔軟に対応できるようにするとともに、制御則の読み出
し速度を上げることである。
An object of the present invention is to make it possible to flexibly cope with a plurality of different work places and to increase the speed of reading out control rules.

【0008】[0008]

【課題を解決するための手段】本発明は上記課題を解決
するため、地図情報作成手段によって、所定の領域毎に
移動ロボットの移動に関する制御則を記述した地図情報
が作成される。
According to the present invention, in order to solve the above-mentioned problems, map information describing a control rule relating to the movement of a mobile robot is created for each predetermined area by map information creating means.

【0009】制御則読出手段によって、移動ロボットの
走行現在位置と移動ロボットに対する動作命令から移動
ロボットが次に移動する位置である指令位置を生成し、
前記地図情報より該指令位置に対応する位置の制御則が
読み出される。
The control law reading means generates a command position, which is a position to which the mobile robot moves next, from the current traveling position of the mobile robot and an operation command for the mobile robot,
A control rule for a position corresponding to the command position is read from the map information.

【0010】移動ロボット制御手段によって、操縦部か
らの動作命令及び前記制御則読出手段によって読み出し
た制御則に基づいて移動ロボットの移動が制御されるの
で、地図情報を作業場所毎に用意することによって、特
別な処理を行うことなく、複数の作業場所に対応するこ
とができる。
The movement of the mobile robot is controlled by the mobile robot control means on the basis of the operation command from the control unit and the control rules read by the control law reading means, so that map information is prepared for each work place. It is possible to deal with a plurality of work places without performing special processing.

【0011】[0011]

【発明の実施の形態】以下、本発明の実施形態について
図面を参照しながら説明する。本発明の実施形態は、各
画素毎に制御則と1対1で対応する制御則番号を定め、
その制御則番号を各画素毎に制御則データ配列に読み込
むことで、所定の領域毎に移動に関する制御則を記述し
た地図情報を作成する。
Embodiments of the present invention will be described below with reference to the drawings. According to the embodiment of the present invention, a control law number corresponding to a control law for each pixel in one-to-one correspondence is determined,
By reading the control rule number into a control rule data array for each pixel, map information describing a control rule relating to movement for each predetermined area is created.

【0012】移動ロボットの走行現在位置と移動ロボッ
トに対する動作命令から移動ロボットが次に移動する位
置である指令位置を生成し、その指令位置のX−Y座標
系上の座標を求め、制御則データ配列の対応する座標の
制御則番号を読み出す。
A command position, which is a position to which the mobile robot moves next, is generated from the current traveling position of the mobile robot and an operation command for the mobile robot, and the coordinates of the command position on the XY coordinate system are obtained. Read the control law number of the corresponding coordinate in the array.

【0013】そして、その制御則番号を制御則番号と制
御則番号に対応する制御則の対応関係を表わした番号−
制御則対応表と照らし合せて制御則を読み出し、その制
御則に基づき移動ロボットの移動を制御するというもの
である。
The control law number is represented by a number representing the correspondence between the control law number and the control law corresponding to the control law number.
The control law is read out in comparison with the control law correspondence table, and the movement of the mobile robot is controlled based on the control law.

【0014】本発明の実施形態の移動ロボットの制御装
置の全体構成について図1を参照しながら説明する。C
PU2は、操縦部9からの動作命令及び移動ロボットの
現在位置情報に基づき、特に図示していない記憶装置に
装着される外部の記録媒体2aまたはROM5に記憶さ
れているプログラム等により、VRAM3及びRAM4
を使用しながらこの移動ロボット29の制御装置1にお
いて必要な処理を行なう。
An overall configuration of a control device for a mobile robot according to an embodiment of the present invention will be described with reference to FIG. C
The PU 2 stores the VRAM 3 and the RAM 4 on the basis of an operation command from the control unit 9 and the current position information of the mobile robot, based on a program or the like stored in an external recording medium 2 a or a ROM 5 mounted on a storage device (not shown).
The necessary processing is performed in the control device 1 of the mobile robot 29 while using.

【0015】走行駆動部6は、操縦部9からの動作命令
に基づき生成された走行動作命令及びCPU2からの移
動ロボット29の現在位置における制御則の制御パラメ
ータに基づき動作する。
The travel drive unit 6 operates based on a travel operation command generated based on an operation command from the control unit 9 and a control parameter of a control law at the current position of the mobile robot 29 from the CPU 2.

【0016】マニピュレータ7は、操縦部9からの動作
命令及びCPU2からの移動ロボット29の現在位置に
おける制御則の制御パラメータに基づき動作する。モニ
タカメラ8は、移動ロボット29の進行方向の映像をと
らえ、モニタテレビ10は、その映像を映し出す。
The manipulator 7 operates based on an operation command from the control unit 9 and a control parameter of a control law at the current position of the mobile robot 29 from the CPU 2. The monitor camera 8 captures an image of the traveling direction of the mobile robot 29, and the monitor television 10 displays the image.

【0017】操縦部9は、作業員がモニタテレビ10に
映し出された映像を見ながら操作すると、操作状況に応
じた動作命令をCPU2、駆動部6、及びマニピュレー
タ7に転送する。
When the operator operates while watching the image displayed on the monitor television 10, the control unit 9 transfers an operation command corresponding to the operation status to the CPU 2, the drive unit 6, and the manipulator 7.

【0018】つぎに、本発明の実施形態の移動ロボット
29の制御装置1の概略動作について図2を参照しなが
ら説明する。図2は、移動ロボット29の制御装置1と
操縦部9の全体構成を表わす図である。
Next, a schematic operation of the control device 1 of the mobile robot 29 according to the embodiment of the present invention will be described with reference to FIG. FIG. 2 is a diagram illustrating the overall configuration of the control device 1 and the control unit 9 of the mobile robot 29.

【0019】移動ロボット29のテレビカメラ8でとら
えられた映像は、モニタテレビ10に映し出される。作
業員21が、その映像を見ながら操縦部9を操作する
と、操縦部9より、操作状況に応じた動作命令が無線機
22を介して、移動ロボット29に内蔵されている無線
機23に動作命令が転送される。
An image captured by the television camera 8 of the mobile robot 29 is displayed on a monitor television 10. When the worker 21 operates the control unit 9 while watching the image, the operation command corresponding to the operation status is transmitted from the control unit 9 to the wireless device 23 built in the mobile robot 29 via the wireless device 22. Instructions are transferred.

【0020】移動ロボット29に内蔵されている無線機
23に転送された動作命令は、走行制御部24及びマニ
ピュレータ制御処理部27に転送され、その動作命令に
基づく制御処理が行なわれる。
The operation command transferred to the wireless device 23 built in the mobile robot 29 is transferred to the traveling control unit 24 and the manipulator control processing unit 27, and control processing based on the operation command is performed.

【0021】なお、指令位置は、現在位置と動作命令よ
り指令位置を求め、その指令位置に基づき制御則の制御
パラメータを読み出し、その制御パラメータが走行制御
部24及びマニピュレータ7に転送されるまでの時間と
同じ時間が経った時に、移動ロボット29が位置する位
置であり、地図情報の各画素は移動ロボット29に比べ
とても小さいものとする。
The command position is obtained by obtaining the command position from the current position and the operation command, reading out the control parameters of the control law based on the command position, and transferring the control parameters to the travel control unit 24 and the manipulator 7. When the same time as the time elapses, the position where the mobile robot 29 is located, and each pixel of the map information is much smaller than the mobile robot 29.

【0022】また、走行制御部24は、走行駆動部6か
ら転送される移動ロボット29の現在位置の情報である
走行現在位置情報と動作命令とより、移動ロボット29
が次に移動する位置である指令位置の指令位置情報を生
成する。その生成された指令位置情報は、制御則読出処
理部25に転送される。
The travel control unit 24 also uses the travel current position information, which is information on the current position of the mobile robot 29 transferred from the travel drive unit 6, and an operation command, to execute the mobile robot 29.
Generates command position information of the command position that is the next position to move. The generated command position information is transferred to the control law read processing unit 25.

【0023】制御則読出処理部25は、指令位置情報に
基づいて地図情報記憶部26より制御則のマニピュレー
タ制御パラメータ、走行制御パラメータ、及びインター
ロック種類を読み出し、マニピュレータ制御パラメータ
をマニピュレータ制御処理部27に転送し、走行制御パ
ラメータを走行制御部24に転送し、インターロック種
類をインターロック処理部28に各々転送する。
The control law read processing unit 25 reads out the manipulator control parameters, travel control parameters, and interlock types of the control law from the map information storage unit 26 based on the command position information, and reads the manipulator control parameters into the manipulator control processing unit 27. To the traveling control parameters to the traveling control unit 24, and the interlock type to the interlock processing unit 28.

【0024】マニピュレータ制御処理部27は、動作命
令及びマニピュレータ制御パラメータに基づきマニピュ
レータ7の動作を制御するとともに、マニピュレータ7
の現在状態情報をインターロック処理部28に転送す
る。
The manipulator control processing unit 27 controls the operation of the manipulator 7 based on the operation command and the manipulator control parameter, and also controls the manipulator 7.
Is transferred to the interlock processing unit 28.

【0025】インターロック処理部28は、インターロ
ック種類とマニピュレータ7の現在状態とに基づきイン
ターロックデータを走行制御部24に転送する。走行制
御部24は、動作命令、走行制御パラメータ、及びイン
ターロックデータに基づき走行制御を行なう。
The interlock processing section 28 transfers the interlock data to the traveling control section 24 based on the type of the interlock and the current state of the manipulator 7. The traveling control unit 24 performs traveling control based on the operation command, traveling control parameters, and interlock data.

【0026】なお、走行制御部24、制御則読出処理部
25、及びマニピュレータ制御処理部27は、CPU2
が記録媒体2a或いはROM5に格納されたプログラム
を実行することで実現される機能を仮想的に表わしたも
のであり、また、地図情報記憶部26は、VRAM3に
よって実現される機能を仮想的に表わしたものである。
The traveling control unit 24, the control law reading processing unit 25, and the manipulator control processing unit 27
Represents a function realized by executing a program stored in the recording medium 2a or the ROM 5, and the map information storage unit 26 virtually represents a function realized by the VRAM 3. It is a thing.

【0027】つぎに、本発明の実施形態の詳細な動作に
ついて、図3から図11を参照しながら説明する。本発
明の実施形態の移動ロボット29の制御装置1の全体動
作について説明する。
Next, a detailed operation of the embodiment of the present invention will be described with reference to FIGS. The overall operation of the control device 1 of the mobile robot 29 according to the embodiment of the present invention will be described.

【0028】図3は、CPU2が記録媒体2aに格納さ
れたプログラムを実行することにより行なわれる本発明
の実施形態による移動ロボット制御処理のフローチャー
トである。
FIG. 3 is a flowchart of a mobile robot control process according to the embodiment of the present invention, which is performed by the CPU 2 executing a program stored in the recording medium 2a.

【0029】まず、操縦部9の操作により、新たな地図
情報の作成ならば、地図情報を作成するので、地図情報
の作成か否かを判断し(S1)、地図情報の作成を行な
う(S2)。
First, if new map information is created by operating the control unit 9, map information is created. It is determined whether or not map information is created (S1), and map information is created (S2). ).

【0030】地図情報の作成手順の詳細について、図4
及び図5を参照しながら説明する。図4は、地図情報作
成処理のフローチャートであり、図5は、地図情報の作
成手順を示した図である。図4及び図5を対応させなが
ら説明する。
FIG. 4 shows the details of the procedure for creating map information.
This will be described with reference to FIG. FIG. 4 is a flowchart of the map information creation process, and FIG. 5 is a diagram showing a procedure for creating the map information. This will be described with reference to FIGS.

【0031】地図情報の作成手順を説明する前に、地図
情報の作成手順の一例として作成する作業場所の間取り
と移動ロボット29を制御するときの約束ごとについて
述べる。
Before describing the procedure for creating the map information, the layout of the work place to be created and the rules for controlling the mobile robot 29 will be described as an example of the procedure for creating the map information.

【0032】これから地図情報の作成手順の一例として
作成する作業場所41の間取りは、工作機械A42と工
作機械B43とがあり、移動ロボット29は、作業員2
1の操縦に従って工作機械B43で加工したワークを矢
印49の方向に抜き取り、工作機械A42に矢印50の
方向に差し入れるものとする。工作機械A42と工作機
械B43の間には、防火シャッタ44があり、防火シャ
ッタ44は通常開いているものとする。また、作業場所
41は、周りを壁で囲まれており、ドア48があるもの
とする。なお、移動ロボット29の指令位置の検出系に
おける位置は、作業場所41の壁と平行に座標軸を持つ
直交座標系上で表現されるものとする。
The layout of the work place 41 to be created as an example of the procedure for creating map information includes a machine tool A42 and a machine tool B43.
According to the first operation, the workpiece processed by the machine tool B43 is extracted in the direction of arrow 49 and inserted into the machine tool A42 in the direction of arrow 50. A fire shutter 44 is provided between the machine tool A42 and the machine tool B43, and the fire shutter 44 is normally open. The work place 41 is surrounded by a wall and has a door 48. Note that the position of the command position of the mobile robot 29 in the detection system is represented on an orthogonal coordinate system having coordinate axes parallel to the wall of the work place 41.

【0033】また、作業場所41において移動ロボット
29の移動を制御する時に以下のような約束ごとがある
とする。 壁、機械の周囲はゆっくりと走行しなければならな
い。 狭い場所を抜けるときにはマニピュレータ7を縮めな
ければならない。 ドア48の周辺に進入してはならない。また、機械、
防火シャッタ44には進入してはならない。
When controlling the movement of the mobile robot 29 in the work place 41, it is assumed that the following promises are made. You must run slowly around walls and machines. When passing through a narrow place, the manipulator 7 must be contracted. Do not enter near door 48. Also machinery,
The fire protection shutter 44 must not enter.

【0034】それぞれの約束ごとを適用する場所を低速
走行領域45(約束ごとのに対応)、マニピュレータ
動作不可領域46(約束ごとのに対応)、及び進入不
可領域47(約束ごとのに対応)として、それぞれ制
御則を決定する。なお、簡単化のために、マニピュレー
タ動作不可領域46は低速走行を行なうものとする。
The places where the respective promises are applied are defined as a low-speed traveling area 45 (corresponding to each promise), a manipulator inoperable area 46 (corresponding to each promise), and an inaccessible area 47 (corresponding to each promise). , Respectively, to determine a control law. For simplification, it is assumed that the manipulator inoperable region 46 runs at low speed.

【0035】以上の条件で地図情報の作成手順について
説明する。まず、約束ごとを適用する場所を低速走行領
域45、マニピュレータ動作不可領域46、及び進入不
可領域47としてそれぞれ判別し、描画領域52を決定
する(S11)。描画領域52の大きさは、制御則の違
う領域をかき分けられるぐらい大きいものとする。ま
た、描画領域52における縦横の画素数が後述する制御
則データ配列の大きさとなる。
A procedure for creating map information under the above conditions will be described. First, the places to which each promise is applied are determined as the low-speed traveling area 45, the manipulator inoperable area 46, and the inaccessible area 47, and the drawing area 52 is determined (S11). It is assumed that the size of the drawing area 52 is large enough to distinguish areas having different control rules. The number of vertical and horizontal pixels in the drawing area 52 is the size of the control rule data array described later.

【0036】つぎに、図5(b)のように、描画領域5
2を制御則の異なる領域に分割する線、分割線51を描
く(S12)。分割線51の描画色は、後述する塗りつ
ぶし色とは異なるものにする。
Next, as shown in FIG.
A line dividing the line 2 into regions having different control rules, a division line 51, is drawn (S12). The drawing color of the dividing line 51 is different from the filling color described later.

【0037】分割線51で分割された各領域について、
図5(c)に示すように、領域内の任意の点53を指定
し(S13)、図5(d)に示すように、その領域にお
ける制御則を表わす色で塗りつぶす(S14)。なお、
図5(c)の位置は、工作機械B43と壁の間及び防火
シャッタ44と壁の間を通り抜けるので、狭い場所を通
り抜けることになり、ロボットを制御するときの制約ご
とがあてはまる。従って、マニピュレータ動作不可領
域46となり、このマニピュレータ動作不可領域46に
適用される制御則の色で塗りつぶされる。
For each area divided by the dividing line 51,
As shown in FIG. 5 (c), an arbitrary point 53 in the area is designated (S13), and as shown in FIG. 5 (d), the area is painted out with a color representing a control rule in the area (S14). In addition,
Since the position shown in FIG. 5C passes between the machine tool B43 and the wall and between the fireproof shutter 44 and the wall, the position passes through a narrow place, and the restrictions when controlling the robot apply. Therefore, a manipulator inoperable area 46 is formed, and the area is painted with the color of the control rule applied to the manipulator inoperable area 46.

【0038】制御則を表わす色は、制御則と1対1で対
応した色で、特に図示していない制御則−色対応表に照
らし合せて変換する。また、塗りつぶしは、一般的なビ
デオメモリ上での塗りつぶしと同じ方式なのでここでは
説明を省略する。この塗りつぶしの処理を行なうことに
よって、各領域内の点に対応する配列のデータが、制御
則の番号となる。
The colors representing the control rules correspond to the control rules on a one-to-one basis, and are converted by referring to a control rule-color correspondence table (not shown). The method of filling is the same as the method of filling on a general video memory, and the description is omitted here. By performing the filling process, the data in the array corresponding to the points in each area becomes the control rule number.

【0039】なお、塗りつぶしの境界は以下のように定
める。 ・分割線51まで(分割線51を含む)。 ・描画領域52の端まで(端を含む)。 ・上記以外で、その点に対応する配列のデータが制約な
しを表わすものでない点まで(その点は含まない)。
Note that the boundary of the filling is determined as follows. -Up to the dividing line 51 (including the dividing line 51). -To the end of the drawing area 52 (including the end). Other than the above, up to a point where the data of the array corresponding to the point does not indicate no restriction (the point is not included).

【0040】そして、描画領域52内の各点毎に色を制
御則番号に変換し、作業場所41に対応する制御則デー
タ配列に読み込むことで地図情報が作成できる(S1
5)。本発明の実施形態の移動ロボット29の制御装置
1の全体動作の説明に戻る。
Then, map information can be created by converting a color into a control law number for each point in the drawing area 52 and reading it into a control law data array corresponding to the work place 41 (S1).
5). The description returns to the overall operation of the control device 1 of the mobile robot 29 according to the embodiment of the present invention.

【0041】つぎに、移動ロボット29の走行現在位置
情報と操縦部9からの動作命令とから、つぎに移動ロボ
ット29が進入する位置である指令位置を求める(S
3)。そして、ステップS3の処理によって求められた
指令位置における制御則を読み出す。
Next, from the information on the current traveling position of the mobile robot 29 and the operation command from the control unit 9, a commanded position which is a position at which the mobile robot 29 enters next is obtained (S).
3). Then, the control law at the command position obtained by the processing in step S3 is read.

【0042】制御則の読み出し処理の詳細について図6
及び図7を参照しながら説明する。図6は、制御則読出
処理のフローチャートであり、図7は、地図情報からの
制御則の読み出しを示す図である。
FIG. 6 shows details of the control rule readout process.
This will be described with reference to FIG. FIG. 6 is a flowchart of the control rule reading process, and FIG. 7 is a diagram illustrating reading of the control rule from the map information.

【0043】まず、制御則読出処理部25が、走行制御
部24からの指令位置情報をY軸指令位置情報とX軸指
令位置情報とに分解し(S21)、Y軸指令位置情報及
びX軸指令位置情報の座標位置を表わす整数の値(以
下、添え字という)への変換を、Y軸指令位置情報のY
軸指令位置の最大値に対するY軸指令位置情報のY軸指
令位置の値の比に対応する制御則データ配列62のY軸
の値をY軸指令位置の座標値jyとして求め、また、X
軸指令位置情報のX軸指令位置の最大値に対するX軸指
令位置情報のX軸指令位置の値の比に対応する制御則デ
ータ配列62のX軸の値をX軸指令位置の座標値ixと
して求め、整数化(四捨五入、切り捨て等)することで
行なう(S22)。
First, the control law readout processing section 25 decomposes command position information from the traveling control section 24 into Y-axis command position information and X-axis command position information (S21), and reads the Y-axis command position information and the X-axis command information. The conversion of the command position information into an integer value representing the coordinate position (hereinafter referred to as a suffix) is performed by converting the Y-axis command position information into a Y value.
The Y-axis value of the control law data array 62 corresponding to the ratio of the value of the Y-axis command position of the Y-axis command position information to the maximum value of the axis command position is obtained as the coordinate value yy of the Y-axis command position.
The value of the X axis of the control law data array 62 corresponding to the ratio of the value of the X axis command position of the X axis command position information to the maximum value of the X axis command position of the axis command position information is defined as the coordinate value ix of the X axis command position. It is determined and converted to an integer (rounded off, rounded down, etc.) (S22).

【0044】ステップS22の処理によって求めた添え
字に対応する座標Dij63より、その座標の制御則を
表わす制御則番号を地図情報記憶部26より制御則読出
処理部25に読み込む(S23)。
From the coordinates Dij63 corresponding to the suffix obtained by the processing in step S22, the control law number representing the control law of the coordinates is read from the map information storage unit 26 into the control law reading processing unit 25 (S23).

【0045】その制御則番号を番号−制御則対応表64
と照らし合せて制御則番号に対応する制御則の制御パラ
メータを求める。なお、番号−制御則対応表64は、制
御則番号と対応する制御パラメータの列とを要素とする
表である。
The control law number is represented by a number-control law correspondence table 64.
Then, a control parameter of a control law corresponding to the control law number is obtained. The number-control law correspondence table 64 is a table having the control law numbers and the corresponding control parameter columns as elements.

【0046】ここで、制御則番号と制御則の制御パラメ
ータの対応を表わした番号−制御パラメータ対応表の一
例を図8に示す。制御パラメータは、マニピュレータ制
御パラメータ、走行制御パラメータ、及びインターロッ
ク種類等がある。
FIG. 8 shows an example of a number-control parameter correspondence table showing the correspondence between the control law numbers and the control parameters of the control law. The control parameters include manipulator control parameters, travel control parameters, and interlock types.

【0047】マニピュレータ制御パラメータは、マニピ
ュレータ制御処理部27に転送され、マニピュレータ7
の動作を制御するパラメータであり、動作可/不可フラ
グ及びマニピュレータ動作範囲がある。
The manipulator control parameters are transferred to the manipulator control processing section 27 and the manipulator 7
, And includes an operation enable / disable flag and a manipulator operation range.

【0048】走行制御パラメータは、走行制御部24に
転送され、走行駆動部6の動作を制御するパラメータで
あり、走行可/不可フラグ、操作可/不可フラグ及び最
高速度がある。
The travel control parameters are transferred to the travel control unit 24 and control the operation of the travel drive unit 6, and include a travel enable / disable flag, an operation enable / disable flag, and a maximum speed.

【0049】インターロック種類は、インターロック処
理部28に転送され、インターロックがあるならば、マ
ニピュレータ制御処理部27の動作を禁止し、また、マ
ニピュレータ7の現在状態に基づいて、走行禁止命令を
走行制御部24に転送し、走行駆動部6を停止する。
The type of the interlock is transferred to the interlock processing unit 28. If there is an interlock, the operation of the manipulator control processing unit 27 is prohibited, and based on the current state of the manipulator 7, a travel prohibition command is issued. The data is transferred to the travel control unit 24, and the travel drive unit 6 is stopped.

【0050】本発明の実施形態の移動ロボット29の制
御装置1の全体動作の説明に戻る。つぎに、制御則読出
処理部25から転送されたマニピュレータ制御パラメー
タ、走行制御パラメータ、及びインターロック種類に基
づき、マニピュレータ7及び走行駆動部6の動作を制御
する(S5)。マニピュレータ7及び走行駆動部6の動
作の制御処理について図9から図11を参照しながら説
明する。
Returning to the description of the overall operation of the control device 1 of the mobile robot 29 according to the embodiment of the present invention. Next, the operations of the manipulator 7 and the traveling drive unit 6 are controlled based on the manipulator control parameters, traveling control parameters, and interlock types transferred from the control law read processing unit 25 (S5). The control processing of the operations of the manipulator 7 and the traveling drive unit 6 will be described with reference to FIGS.

【0051】マニピュレータ7及び走行駆動部6の動作
の制御の一例として制御処理を行なうにあたって、以下
のような動作上の制約を制御則として持つものとして説
明する。 (A)場所により、マニピュレータ7の動作を禁止す
る。また、マニピュレータ7が伸びたままで、その場所
に進入することを禁止する(マニピュレータ動作不可領
域46)。 (B)場所により、移動ロボット29の走行速度を制限
する(低速走行領域45)。 (C)場所により、移動ロボット29のマニピュレータ
7の動作範囲を制限する(マニピュレータ縮退運転領
域)。 (D)場所により、移動ロボット29の進入を禁止する
(進入禁止領域)。 (E)場所により、移動ロボット29の動作命令による
停止を禁止し、その場で操作を禁止する(操作禁止領
域)。
As an example of the control of the operation of the manipulator 7 and the traveling drive unit 6, a description will be given on the assumption that the following operational restrictions are used as control rules in performing control processing. (A) The operation of the manipulator 7 is prohibited in some places. In addition, the manipulator 7 is prohibited from entering the place while being extended (the manipulator inoperable area 46). (B) The traveling speed of the mobile robot 29 is restricted depending on the location (low-speed traveling area 45). (C) The operating range of the manipulator 7 of the mobile robot 29 is limited depending on the place (manipulator degenerate operation area). (D) The entry of the mobile robot 29 is prohibited depending on the location (entry prohibited area). (E) Depending on the location, the stopping of the mobile robot 29 by the operation command is prohibited, and the operation is prohibited on the spot (operation prohibited area).

【0052】前記制御則を実現するするには、以下のよ
うに制御パラメータを設定することで実現できる。 (a)マニピュレータ動作不可領域46 インターロック種類をインターロック有りとする。 (b)低速走行領域45 走行制御パラメータの最高速度を低く設定する。 (c)マニピュレータ縮退運転領域 マニピュレータ制御パラメータでマニピュレータ動作範
囲を狭く設定する。 (d)進入禁止領域 走行制御パラメータで走行不可とする。 (e)操作禁止領域 マニピュレータ制御パラメータの動作制御パラメータを
動作不可、走行制御パラメータの操作制御パラメータを
操作不可とする。
The above control law can be realized by setting control parameters as follows. (A) Manipulator inoperable area 46 The interlock type is set to interlock. (B) Low-speed running area 45 The maximum speed of the running control parameters is set low. (C) Manipulator degenerate operation area The manipulator operation range is set narrow by manipulator control parameters. (D) Entry prohibited area The travel is prohibited by the travel control parameter. (E) Operation prohibition area The operation control parameter of the manipulator control parameter is disabled, and the operation control parameter of the traveling control parameter is disabled.

【0053】まず、マニピュレータ制御パラメータに基
づくマニピュレータ7の制御処理について、図9のマニ
ピュレータ制御パラメータに基づくマニピュレータ7の
制御処理のフローチャートを参照しながら説明する。
First, the control processing of the manipulator 7 based on the manipulator control parameters will be described with reference to the flowchart of the control processing of the manipulator 7 based on the manipulator control parameters in FIG.

【0054】まず、マニピュレータ7の動作命令がある
か否か判断する(S31)。マニピュレータ7の動作命
令があれば(YES)、動作可/不可フラグが“1”か
否かを判断する(S32)。
First, it is determined whether or not there is an operation command for the manipulator 7 (S31). If there is an operation command for the manipulator 7 (YES), it is determined whether or not the operation enable / disable flag is "1" (S32).

【0055】マニピュレータ7の動作命令がないならば
(NO)、マニピュレータ7の動作を停止する(S3
5)。動作可/不可フラグが“1”か否かを判断し(S
32)、動作可/不可フラグが“1”でマニピュレータ
7が動作可ならば、つぎに、インターロックによるマニ
ピュレータ7の動作禁止命令があるか判断する(S3
3)。
If there is no operation command for the manipulator 7 (NO), the operation of the manipulator 7 is stopped (S3).
5). It is determined whether the operation enable / disable flag is “1” (S
32) If the operation enable / disable flag is "1" and the manipulator 7 is operable, then it is determined whether or not there is a command to inhibit the operation of the manipulator 7 due to the interlock (S3).
3).

【0056】移動ロボット29の指令位置が操作禁止領
域以外ならば、動作可/不可フラグが“1”(動作可)
となる(YES)。移動ロボット29の指令位置が操作
禁止領域ならば、動作可/不可フラグが“0”となり
(NO)、マニピュレータ7の動作命令に基づきマニピ
ュレータ7の動作を停止する(S35)。
If the command position of the mobile robot 29 is outside the operation prohibited area, the operation enable / disable flag is set to "1" (operation enabled).
(YES). If the command position of the mobile robot 29 is in the operation prohibited area, the operation enable / disable flag is set to "0" (NO), and the operation of the manipulator 7 is stopped based on the operation command of the manipulator 7 (S35).

【0057】インターロックによるマニピュレータ7の
動作禁止命令があるか判断して(S33)、移動ロボッ
ト29の指令位置がマニピュレータ動作不可領域46で
ないならば、インターロックによるマニピュレータ7の
動作禁止命令はなく、マニピュレータ7の動作命令に基
づきマニピュレータ制御パラメータのマニピュレータ動
作範囲で指定された動作範囲内でマニピュレータ7を動
作する(S34)。なお、マニピュレータ動作範囲によ
ってマニピュレータ7の動作範囲が制限されていなけれ
ば、マニピュレータ7の動作命令に基づきマニピュレー
タ7を動作する(S34)。
It is determined whether there is a command to prohibit operation of the manipulator 7 due to the interlock (S33). If the command position of the mobile robot 29 is not in the manipulator inoperable area 46, there is no command to prohibit operation of the manipulator 7 due to the interlock. The manipulator 7 is operated within the operation range specified by the manipulator operation range of the manipulator control parameter based on the operation command of the manipulator 7 (S34). If the operation range of the manipulator 7 is not limited by the operation range of the manipulator, the manipulator 7 is operated based on the operation command of the manipulator 7 (S34).

【0058】移動ロボット29の指令位置がマニピュレ
ータ動作不可領域46ならば、インターロックによるマ
ニピュレータ7の動作禁止命令があり、動作禁止命令に
基づきマニピュレータ7の動作を停止する(S35)。
If the command position of the mobile robot 29 is the manipulator inoperable area 46, there is a command to prohibit the operation of the manipulator 7 by an interlock, and the operation of the manipulator 7 is stopped based on the command to prohibit the operation (S35).

【0059】以上の処理により、移動ロボット29の指
令位置が操作禁止領域以外ならば、マニピュレータ7の
動作命令に基づきマニピュレータ制御パラメータのマニ
ピュレータ動作範囲で指定された動作範囲内でマニピュ
レータ7を動作でき、移動ロボット29の指令位置が操
作禁止領域ならば、マニピュレータ7の動作命令に基づ
くマニピュレータ7の動作を禁止するというようにマニ
ピュレータ7の動作を制御できる。また、移動ロボット
29の指令位置がマニピュレータ動作不可領域46なら
ば、インターロックによるマニピュレータ7の動作禁止
命令に基づきマニピュレータ7の動作を停止するという
ようにマニピュレータ7の動作を制御できる。
With the above processing, if the command position of the mobile robot 29 is outside the operation prohibited area, the manipulator 7 can be operated within the operation range specified by the manipulator operation range of the manipulator control parameter based on the operation command of the manipulator 7. If the command position of the mobile robot 29 is in the operation prohibited area, the operation of the manipulator 7 can be controlled such that the operation of the manipulator 7 based on the operation command of the manipulator 7 is prohibited. If the command position of the mobile robot 29 is the manipulator inoperable area 46, the operation of the manipulator 7 can be controlled such that the operation of the manipulator 7 is stopped based on the operation prohibition command of the manipulator 7 by the interlock.

【0060】つぎに、走行制御パラメータに基づく走行
駆動部7の制御処理について、図10の走行制御パラメ
ータに基づく走行駆動部7の制御処理のフローチャート
を参照しながら説明する。
Next, a control process of the traveling drive unit 7 based on the traveling control parameters will be described with reference to a flowchart of a control process of the traveling drive unit 7 based on the traveling control parameters in FIG.

【0061】まず、移動ロボット29の指令位置が操作
禁止領域であり、その場の操作が禁止か否かを判断する
ために、操作可/不可フラグが“1”か否かを判断する
(S41)。
First, in order to determine whether or not the command position of the mobile robot 29 is in the operation prohibited area, and whether or not the operation on the spot is prohibited, it is determined whether or not the operation enable / disable flag is "1" (S41). ).

【0062】移動ロボット29の指令位置が操作禁止領
域ならば、操作可/不可フラグが“0”(操作不可)と
なり、その場で操作を禁止する(S43)。移動ロボッ
ト29の指令位置が操作禁止領域でないならば、操作可
/不可フラグが“1”(操作可)となり、操縦部9から
の動作命令に基づき走行が可能なので、操縦部9からの
動作命令が停止か否かを判断する(S42)。
If the command position of the mobile robot 29 is in the operation prohibited area, the operation enabled / disabled flag is set to "0" (operation disabled), and the operation is prohibited on the spot (S43). If the command position of the mobile robot 29 is not in the operation prohibited area, the operation possible / impossible flag becomes “1” (operable), and the vehicle can travel based on the operation command from the control unit 9. Is determined to be stopped (S42).

【0063】動作命令が停止ならば(YES)、作業員
21が意図的に操縦部9を操作して移動ロボット29を
停止させたので動作命令に従い走行駆動部6を停止して
移動ロボット29を停止する(S48)。
If the operation command is stopped (YES), since the worker 21 intentionally operated the control unit 9 to stop the mobile robot 29, the traveling drive unit 6 is stopped according to the operation command and the mobile robot 29 is stopped. The operation stops (S48).

【0064】動作命令が走行ならば(NO)、動作命令
及び走行制御パラメータに基づき走行駆動部6を駆動さ
せる前に、走行可か否かを判断する(S44)。移動ロ
ボット29の指令位置が進入禁止領域ならば、走行可/
不可フラグが“0”(走行不可)となり、走行駆動部6
を停止して移動ロボット29を停止する(S48)。
If the operation command is traveling (NO), it is determined whether or not traveling is possible before driving the traveling drive unit 6 based on the operation command and traveling control parameters (S44). If the command position of the mobile robot 29 is in the no-go area, traveling is possible /
The refusal flag becomes “0” (prohibition of traveling), and the traveling drive unit 6
Is stopped to stop the mobile robot 29 (S48).

【0065】移動ロボット29の指令位置が進入禁止領
域でないならば、走行可/不可フラグが“1”(走行
可)となり、操縦部9からの動作命令に基づき走行が可
能なので、動作命令及び走行制御パラメータに基づき走
行駆動部6を駆動させる前に、更に、インターロックに
よる走行停止があるか否かを判断する(S45)。
If the command position of the mobile robot 29 is not in the entry-prohibited area, the travel permission / prohibition flag becomes “1” (travel permission), and the vehicle can travel based on the operation command from the control unit 9. Before driving the traveling drive unit 6 based on the control parameters, it is further determined whether or not traveling is stopped by an interlock (S45).

【0066】インターロックによる走行停止命令がある
のならば(YES)、走行駆動部6を停止して移動ロボ
ット29を停止する(S48)。インターロックによる
走行停止命令がないならば(NO)、走行制御パラメー
タの走行最高速度を確認し(S46)、操縦部9からの
動作命令に基づき走行最高速度以内で走行する(S4
7)。
If there is a traveling stop command by the interlock (YES), the traveling drive unit 6 is stopped and the mobile robot 29 is stopped (S48). If there is no travel stop command due to the interlock (NO), the travel maximum speed of the travel control parameter is checked (S46), and the vehicle travels within the travel maximum speed based on the operation command from the control unit 9 (S4).
7).

【0067】なお、インターロックによる走行停止命令
は、移動ロボット29の指令位置がマニピュレータ動作
不可領域46に位置し、マニピュレータ7が伸びた状態
のときにインターロック処理部28より走行制御部24
に転送される。
It should be noted that the traveling stop command by the interlock is issued by the interlock processing unit 28 when the command position of the mobile robot 29 is located in the manipulator inoperable area 46 and the manipulator 7 is extended.
Is forwarded to

【0068】以上の処理により、移動ロボット29の指
令位置がマニピュレータ動作不可領域46に位置し、マ
ニピュレータ7が伸びた状態ならば、インターロックに
より走行を停止し、進入禁止領域ならば、走行可/不可
フラグを“0”として走行不可とし、操作禁止領域なら
ば、動作命令のあるときには、また、走行可/不可フラ
グが“1”(走行可)ならば、操作可/不可フラグを
“0”として操作を不可にすることができる。
According to the above processing, the command position of the mobile robot 29 is located in the manipulator inoperable area 46. If the manipulator 7 is in the extended state, the traveling is stopped by the interlock. When the operation instruction is present in the operation prohibition area, the operation permission / inhibition flag is set to “0” and the operation permission / inhibition flag is set to “0”. The operation can be disabled.

【0069】つぎに、前記マニピュレータ制御パラメー
タに基づくマニピュレータ制御処理部27の制御処理及
び前記走行制御パラメータに基づく走行駆動部7の制御
処理で適用されるインターロックについて説明する。
Next, the interlock applied in the control processing of the manipulator control processing section 27 based on the manipulator control parameters and the control processing of the travel drive section 7 based on the travel control parameters will be described.

【0070】インターロックの詳細について図11のイ
ンターロック種類に基づくインターロック処理部28の
インターロック処理のフローチャートを参照しながら説
明する。
The details of the interlock will be described with reference to the flowchart of the interlock process of the interlock processing unit 28 based on the interlock type shown in FIG.

【0071】インターロックは、制御パラメータのイン
ターロック種類のインターロックであることを示すフラ
グであるインターロックフラグが“1”か否かを判断し
て(S51)、移動ロボット29の指令位置がマニピュ
レータ動作不可領域46に位置するならば、インターロ
ックフラグが“1”となり(YES)、マニピュレータ
制御処理部27にマニピュレータ動作禁止命令を転送す
る(S52)。
The interlock determines whether or not an interlock flag, which is a flag indicating the type of interlock of the interlock type in the control parameters, is "1" (S51), and the command position of the mobile robot 29 is changed to the manipulator. If it is located in the inoperable area 46, the interlock flag is set to "1" (YES), and a manipulator operation prohibition command is transferred to the manipulator control processing unit 27 (S52).

【0072】更に、インターロックフラグが“1”なら
ば、マニピュレータ7が伸びたままか否かを判断して
(S53)、マニピュレータ7が伸びたままならば(Y
ES)、走行禁止命令を走行制御部24に転送する(S
54)。
Further, if the interlock flag is "1", it is determined whether or not the manipulator 7 has been extended (S53), and if the manipulator 7 has been extended (Y
ES), and transmits the travel prohibition command to the travel control unit 24 (S
54).

【0073】以上の処理により、移動ロボット29の指
令位置がマニピュレータ動作不可領域46に位置するな
らば、マニピュレータ7の動作命令があっても、インタ
ーロックによりマニピュレータ動作禁止命令がマニピュ
レータ制御処理部27に転送され、マニピュレータ7の
動作を禁止することができる。また、マニピュレータ7
が伸びたままマニピュレータ動作不可領域46に進入し
ようとしても、インターロックにより走行禁止命令が走
行制御部24に転送され、その位置で停止することがで
きる。
According to the above processing, if the command position of the mobile robot 29 is located in the manipulator inoperable area 46, the manipulator operation prohibition command is sent to the manipulator control processor 27 by the interlock even if the manipulator 7 is operated. The operation is transferred and the operation of the manipulator 7 can be prohibited. In addition, the manipulator 7
Even if the user tries to enter the manipulator inoperable area 46 with the extension, the travel prohibition command is transferred to the travel control unit 24 by the interlock, and the vehicle can be stopped at that position.

【0074】以上のように、移動ロボット29の指令位
置及びマニピュレータ7の状態に応じて、読み出した制
御則に基づきマニピュレータ7及び走行駆動部6を制御
することができ、移動ロボット29の移動を制御するこ
とができる。
As described above, according to the command position of the mobile robot 29 and the state of the manipulator 7, the manipulator 7 and the traveling drive unit 6 can be controlled based on the read control rules, and the movement of the mobile robot 29 can be controlled. can do.

【0075】したがって、地図情報61を移動ロボット
29の作業場所41に合わせて作成すれば、その作成し
た地図情報61より移動ロボット29の指令位置の制御
則を読み出すことができ、その制御則に基づき、移動ロ
ボット29を制御することができるので、制御則の読み
出し時間が変らず、従来のように、特別な処理を行なう
ために、処理時間が長くなり、常時制御則を移動ロボッ
ト29に適用するための読み出し速度が得にくいという
ことがない。
Therefore, if the map information 61 is created in accordance with the work place 41 of the mobile robot 29, the control rule for the command position of the mobile robot 29 can be read from the created map information 61, and based on the control rule. Since the mobile robot 29 can be controlled, the read time of the control rule does not change, and the processing time becomes longer to perform a special process as in the related art, and the control rule is always applied to the mobile robot 29. Reading speed is not difficult to obtain.

【0076】また、地図情報61を作成すれば、複数の
作業場所41に対応する移動ロボット29を実現でき
る。なお、本発明は、図2に示したような移動ロボット
に限られるだけでなく、マニピュレータが複数ある移動
ロボット、ケーブル等によって動作命令を伝送する移動
ロボット等に適用してもよい。
Further, if the map information 61 is created, the mobile robot 29 corresponding to a plurality of work places 41 can be realized. The present invention is not limited to the mobile robot shown in FIG. 2, but may be applied to a mobile robot having a plurality of manipulators, a mobile robot transmitting an operation command through a cable, or the like.

【0077】また、本発明の実施形態において、記録媒
体2aとしては、図12に示すように、例えば、CD−
ROMディスクや、フロッピーディスク、更には特に図
示していないMOディスク、DVD−ROMディスク、
或いはリムーバルディスク等の可搬記憶媒体76や、C
PU2を含むコンピュータ71からネットワーク回線7
5を介して接続されるプログラムサーバ73の記憶装置
74や、或いはコンピュータ71自身が有する記憶装置
72(RAMやハードディスク)が含まれる。
In the embodiment of the present invention, as the recording medium 2a, for example, as shown in FIG.
ROM disk, floppy disk, and MO disk, DVD-ROM disk (not shown),
Alternatively, a portable storage medium 76 such as a removable disk,
Network line 7 from computer 71 including PU2
5 includes a storage device 74 of a program server 73 connected via the storage device 5 or a storage device 72 (RAM or hard disk) of the computer 71 itself.

【0078】[0078]

【発明の効果】以上、説明したように、本実施形態によ
れば、所定の領域毎に移動に関する制御則を記述した地
図情報を作成し、移動ロボットが移動しているときに、
移動ロボットの現在走行位置と移動ロボットに対する動
作命令より指令位置を生成し、その指令位置に対応する
地図情報の位置の制御則を読み出して、操作部からの動
作命令及び制御則に基づき移動ロボットの移動が制御さ
れるので、制御則を記述した地図情報を作成さえすれ
ば、特別な処理を行うことなく複数の作業場所における
移動ロボットの移動則を求めることができる。
As described above, according to the present embodiment, map information describing a control rule for movement is created for each predetermined area, and when the mobile robot is moving,
A command position is generated from the current running position of the mobile robot and an operation command for the mobile robot, a control rule for the position of the map information corresponding to the command position is read, and the mobile robot is controlled based on the operation command and control rule from the operation unit. Since the movement is controlled, it is possible to obtain the movement rules of the mobile robot at a plurality of work places without performing special processing, only by creating map information describing the control rules.

【0079】また、作業場所が変っても、移動ロボット
の移動に関する制御則を求める処理は変らないので、処
理時間が長くなり、読み出し速度が遅くなることがな
く、十分な読み出し速度を得ることができる。
Further, even if the work place changes, the processing for obtaining the control law relating to the movement of the mobile robot does not change, so that the processing time becomes longer and the reading speed does not decrease, and a sufficient reading speed can be obtained. it can.

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

【図1】本発明に係わる実施形態の回路構成を示すブロ
ック図である。
FIG. 1 is a block diagram showing a circuit configuration of an embodiment according to the present invention.

【図2】本発明の移動ロボットの制御装置の全体構成を
示す図である。
FIG. 2 is a diagram showing an overall configuration of a control device for a mobile robot according to the present invention.

【図3】本発明の移動ロボット制御処理を説明するフロ
ーチャートである。
FIG. 3 is a flowchart illustrating a mobile robot control process according to the present invention.

【図4】本発明の地図情報作成処理を説明するフローチ
ャートである。
FIG. 4 is a flowchart illustrating a map information creation process according to the present invention.

【図5】地図情報の作成手順を示す図である。FIG. 5 is a diagram showing a procedure for creating map information.

【図6】本発明の制御則読出処理を説明するフローチャ
ートである。
FIG. 6 is a flowchart illustrating a control law reading process according to the present invention.

【図7】地図情報からの制御則の読み出しを示す図であ
る。
FIG. 7 is a diagram showing reading of a control law from map information.

【図8】番号−制御則パラメータ対応表の一例を示す図
である。
FIG. 8 is a diagram showing an example of a number-control law parameter correspondence table.

【図9】本発明のマニピュレータ制御パラメータに基づ
くマニピュレータの制御処理を説明するフローチャート
である。
FIG. 9 is a flowchart illustrating a manipulator control process based on manipulator control parameters according to the present invention.

【図10】本発明の走行制御パラメータに基づく走行制
御部の制御処理を説明するフローチャートである。
FIG. 10 is a flowchart illustrating a control process of a traveling control unit based on traveling control parameters according to the present invention.

【図11】本発明のインターロック種類に基づくインタ
ーロック処理を説明するフローチャートである。
FIG. 11 is a flowchart illustrating an interlock process based on an interlock type according to the present invention.

【図12】本発明のコンピュータが読み取り可能な記録
媒体の例を示す図である。
FIG. 12 is a diagram showing an example of a computer-readable recording medium of the present invention.

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

1 制御装置 2 CPU 2a 記録媒体 3 VRAM 4 RAM 5 ROM 6 走行駆動部 7 マニピュレータ 8 モニタカメラ 9 操縦部 10 モニタテレビ 21 作業員 22 無線機 23 無線機 24 走行制御部 25 制御則読出処理部 26 地図情報記憶部 27 マニピュレータ制御処理部 28 インターロック処理部 29 移動ロボット 41 作業場所 42 工作機械A 43 工作機械B 44 防火シャッタ 45 低速走行領域 46 マニピュレータ動作不可領域 47 進入不可領域 48 ドア 49 矢印 50 矢印 51 分割線 52 描画領域 53 任意の点 61 地図情報 62 制御則データ配列 63 座標Dij 64 番号−制御則対応表 71 コンピュータ 72 記憶装置 73 プログラムサーバ 74 記憶装置 75 ネットワーク回線 76 可搬記録媒体 Reference Signs List 1 control device 2 CPU 2a recording medium 3 VRAM 4 RAM 5 ROM 6 traveling drive unit 7 manipulator 8 monitor camera 9 operation unit 10 monitor television 21 worker 22 wireless device 23 wireless device 24 travel control unit 25 control rule read processing unit 26 map Information storage unit 27 Manipulator control processing unit 28 Interlock processing unit 29 Mobile robot 41 Working place 42 Machine tool A 43 Machine tool B 44 Fireproof shutter 45 Low-speed running area 46 Manipulator inoperable area 47 Inaccessible area 48 Door 49 Arrow 50 Arrow 51 Division line 52 Drawing area 53 Arbitrary point 61 Map information 62 Control law data array 63 Coordinate Dij 64 Number-control law correspondence table 71 Computer 72 Storage device 73 Program server 74 Storage device 75 Network line 76 Portable recording medium body

Claims (15)

【特許請求の範囲】[Claims] 【請求項1】 所定の領域毎に移動ロボットの移動に関
する制御則を記述した地図情報を作成し、 移動ロボットの走行現在位置と移動ロボットに対する動
作命令から移動ロボットが次に移動する位置である指令
位置を生成し、前記地図情報より該指令位置に対応する
位置の制御則を読み出し、 操縦部からの動作命令及び前記読み出した制御則に基づ
いて移動ロボットの移動を制御する、 ことを特徴とする移動ロボットの制御方法。
1. A map information that describes a control rule relating to movement of a mobile robot is created for each predetermined area, and a command indicating a position to which the mobile robot moves next is obtained from a current travel position of the mobile robot and an operation command for the mobile robot. Generating a position, reading a control rule of a position corresponding to the command position from the map information, and controlling movement of the mobile robot based on an operation command from a control unit and the read control rule. How to control a mobile robot.
【請求項2】 前記地図情報は、描画領域が作業場所全
体に対応し、描画領域を構成している複数の画素が制御
則と1対1で対応する制御則番号の2次元配列である制
御則データ配列であることを特徴とする請求項1記載の
移動ロボットの制御方法。
2. The map information according to claim 1, wherein the drawing area corresponds to the entire work place, and a plurality of pixels forming the drawing area are a two-dimensional array of control law numbers corresponding one-to-one with the control law. 2. The control method for a mobile robot according to claim 1, wherein the control data is a law data array.
【請求項3】 前記地図情報を作成するときに、前記描
画領域を制御則の異なる領域毎に分割する分割線を引い
て前記描画領域を制御則の異なる領域毎に分割すること
を特徴とする請求項2記載の移動ロボットの制御方法。
3. The method according to claim 2, wherein, when creating the map information, the drawing area is divided into regions having different control rules by dividing the drawing region into regions having different control rules. The method for controlling a mobile robot according to claim 2.
【請求項4】 前記地図情報を作成するときに、分割線
によって分割された前記地図情報を制御則毎に異なる色
で領域を塗りつぶすことを特徴とする請求項3記載の移
動ロボットの制御方法。
4. The control method for a mobile robot according to claim 3, wherein, when creating the map information, the map information divided by a dividing line is filled with an area in a different color for each control rule.
【請求項5】 前記各画素の色を制御則と1対1で対応
する制御則番号に変換して制御則データ配列に読み込む
ことで前記地図情報を作成することを特徴とする請求項
4記載の移動ロボットの制御方法。
5. The map information is created by converting the color of each pixel into a control rule number corresponding to a control rule on a one-to-one basis and reading the control rule number into a control rule data array. Mobile robot control method.
【請求項6】 前記指令位置をX軸及びY軸の座標に分
解し、更にX軸指令位置及びY軸指令位置とにそれぞれ
分解し、X−Y座標系上の座標を求めて制御則データ配
列の対応する座標の制御則番号を読み出すことを特徴と
する請求項2記載の移動ロボットの制御方法。
6. The control law data is decomposed into X-axis and Y-axis coordinates, further decomposed into an X-axis command position and a Y-axis command position, and coordinates on an XY coordinate system are obtained. 3. The control method for a mobile robot according to claim 2, wherein a control law number of a corresponding coordinate in the array is read.
【請求項7】 制御則番号と制御則番号に対応する制御
則の対応関係を表わした番号制御則対応表を有し、読み
出した前記制御則番号を該番号制御則対応表と照らし合
せることで前記制御則を求めることを特徴とする請求項
2記載の移動ロボットの制御方法。
7. A number control law correspondence table showing a correspondence relation between a control law number and a control law corresponding to the control law number, and the read out control law number is compared with the number control law correspondence table. The control method for a mobile robot according to claim 2, wherein the control rule is obtained.
【請求項8】 所定の領域毎に移動ロボットの移動に関
する制御則を記述した地図情報を作成する地図情報作成
手段と、 移動ロボットの走行現在位置と移動ロボットに対する動
作命令から移動ロボットが次に移動する位置である指令
位置を生成し、前記地図情報より該指令位置に対応する
位置の制御則を読み出す制御則読出手段と、 操縦部からの動作命令及び前記制御則読出手段によって
読み出した制御則に基づいて移動ロボットの移動を制御
する移動ロボット制御手段と、 を有することを特徴とする移動ロボットの制御装置。
8. A map information creating means for creating map information describing a control rule relating to the movement of the mobile robot for each predetermined area, and the mobile robot moves next based on the current running position of the mobile robot and an operation command for the mobile robot. A control rule reading unit that generates a command position that is a position to perform, and reads a control rule of a position corresponding to the command position from the map information; A control device for a mobile robot, comprising: mobile robot control means for controlling movement of the mobile robot based on the mobile robot control device.
【請求項9】 前記地図情報は、描画領域が作業場所全
体に対応し、描画領域を構成している複数の画素が制御
則と1対1で対応する制御則番号の2次元配列である制
御則データ配列となっていることを特徴とする請求項8
記載の移動ロボットの制御装置。
9. The map information, wherein a drawing area corresponds to the whole work place, and a plurality of pixels constituting the drawing area are a two-dimensional array of control law numbers corresponding one-to-one with control laws. 9. A law data array.
The control device of the mobile robot according to the above.
【請求項10】 前記地図情報作成手段は、前記描画領
域を制御則の異なる領域毎に分割する分割線を引いて前
記描画領域を制御則の異なる領域毎に分割することを特
徴とする請求項9記載の移動ロボットの制御装置。
10. The map information creating means divides the drawing region into regions having different control rules by drawing a dividing line for dividing the drawing region into regions having different control rules. 10. The control device for a mobile robot according to claim 9.
【請求項11】 前記地図情報作成手段は、分割線によ
って分割された前記地図情報を制御則毎に異なる色で領
域の塗りつぶしを行なうことを特徴とする請求項10記
載の移動ロボットの制御装置。
11. The control device for a mobile robot according to claim 10, wherein said map information creating means fills an area of the map information divided by a dividing line with a different color for each control rule.
【請求項12】 前記地図情報作成手段は、前記各画素
の色を制御則と1対1で対応する制御則番号に変換して
制御則データ配列に読み込むことで前記地図情報を作成
することを特徴とする請求項11記載の移動ロボットの
制御装置。
12. The map information creating means creates the map information by converting the color of each pixel into a control law number corresponding to a control law on a one-to-one basis and reading the converted control law data array. The control device for a mobile robot according to claim 11, wherein:
【請求項13】 前記制御則読出手段は、前記指令位置
をX軸及びY軸の座標に分解し、更にX軸指令位置及び
Y軸指令位置とにそれぞれ分解し、X−Y座標系上の座
標を求めて制御則データ配列の前記制御則番号を読み出
すことを特徴とする請求項9記載の移動ロボットの制御
装置。
13. The control law reading means decomposes the command position into X-axis and Y-axis coordinates, and further decomposes the command position into an X-axis command position and a Y-axis command position. 10. The control device for a mobile robot according to claim 9, wherein coordinates are obtained and the control law number in a control law data array is read.
【請求項14】 前記制御則読出手段は、制御則番号と
制御則番号に対応する制御則の対応関係を表わした番号
制御則対応表を有し、読み出した前記制御則番号を該番
号制御則対応表と照らし合せることで前記制御則を求め
ることを特徴とする請求項9記載の移動ロボットの制御
装置。
14. The control law reading means has a number control law correspondence table showing a correspondence relation between a control law number and a control law corresponding to the control law number, and reads the read control law number into the number control law. The control device for a mobile robot according to claim 9, wherein the control rule is obtained by comparing the control rule with a correspondence table.
【請求項15】 所定の領域毎に移動に関する制御則を
記述した地図情報を作成する機能と、 移動ロボットの走行現在位置と移動ロボットに対する動
作命令から移動ロボットが次に移動する位置である指令
位置を生成し、前記地図情報より該指令位置に対応する
位置の制御則を読み出す機能と、 操縦部からの動作命令及び前記読み出した制御則に基づ
いて移動ロボットの移動を制御する機能と、 を計算機に実行させるためのプログラムが前記計算機が
読取り可能な形式で記憶された記録媒体。
15. A function for creating map information describing a control rule relating to movement for each predetermined area, and a command position as a position to which the mobile robot moves next based on a current traveling position of the mobile robot and an operation command for the mobile robot. And a function of reading a control rule of a position corresponding to the commanded position from the map information, and a function of controlling movement of a mobile robot based on an operation command from a control unit and the read control rule. And a computer-readable storage medium storing a program for causing the computer to execute the program.
JP9338333A 1997-12-09 1997-12-09 Method and device for controlling moving robot and recording medium Withdrawn JPH11175151A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP9338333A JPH11175151A (en) 1997-12-09 1997-12-09 Method and device for controlling moving robot and recording medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP9338333A JPH11175151A (en) 1997-12-09 1997-12-09 Method and device for controlling moving robot and recording medium

Publications (1)

Publication Number Publication Date
JPH11175151A true JPH11175151A (en) 1999-07-02

Family

ID=18317172

Family Applications (1)

Application Number Title Priority Date Filing Date
JP9338333A Withdrawn JPH11175151A (en) 1997-12-09 1997-12-09 Method and device for controlling moving robot and recording medium

Country Status (1)

Country Link
JP (1) JPH11175151A (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2004018159A1 (en) * 2002-08-26 2004-03-04 Sony Corporation Environment identification device, environment identification method, and robot device
JP2004299025A (en) * 2003-04-01 2004-10-28 Honda Motor Co Ltd Mobile robot control device, mobile robot control method and mobile robot control program
JP2008021023A (en) * 2006-07-11 2008-01-31 Fujitsu Ltd Mobile robot device and mobile robot control method

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2004018159A1 (en) * 2002-08-26 2004-03-04 Sony Corporation Environment identification device, environment identification method, and robot device
JP2004299025A (en) * 2003-04-01 2004-10-28 Honda Motor Co Ltd Mobile robot control device, mobile robot control method and mobile robot control program
US7551980B2 (en) 2003-04-01 2009-06-23 Honda Motor Co., Ltd. Apparatus, process, and program for controlling movable robot control
JP2008021023A (en) * 2006-07-11 2008-01-31 Fujitsu Ltd Mobile robot device and mobile robot control method

Similar Documents

Publication Publication Date Title
JP5855469B2 (en) Carry-in route planning system
JP3574170B2 (en) Distributed image processing device
US4979128A (en) Method of deciding robot layout
JP2011524520A (en) Method for defining a safety zone of a laser processing system
JPH1124735A (en) Plant operation support system
JPH11175151A (en) Method and device for controlling moving robot and recording medium
US5617520A (en) Three-dimensional pattern editing apparatus having moving distance calculator and/or a dragging pattern holding unit
CN108656103A (en) The delineating method of robot work region
CN116624164A (en) Cutting control method, device and system of heading machine and storage medium
CN111260772A (en) Equipment anti-collision protection method, system and manufacturing system
JP3450609B2 (en) Offline teaching device for robots
JPS6334093A (en) Visual device
JPH0660164A (en) Three-dimensional shape processing system
JP2854174B2 (en) Enlargement drawing method in numerical controller
JPH02150968A (en) Three-dimensional cursor controller
JP2020111970A (en) Interference prevention device
JPH07129223A (en) Blanking data generating device for automatic programming system for sheet metal machining
JP6972249B1 (en) Control device
JPH11143926A (en) Three-dimensional graphic layout device
Tarutani et al. Accuracy and Generality of Trained Models for Lift Planning Using Deep Reinforcement Learning-Optimization of the Crane Hook Movement between Two Points
JP3246952B2 (en) CAD processing method and apparatus
JPH0337946A (en) Observation position display method for scanning type electronic microscope
KR20230170569A (en) Method and apparatus for generating moving path of robot, robot system, and program
JPH10154040A (en) Image processor
JPH11144049A (en) Image conversion method and device therefor

Legal Events

Date Code Title Description
A300 Application deemed to be withdrawn because no request for examination was validly filed

Free format text: JAPANESE INTERMEDIATE CODE: A300

Effective date: 20050301