JP2012089174A - Robot and program of information processor - Google Patents

Robot and program of information processor Download PDF

Info

Publication number
JP2012089174A
JP2012089174A JP2012024994A JP2012024994A JP2012089174A JP 2012089174 A JP2012089174 A JP 2012089174A JP 2012024994 A JP2012024994 A JP 2012024994A JP 2012024994 A JP2012024994 A JP 2012024994A JP 2012089174 A JP2012089174 A JP 2012089174A
Authority
JP
Japan
Prior art keywords
robot
map
movable object
self
arrangement position
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
JP2012024994A
Other languages
Japanese (ja)
Other versions
JP5429901B2 (en
Inventor
Kobo Okamura
公望 岡村
Kazumi Fukunaga
和海 福永
Takuya Ishida
卓也 石田
Akihisa Oya
晃久 大矢
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.)
University of Tsukuba NUC
Fuji Soft Inc
Original Assignee
University of Tsukuba NUC
Fuji Soft Inc
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 University of Tsukuba NUC, Fuji Soft Inc filed Critical University of Tsukuba NUC
Priority to JP2012024994A priority Critical patent/JP5429901B2/en
Publication of JP2012089174A publication Critical patent/JP2012089174A/en
Application granted granted Critical
Publication of JP5429901B2 publication Critical patent/JP5429901B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

PROBLEM TO BE SOLVED: To provide technology capable of reducing costs required to regenerate an environment map and regenerating the environment map timely.SOLUTION: When map information including the arrangement position of a fixed object within a prescribed area is stored to regenerate a map, (1) to (5) is repeatedly executed while moving a robot 10 within the prescribed area. (1) An encoder 21 is estimated to calculate the self-position of the robot; (2) distances up to a fixed object and a movable object existing within a predetermined viewing angle range of the robot are measured; (3) a corrected self-position is calculated from the measured distances and a distance to the fixed object obtained from map information; (4) a measurement value representing the distance to the movable object within the measurement values is extracted; and (5) the arrangement position of the movable object is calculated from the extracted measurement value and the corrected self-position. Then, the calculated arrangement position of the movable object is subjected to aggregation processing to calculate a new arrangement position, and the calculated new arrangement position is outputted to the outside.

Description

本発明は、環境地図の再作成に要するコストを低減し、かつ環境地図をタイムリーに再作成することのできるロボットのプログラム及び情報処理装置のプログラムに関する。   The present invention relates to a robot program and an information processing apparatus program that can reduce the cost required to re-create an environment map and can re-create the environment map in a timely manner.

現在、サービス分野において、例えば、案内、清掃、搬送などのサービスを行う移動ロボットが使用されている。この移動ロボットは、人間にサービスを行うために所定の作業スケジュールに従って自律的に移動する。   Currently, mobile robots that provide services such as guidance, cleaning, and transportation are used in the service field. This mobile robot moves autonomously according to a predetermined work schedule in order to provide services to humans.

従来の技術では、移動ロボットは、移動用の車輪の回転を積算して移動量を求めるオドメトリにより自己位置を推定する。オドメトリとは、左右の車輪の回転速度からロボットの並進速度とロボット本体の角速度を求め、それらを積分してロボットの位置と姿勢を求める方法である。その推定自己位置に基づいて、定められた経路に従って走行することにより、移動ロボットは、必要な位置へ移動することができる。   In the conventional technology, the mobile robot estimates its own position by odometry that calculates the amount of movement by integrating the rotation of the wheels for movement. Odometry is a method of obtaining the translation speed of the robot and the angular velocity of the robot body from the rotational speeds of the left and right wheels, and integrating them to obtain the position and orientation of the robot. Based on the estimated self-position, the mobile robot can move to a required position by traveling along a predetermined route.

ところで、移動ロボットが動作する環境は人間が活動している環境である。従って、その環境は不変ではなく変化するのが普通である。一方、ほとんどの移動ロボットは、予め与えられた環境地図に基づいて自律移動を行う。そのため、移動ロボットが保有する環境地図と実際の外界の環境とが異なった場合には、移動ロボットの自己位置認識機能が低下する。   By the way, the environment in which the mobile robot operates is an environment where humans are active. Therefore, the environment usually changes rather than remains unchanged. On the other hand, most mobile robots perform autonomous movement based on a predetermined environmental map. For this reason, when the environment map held by the mobile robot is different from the actual external environment, the self-position recognition function of the mobile robot is degraded.

移動ロボットの自己位置認識機能の低下を防止するためには環境地図を外界の環境に合わせるように再作成することが必要である。しかし、環境地図の再作成においても新たな環境地図作成時と同様に、特別なスキルを備えた要員による特別の作業が不可欠であるため、コスト及び納期の面において改善が求められている。   In order to prevent the mobile robot's self-position recognition function from being degraded, it is necessary to recreate the environment map to match the environment of the outside world. However, in the re-creation of the environmental map, as in the case of creating a new environmental map, special work by personnel with special skills is indispensable, so improvement in terms of cost and delivery time is required.

特許文献1に開示された技術では、自走ロボットが移動経路を学習する際に、教示者が移動経路を辿って歩くだけで、学習モードにセットされた自走ロボットが教示者の移動経路を後追いして経路教示データを確定する自動処理を実行するため、教示者が位置データを直接に編集しなくとも自走ロボットに経路を教示することができる。   In the technique disclosed in Patent Document 1, when the self-propelled robot learns the movement route, the self-propelled robot set in the learning mode can change the teacher's movement route simply by walking along the movement route. Since automatic processing for determining the route teaching data after the execution is executed, the route can be taught to the self-running robot without the teacher directly editing the position data.

特開2004−240698号公報JP 2004-240698 A

しかしながら、特許文献1に記載された技術では、現場における教示が必要となるため、所要のスキルを備えた教示者と移動ロボットの動作している環境とが離れている場合には、環境変化が発生する毎に現地における教示が必要となり運用コストの増加につながるとともに、環境変化に対して必ずしもタイムリーな対応ができるものでもなかった。
今後、サービス分野における移動ロボットの普及を促進していく上では、移動ロボットに使用される環境地図の再作成に要するコストを低減し、かつ環境地図をタイムリーに再作成できることが求められる。
However, since the technique described in Patent Document 1 requires on-site teaching, if the instructor with the required skill is separated from the environment in which the mobile robot is operating, the environment changes. Each time it occurs, local teaching is required, leading to an increase in operating costs and a timely response to environmental changes.
In the future, in order to promote the spread of mobile robots in the service field, it is required to reduce the cost required to re-create environmental maps used for mobile robots and to re-create environmental maps in a timely manner.

本発明は、斯かる事情に鑑みてなされたものであって、環境地図の再作成に要するコストを低減し、かつ環境地図をタイムリーに再作成することのできる技術を提供することを目的とする。   The present invention has been made in view of such circumstances, and an object of the present invention is to provide a technology capable of reducing the cost required to re-create an environmental map and re-creating the environmental map in a timely manner. To do.

上記課題を解決するための本発明は、所定領域内を自動で移動するロボットを制御するプログラムであって、前記所定領域内の固定物の配置位置を含む地図情報を記憶するステップ、外部から地図再作成の指示を受付けた際、前記所定領域内を前記ロボットを移動させつつ(1)乃至(5)のステップを繰返し実行するステップ、(1)エンコーダの測定値を積算して前記ロボットの自己位置を算出するステップ、(2)前記ロボットの所定視野角範囲内にある前記固定物及び移動可能物までの距離を水平面の特定角度毎に測定するステップ、(3)測定した距離と、前記地図情報から得られる前記固定物までの距離とを処理して、前記算出した自己位置を補正した補正自己位置を求めるステップ、(4)前記測定値の内、前記移動可能物までの距離を表す測定値を抽出するステップ、(5)前記抽出した測定値と前記補正自己位置とから前記移動可能物の配置位置を算出するステップ、前記算出した移動可能物の配置位置を集約処理して新たな配置位置を求めるステップ、前記求めた新たな配置位置を外部に出力するステップ、を前記ロボットに搭載されるコンピュータに実行させるためのプログラムである。   The present invention for solving the above-mentioned problems is a program for controlling a robot that automatically moves within a predetermined area, the step of storing map information including an arrangement position of a fixed object within the predetermined area, a map from the outside Steps (1) to (5) are repeatedly executed while the robot is moved within the predetermined area when the re-creation instruction is received. A step of calculating a position, (2) a step of measuring a distance to the fixed object and a movable object within a predetermined viewing angle range of the robot for each specific angle of a horizontal plane, and (3) the measured distance and the map Processing the distance to the fixed object obtained from the information to obtain a corrected self position obtained by correcting the calculated self position; (4) Of the measured values, the movable object (5) calculating the arrangement position of the movable object from the extracted measurement value and the corrected self-position, and aggregating the calculated arrangement position of the movable object Then, a program for causing a computer mounted on the robot to execute a step of obtaining a new arrangement position and a step of outputting the obtained new arrangement position to the outside.

また本発明は、情報処理装置のプログラムであって、上記記載の発明であるプログラムを搭載した前記ロボットが出力した前記移動可能物についての新たな配置位置を入力するステップ、前記新たな配置位置をユーザに提示するステップ、この新たな配置位置に基づくユーザの操作に対応して環境地図を再作成するステップ、を前記情報処理装置に搭載したコンピュータに実行させるためのプログラムである。   Further, the present invention is a program for an information processing apparatus, the step of inputting a new arrangement position for the movable object outputted by the robot equipped with the program according to the invention described above, and the new arrangement position. A program for causing a computer mounted on the information processing apparatus to execute a step presented to a user and a step of recreating an environment map in response to a user operation based on the new arrangement position.

この発明によれば、環境地図の再作成に要するコストを低減し、かつ環境地図をタイムリーに再作成することができる。   According to the present invention, it is possible to reduce the cost required for re-creating the environment map and to re-create the environment map in a timely manner.

地図作成システムの構成を示す図。The figure which shows the structure of a map creation system. 移動ロボットの構成を示す図。The figure which shows the structure of a mobile robot. 新たに地図を作成する際の移動ロボットの動作を示すフロー図。The flowchart which shows operation | movement of the mobile robot at the time of creating a new map. 作成された地図を示す図。The figure which shows the created map. 作業のために自律移動する際の移動ロボットの動作を示すフロー図。The flowchart which shows operation | movement of the mobile robot at the time of autonomous movement for work. 自己位置を補正する手順を示すフロー図。The flowchart which shows the procedure which correct | amends a self-position. 対応点の探索方法を示す図。The figure which shows the search method of a corresponding point. 地図を再作成する際の移動ロボットの動作を示すフロー図。The flowchart which shows operation | movement of the mobile robot at the time of recreating a map. 移動可能物位置取得処理の概略の手順を示すフローチャート。The flowchart which shows the general | schematic procedure of a movable object position acquisition process.

[第1の実施の形態]
図1は、地図作成システムの構成を示す図である。
本地図作成システムでは、博物館1に備えられた移動ロボット10と、保守センタ2のセンタ情報処理端末11とがインターネット12、無線LANルータ13を介して情報を授受する。そして、博物館1に設けられたユーザ情報処理端末14は、無線LANルータ13を介して移動ロボット10及びセンタ情報処理端末11と情報を授受することができる。
[First Embodiment]
FIG. 1 is a diagram showing a configuration of a map creation system.
In this mapping system, the mobile robot 10 provided in the museum 1 and the center information processing terminal 11 of the maintenance center 2 exchange information via the Internet 12 and the wireless LAN router 13. The user information processing terminal 14 provided in the museum 1 can exchange information with the mobile robot 10 and the center information processing terminal 11 via the wireless LAN router 13.

移動ロボット10は、博物館1への入場者を引率して所定の経路を進み、それぞれの展示物の前で静止して当該展示物の説明を行うなどの案内業務を担当する。また夜間には、博物館内の所定の経路を巡るなどの見回り作業も担当する。   The mobile robot 10 leads a visitor to the museum 1 and proceeds along a predetermined route, and takes charge of guidance work such as standing in front of each exhibit and explaining the exhibit. In the evening, he is also in charge of patrols such as visiting a predetermined route in the museum.

保守センタ2の保守者は、センタ情報処理端末11を操作して遠隔で移動ロボット10を操作することができる。移動ロボット10は、遠隔からの指令に従って動作するとともに、収集した情報をセンタ情報処理端末11に送信する。
博物館1のユーザは、ユーザ情報処理端末14を操作して遠隔で移動ロボット10を操作することができる。移動ロボット10は、遠隔からの指令に従って動作するとともに、収集した情報をユーザ情報処理端末14に送信する。
A maintenance person of the maintenance center 2 can operate the mobile robot 10 remotely by operating the center information processing terminal 11. The mobile robot 10 operates according to a remote command and transmits the collected information to the center information processing terminal 11.
A user of the museum 1 can operate the mobile robot 10 remotely by operating the user information processing terminal 14. The mobile robot 10 operates in accordance with a remote command and transmits the collected information to the user information processing terminal 14.

図2は、移動ロボット10の構成を示す図である。
移動ロボット10には、統括コントローラ20、エンコーダ21、レーザレンジファインダ(LRF:Laser Range Finder)22、通信部23、リモートコントローラ24及びデータ蓄積装置25が設けられている。
FIG. 2 is a diagram illustrating a configuration of the mobile robot 10.
The mobile robot 10 includes a general controller 20, an encoder 21, a laser range finder (LRF) 22, a communication unit 23, a remote controller 24, and a data storage device 25.

統括コントローラ20は、移動ロボット10に予め設定されたプログラム動作を実行するとともに、移動ロボット10の動作を統括して制御する。エンコーダ21は、移動ロボット10の左右の移動用車軸に設けられ、車輪の回転速度を測定することができる。測定した回転速度からオドメトリにより移動ロボット10の自己位置を推定することができる。 LRF22は、測域センサであり、移動ロボット10の視野範囲(例えば、240度の範囲)にある物体までの距離を、水平面の特定角度毎に測定する。通信部23は、無線LANによってセンタ情報処理端末11、ユーザ情報処理端末14と情報を授受する。リモートコントローラ24は、人間の操作によって移動ロボット10を動作させる場合の操縦装置である。   The overall controller 20 executes a preset program operation for the mobile robot 10 and controls the operation of the mobile robot 10 in an integrated manner. The encoder 21 is provided on the left and right moving axles of the mobile robot 10 and can measure the rotational speed of the wheels. The self-position of the mobile robot 10 can be estimated from the measured rotational speed by odometry. The LRF 22 is a range sensor, and measures the distance to an object in the visual field range (for example, a range of 240 degrees) of the mobile robot 10 for each specific angle on the horizontal plane. The communication unit 23 exchanges information with the center information processing terminal 11 and the user information processing terminal 14 through a wireless LAN. The remote controller 24 is a control device when the mobile robot 10 is operated by a human operation.

続いて、移動ロボット10の新規地図作成動作、自律移動動作及び地図再作成動作をそれぞれ説明する。
図3は、新たに地図を作成する際の移動ロボット10の動作を示すフロー図である。
この最初の地図作成においては、通常は保守センタ2で業務を行っている保守者が現地に出掛けて、例えばリモートコントローラ24を用いて移動ロボット10を操作する。
Next, a new map creation operation, an autonomous movement operation, and a map recreation operation of the mobile robot 10 will be described.
FIG. 3 is a flowchart showing the operation of the mobile robot 10 when a new map is created.
In this first map creation, a maintenance person who normally performs work at the maintenance center 2 goes to the site and operates the mobile robot 10 using the remote controller 24, for example.

動作開始に際し、移動ロボット10は、内部にある自己位置を初期値に設定する。例えば、待機ステーションにいる場合は、その位置を初期の自己位置として設定する。
次に、移動ロボット10は、リモートコントローラ24からの指示を受信し、その指示に従った動作を実行する。
At the start of operation, the mobile robot 10 sets its own position inside as an initial value. For example, if you are at a standby station, that position is set as the initial self-position.
Next, the mobile robot 10 receives an instruction from the remote controller 24 and executes an operation according to the instruction.

ステップS01において、受信した指示が回転・並進の移動指示の場合、統括コントローラ20はアクチュエータにトルクを与えて移動ロボット10を指示方向に移動させて停止する。この際、移動ロボット10は、オドメトリより自己位置を推定する。ここで、推定する自己位置は、例えば、平面上のX,Y位置及び向きを示す角度θである。   In step S01, when the received instruction is a rotation / translation movement instruction, the overall controller 20 applies torque to the actuator to move the mobile robot 10 in the instruction direction and stops. At this time, the mobile robot 10 estimates its own position from odometry. Here, the estimated self-position is, for example, an angle θ indicating the X and Y positions and orientations on the plane.

ステップS02において、受信した指示が外界データ取得指示の場合、統括コントローラ20は、LRF22に測定させると共に測定したデータを取得する。そして、ステップS03において、データ蓄積装置25内に格納してある環境地図に、自己位置を基準として測定データを合成する。
図4は、作成された地図を示す図である。
図4の小さな点で表される点群(ポイントクラウド)がLRF22で測定したデータを表している。上述のように、LRF22は、移動ロボット10の視野範囲(例えば、240度の範囲)にある物体までの距離を、水平面の特定角度毎に測定する。従って、測定値は、物体の外形を不連続に測定した複数の点で表される。これが図4に示される点群である。この点群で表される地図を環境地図という。
If the received instruction is an outside world data acquisition instruction in step S02, the overall controller 20 causes the LRF 22 to measure and acquire the measured data. In step S03, the measurement data is combined with the environment map stored in the data storage device 25 using the self position as a reference.
FIG. 4 is a diagram showing the created map.
A point group (point cloud) represented by small points in FIG. 4 represents data measured by the LRF 22. As described above, the LRF 22 measures the distance to an object in the visual field range (for example, a range of 240 degrees) of the mobile robot 10 for each specific angle on the horizontal plane. Therefore, the measured value is represented by a plurality of points obtained by measuring the outer shape of the object discontinuously. This is the point group shown in FIG. A map represented by this point cloud is called an environmental map.

図4の直線は、移動ロボットの経路を表している。図4の大きな丸で表される位置は移動ロボット10が移動方向を変更するために停止した位置(通過地点)を表している。この通過地点において、移動ロボット10は、指定された角度回転して移動方向を転換する。この経路と停止位置で表される地図を経路地図という。   The straight line in FIG. 4 represents the path of the mobile robot. A position represented by a large circle in FIG. 4 represents a position (passing point) where the mobile robot 10 stops to change the moving direction. At this passing point, the mobile robot 10 rotates the specified angle to change the moving direction. A map represented by this route and the stop position is called a route map.

図3のステップS04において、上述の動作を移動範囲の地図を作成するまで繰り返して実行する。そして、ステップS05において、作成した環境地図、経路地図を地図情報としてデータ蓄積装置25に保存すると共に通信部23を介してセンタ情報処理端末11に送信する。   In step S04 in FIG. 3, the above-described operation is repeated until a map of the movement range is created. In step S05, the created environment map and route map are stored as map information in the data storage device 25 and transmitted to the center information processing terminal 11 via the communication unit 23.

送信された地図情報である環境地図、経路地図は、センタ情報処理端末11のデータ蓄積装置32に格納され、保守者によってさらに編集される。保守者は、入出力装置31を用いて環境地図、経路地図を表示させながらGUI(Graphical User Interface)を介して編集作業を実行する。   The transmitted map information, which is the environment map and route map, is stored in the data storage device 32 of the center information processing terminal 11 and further edited by the maintenance person. The maintenance person performs an editing operation via a GUI (Graphical User Interface) while displaying the environment map and the route map using the input / output device 31.

ステップT01において、経路・地点情報を編集する。例えば、図4の直線で表される経路を追加・修正・削除する。また、図4の大きな丸で表される通過地点を追加・修正・削除する。   In step T01, route / point information is edited. For example, a route represented by a straight line in FIG. 4 is added / modified / deleted. In addition, a passing point represented by a large circle in FIG. 4 is added / modified / deleted.

ステップT02において、移動可能物・固定物を設定する。例えば、図4の点群に対して移動可能物・固定物の属性を付与する。ここで、固定物は、例えば柱、特定の展示物、固定壁など、半永久的に所定位置に存在している物体である。移動可能物は、固定物以外の物であり、例えば椅子、特定の展示物、簡易仕切壁など設置位置が変更されうるものが該当する。
保守者は、図4で示される点群の内から、マウスのドラッグ&ドロップ操作によって複数の点群(グループ)を選択して、グループ名(個々の移動可能物及び固定物の名称)を設定し、移動可能物か固定物かの区分情報を設定入力する。この動作を繰り返して環境地図ファイルを作成する。
In step T02, a movable / fixed object is set. For example, the attribute of a movable object / fixed object is given to the point group in FIG. Here, the fixed object is an object that exists semi-permanently at a predetermined position, such as a pillar, a specific exhibit, or a fixed wall. A movable thing is a thing other than a fixed thing, for example, what can change an installation position, such as a chair, a specific exhibit, and a simple partition wall.
The maintenance person selects a plurality of point groups (groups) from the point cloud shown in FIG. 4 by dragging and dropping the mouse, and sets group names (names of individual movable objects and fixed objects). Then, set and input the classification information for movable or fixed objects. This operation is repeated to create an environment map file.

環境地図ファイルは、マスターファイルとスレーブファイルとで構成されている。   The environment map file is composed of a master file and a slave file.

マスターファイルには、グループ毎に、グループの基準となる座標(X,Y)、グループ名、移動種別(M,IM)が格納されている。グループの基準となる座標(X,Y)は、例えば、選択された複数の点群の内最も座標原点に近い点の座標である。移動種別は、移動可能物(M:Movable)か固定物(IM:Immovable)かの区分を表す。
スレーブファイルは、マスターファイルのグループ毎に設けられ、このグループに含まれる複数の点のそれぞれの座標(X,Y)が格納されている。
The master file stores, for each group, coordinates (X, Y), a group name, and a movement type (M, IM) serving as a group reference. The coordinates (X, Y) serving as the group reference are, for example, the coordinates of the point closest to the coordinate origin among the plurality of selected point groups. The movement type represents a classification of a movable object (M: Movable) or a fixed object (IM: Immovable).
A slave file is provided for each group of master files, and coordinates (X, Y) of a plurality of points included in this group are stored.

ステップT03において、作業シナリオを編集する。保守者は、移動ロボット10の動作を規定した作業シナリオを作成する。例えば、移動ロボットがどの移動地点からどの移動地点までどの経路を辿って移動するかを規定する。また、例えば、ある展示物の前では所定時間停止して説明用の音声を出力するなどの動作を規定する。   In step T03, the work scenario is edited. The maintenance person creates a work scenario that defines the operation of the mobile robot 10. For example, it is defined which route the mobile robot moves from which moving point to which moving point. Further, for example, an operation such as stopping for a predetermined time and outputting a sound for explanation in front of a certain exhibit is defined.

保守者によって編集された上述の各情報はインターネット12と無線LAN13を介して移動ロボット10に送信され、データ蓄積装置25に蓄積される。なお、データ蓄積装置25への蓄積状況は、適宜移動ロボット10からセンタ情報処理端末11に送信される。   Each information edited by the maintenance person is transmitted to the mobile robot 10 via the Internet 12 and the wireless LAN 13 and stored in the data storage device 25. The storage status in the data storage device 25 is appropriately transmitted from the mobile robot 10 to the center information processing terminal 11.

図5は、作業のために自律移動する際の移動ロボット10の動作を示すフロー図である。
移動ロボット10は、センタ情報処理端末11からの指示あるいはタイマからのイベントにより所定の作業シナリオに従った動作を開始する。
FIG. 5 is a flowchart showing the operation of the mobile robot 10 when autonomously moving for work.
The mobile robot 10 starts an operation according to a predetermined work scenario in response to an instruction from the center information processing terminal 11 or an event from a timer.

ステップS11において、移動ロボット10は起動時の自己位置を推定する。ここで、移動ロボット10が充電ステーション(不図示)など、所定の待機位置にいる場合は、自己位置は直ちに確定する。しかし、所定の待機位置にいないときは、LRF22で測定した点群と、データ蓄積装置25に保持している環境地図とを比較して自己位置を推定する。なお、自己位置の推定が困難なときは、別の位置に移動してLRF22の測定と自己位置推定の動作を繰り返す。移動する方向は、LRF22の測定結果で物体の存在しない方向とする。   In step S11, the mobile robot 10 estimates its own position at the time of activation. Here, when the mobile robot 10 is at a predetermined standby position such as a charging station (not shown), the self-position is immediately determined. However, when not at the predetermined standby position, the self-position is estimated by comparing the point group measured by the LRF 22 with the environment map held in the data storage device 25. When it is difficult to estimate the self position, the measurement is moved to another position and the measurement of the LRF 22 and the self position estimation operation are repeated. The moving direction is a direction in which no object exists in the measurement result of the LRF 22.

自己位置が推定できた場合、経路情報と作業シナリオを認識したことを表す動作状態ログを保守センタに送信する。そして、ステップS12において、経路情報に従って次に移動すべき地点に移動する。ステップS13において、エンコーダ21より推定自己位置を算出する。なお、エンコーダ21による推定自己位置の算出はロボットの移動中において所定距離ごと、又は所定時間ごとに行っている。   When the self-position can be estimated, an operation state log indicating that the route information and the work scenario are recognized is transmitted to the maintenance center. In step S12, the robot moves to the next point to be moved according to the route information. In step S13, the estimated self-position is calculated from the encoder 21. The encoder 21 calculates the estimated self-position every predetermined distance or every predetermined time during the movement of the robot.

ところで推定自己位置は、エンコーダ21を用いて測定した並進成分、回転成分を積算することによって求められる。しかし移動経路が平坦でなく凹凸が存在している等で発生した誤差が積算されるため、適宜自己位置を正しい値に補正する必要がある。   By the way, the estimated self-position is obtained by integrating the translation component and the rotation component measured using the encoder 21. However, since errors generated when the movement path is not flat and there are irregularities are integrated, it is necessary to appropriately correct the self-position to a correct value.

そこで、ステップS14において、環境地図とLRF22の測定結果とを基にエンコーダ21による現在推定自己位置を補正する。   Therefore, in step S14, the current estimated self-position by the encoder 21 is corrected based on the environment map and the measurement result of the LRF 22.

図6は、自己位置を補正する手順を示すフロー図である。
ステップT11において、オドメトリによる現在推定自己位置を基にLRF22を用いた測距範囲の部分の環境地図を抽出する。なお、推定自己位置の誤差を考慮して、所定範囲だけ広い部分を抽出する。
FIG. 6 is a flowchart showing a procedure for correcting the self-position.
In step T11, an environment map of the range of the distance measurement range using the LRF 22 is extracted based on the current estimated self-position by odometry. In consideration of the error of the estimated self-position, a portion wide by a predetermined range is extracted.

ステップT12において、環境地図上の点とLRF22の測定データをICPスキャンマッチングする。つまり、オドメトリによる推定自己位置の算出処理とは別に、LRF22の測定データを基にした推定自己位置の算出処理を実行する。ここで、環境地図上には、移動可能物と固定物とが存在するが、ICPスキャンマッチングでは、移動可能物、固定物に分けて実施する。   In step T12, the points on the environment map and the measurement data of the LRF 22 are subjected to ICP scan matching. That is, separately from the calculation process of the estimated self-position by odometry, the calculation process of the estimated self-position based on the measurement data of the LRF 22 is executed. Here, although there are a movable object and a fixed object on the environment map, the ICP scan matching is performed separately for the movable object and the fixed object.

続いてICPスキャンマッチング方法について説明する。   Next, an ICP scan matching method will be described.

[A.最近傍対応点探索]
ステップA1:LRF22で測定したデータは、移動ロボット10を基準とした(LRF22の位置を原点とする)ロボット座標系で表されている。一方、環境地図の座標は、環境地図の原点を基準とした世界座標系で表されている。そこで、測定した点の位置をロボット座標系から世界座標系に変換(同次変換)する。同次変換後の測定点(変換点)の座標は式(1)で表される。

Figure 2012089174
[A. Nearest neighbor search]
Step A1: The data measured by the LRF 22 is expressed in a robot coordinate system with the mobile robot 10 as a reference (the position of the LRF 22 is the origin). On the other hand, the coordinates of the environment map are expressed in a world coordinate system based on the origin of the environment map. Therefore, the position of the measured point is converted from the robot coordinate system to the world coordinate system (homogeneous conversion). The coordinates of the measurement point (conversion point) after the homogeneous conversion are expressed by equation (1).
Figure 2012089174

ここで、式(1)の右辺第1項は移動ロボット10の向きを補正する回転成分であり、第2項は移動ロボット10の平行移動成分を表している。   Here, the first term on the right side of the equation (1) is a rotation component for correcting the orientation of the mobile robot 10, and the second term represents the translation component of the mobile robot 10.

ステップA2:式(1)で求めた変換点と、距離が最小となる環境地図上の点(参照点)を探索し、この2点から成る組を対応組とする。
図7は、対応組の探索方法を示す図である。変換点qtがi個存在し、参照点pがj個存在している場合は、それぞれの変換点ごとに全ての参照点との距離を求める。そして、変換点ごとに、距離が最小となる参照点を選択し、その変換点と参照点を対応させ、対応組とする。この探索中には、常時、外れ値除去を行う。外れ値除去とは、探索中に算出した距離が所定の閾値以上の場合は、前記選択の対象から除外し、以降の処理の対象からも除外する。
Step A2: The conversion point obtained by the equation (1) and the point (reference point) on the environment map where the distance is the minimum are searched, and a set of these two points is set as a corresponding set.
FIG. 7 is a diagram illustrating a method for searching for a correspondence group. When there are i conversion points qt and j reference points p, the distances from all the reference points are obtained for each conversion point. Then, for each conversion point, a reference point having a minimum distance is selected, and the conversion point and the reference point are associated with each other to obtain a corresponding set. During this search, outlier removal is always performed. In the outlier removal, when the distance calculated during the search is equal to or larger than a predetermined threshold, it is excluded from the selection target and also excluded from the subsequent processing targets.

なお、外れ値除去は、上述のような探索中に限られず、この探索の結果で得られた対応組の変換点と参照点との距離が所定の閾値以上の場合は、以降の処理の対象から除外するようにしても良い。   Note that outlier removal is not limited to the above-described search. If the distance between the conversion point and the reference point of the corresponding pair obtained as a result of this search is equal to or greater than a predetermined threshold, the target of subsequent processing You may make it exclude from.

[B.外れ値除去パラメータ更新]
この外れ値除去のための閾値は、前回の探索において求めた各対応組の変換点と参照点との間の距離の平均値と、その標準偏差を所定倍(例えば、2倍)したものとの和で得られた値を用いる。従って、今回の探索において求めた外れ値除去のための閾値は、次回の探索で用いられる。
[B. Update outlier removal parameter]
The threshold for removing outliers is obtained by multiplying the average value of the distance between the conversion point of each corresponding set obtained in the previous search and the reference point by a predetermined multiple (for example, twice) of the standard deviation. The value obtained by the sum of is used. Therefore, the threshold value for outlier removal obtained in the current search is used in the next search.

[C.ニュートン法を用いた同次変換値の更新]
ここでは、式(1)より求めた変換点qti(n)を対応する参照点pjに近づけるように初期自己位置及び更新自己位置を更新する。このとき、自己位置の内部データを更新するのであって、実際にロボットを移動させてその自己位置を更新するわけではない。
[C. Update homogeneous transformation values using Newton's method]
Here, the initial self-position and the update self-position are updated so that the conversion point qti (n) obtained from the equation (1) approaches the corresponding reference point pj. At this time, the internal data of the self position is updated, and the self position is not updated by actually moving the robot.

そのため、ステップC1:変換点qti(n)と参照点pjが近づいたか否かの指標となる評価関数を導入する。次に、ステップC2:ステップ1の評価関数に最適化法の1つであるニュートン法を用いることにより、変換点qti(n)が対応する参照点pjに近づくように処理を行う。ステップC3:この処理に対応して、ロボットの初期自己位置および更新自己位置(tx(n)、ty(n)、tθ(n))を更新して(tx(n+1)、ty(n+1)、tθ(n+1))とする。ステップC4:更新後の自己位置と更新前の自己位置の対応成分同士の差の2乗をそれぞれ求め、これらの総和値を算出する。ステップC5:更新後の自己位置を基に新たな変換点を算出し、この新たな変換点を用いて前記総和値が閾値以下となるまでステップC2からステップC4までの処理を繰り返す。総和値が閾値以下となったときICPスキャンマッチングを終了する。このときの更新後の自己位置がICPスキャンマッチングの結果、つまりLRF22による推定自己位置である。 Therefore, Step C1: An evaluation function is introduced that serves as an index as to whether or not the conversion point qti (n) and the reference point pj are close to each other. Next, by using Newton's method which is one of optimization methods for the evaluation function in Step C2: Step 1, processing is performed so that the conversion point qti (n) approaches the corresponding reference point pj. Step C3: Corresponding to this processing, the robot's initial self-position and update self-position (tx (n), ty (n), tθ (n)) are updated (tx (n + 1), ty (n + 1), tθ (n + 1)). Step C4: The squares of the differences between the corresponding components of the self-position after update and the self-position before update are respectively obtained, and the sum of these values is calculated. Step C5: A new conversion point is calculated based on the updated self-position, and the processes from Step C2 to Step C4 are repeated using the new conversion point until the total value becomes equal to or less than the threshold value. When the total value is equal to or less than the threshold value, the ICP scan matching is finished. The updated self-position at this time is the result of ICP scan matching, that is, the estimated self-position by the LRF 22.

なお、ステップC2からステップC5までの処理では、ステップC2における変換点と参照点との距離が閾値以下となることを前提とし、前記総和値が閾値以下になったとしても、ステップC2における変換点と参照点との距離が閾値以下とならないまま、ステップC2からステップC4までの処理の繰り返し回数が閾値を超える場合には、エラーを出力して処理を終了するようにしても良い。このとき出力されたエラーを集計してマッチングエラー率として地図再作成が必要か否かの指標に利用することができる。例えば、ロボットが走行空間内のn箇所で上記ステップC1からステップC5までを実行して、その内マッチングエラーとして出力された箇所がm箇所である場合には、マッチングエラー率を(m/n)×100として算出し、この値が閾値を超える場合には地図再作成が必要であると判断する。   In the process from step C2 to step C5, it is assumed that the distance between the conversion point and the reference point in step C2 is equal to or less than a threshold value. Even if the total value is equal to or less than the threshold value, the conversion point in step C2 is determined. If the number of repetitions of the processing from step C2 to step C4 exceeds the threshold without the distance between the reference point and the reference point being equal to or less than the threshold, an error may be output and the processing may be terminated. The errors output at this time can be aggregated and used as an index indicating whether or not map re-creation is necessary as a matching error rate. For example, when the robot executes steps C1 to C5 at n points in the travel space and m points are output as matching errors, the matching error rate is (m / n). It is calculated as x100, and when this value exceeds the threshold value, it is determined that map recreation is necessary.

以上のようにして、ICPスキャンマッチングによりLRF22による推定自己位置を算出した後、図6のステップT13において、エンコーダ21による現在推定自己位置を補正する。   After calculating the estimated self-position by the LRF 22 by ICP scan matching as described above, the current estimated self-position by the encoder 21 is corrected in step T13 of FIG.

このためには、移動可能物を基にしたLRF22による推定自己位置と、固定物を基にしたLRF22による推定自己位置と、エンコーダ21による推定自己位置とをカルマンフィルタを用いた最尤推定法により融合して新たな自己位置を算出する。ここで算出された新たな自己位置が補正後の自己位置である。なお、この融合処理には、エンコーダ21による推定自己位置の誤差の大きさとLRF22による推定自己位置の誤差の大きさを考慮し、それらの誤差の大きさに依存した重み付けをして、より正確な自己位置を算出する処理を含む。カルマンフィルタを用いた最尤推定法による融合については、例えば、日本ロボット学会誌Vol.22 No.3、pp.343-352、2004を参考にして実施することができる。   For this purpose, the estimated self-position by the LRF 22 based on the movable object, the estimated self-position by the LRF 22 based on the fixed object, and the estimated self-position by the encoder 21 are fused by the maximum likelihood estimation method using the Kalman filter. To calculate a new self-position. The new self-position calculated here is the self-position after correction. This fusion process takes into account the magnitude of the estimated self-position error by the encoder 21 and the magnitude of the estimated self-position error by the LRF 22, and weights depending on the magnitude of these errors to provide a more accurate result. Includes the process of calculating the self-position. The fusion by the maximum likelihood estimation method using the Kalman filter can be performed with reference to, for example, Journal of the Robotics Society of Japan Vol.22 No.3, pp.343-352, 2004.

なお、移動可能物、固定物から求めた2つの自己位置から融合によって新たな自己位置を推定するのは、例えば、広く簡素な空間を測定する場合のように、固定物が少ないために固定物に基づく自己位置の誤差が大きくなるようなケースにおいて、移動可能物による自己位置の情報を取り入れることによって精度の低下を防止するためである。   Note that the new self-position is estimated from the two self-positions obtained from the movable object and the fixed object by fusion because, for example, when measuring a wide and simple space, the fixed object is small. This is because, in the case where the error of the self-position based on the case becomes large, the deterioration of accuracy is prevented by incorporating the self-position information by the movable object.

従って、本実施の形態に示すように、対象とするエリアが限定され、自己位置算定に必要な数の固定物が配置されている場合は、移動可能物については融合処理を行う必要はない。   Therefore, as shown in the present embodiment, when the target area is limited and the number of fixed objects necessary for self-position calculation is arranged, it is not necessary to perform the fusion process on the movable objects.

走行空間に固定物がまばらな場合において、移動可能物、固定物から求めた2つの推定自己位置を融合する方法としては、例えば、現在の自己位置から固定物までの距離について、LRF22の測定結果と環境地図上の対応する点同士を比較して誤差率を算出し、この誤差率が閾値以下であれば移動可能物の融合比率を0とする。閾値を超える場合には移動可能物の融合比率を誤差率に依存した係数にて設定し、この融合比率に応じて移動可能物、固定物から求めた2つの推定自己位置を融合する。   As a method of fusing the two estimated self-positions obtained from the movable object and the fixed object when the fixed object is sparse in the traveling space, for example, the measurement result of the LRF 22 for the distance from the current self-position to the fixed object. And corresponding points on the environment map are compared with each other to calculate an error rate. If this error rate is equal to or less than a threshold value, the fusion ratio of movable objects is set to zero. When the threshold value is exceeded, the fusion ratio of the movable object is set by a coefficient depending on the error rate, and the two estimated self-positions obtained from the movable object and the fixed object are fused according to the fusion ratio.

移動ロボット10は、上述の手順によって算出した自己位置を環境地図と照合する。そして、図5のステップS15において、目的地に到達したかどうかを判断する。   The mobile robot 10 collates the self-position calculated by the above procedure with the environment map. Then, in step S15 of FIG. 5, it is determined whether or not the destination has been reached.

ステップS15でNoの場合、即ち、まだ目的地に到達していない場合は、移動ロボット10は、上述のステップS12からの動作を継続する。このように移動ロボット10は、移動中においても所定距離ごと、又は所定時間ごとにエンコーダ21による現在推定自己位置の補正を繰り返して実行する。
ステップS15でYesの場合、即ち、目的地に到達した場合は、ステップS16において、その地点での作業シナリオに登録された作業があればその作業を実行する。
If No in step S15, that is, if the destination has not yet been reached, the mobile robot 10 continues the operation from step S12 described above. In this way, the mobile robot 10 repeatedly executes the correction of the current estimated self-position by the encoder 21 every predetermined distance or every predetermined time even during movement.
If Yes in step S15, that is, if the destination is reached, in step S16, if there is a work registered in the work scenario at that point, the work is executed.

ステップS17において、ロボット動作時に必要が生じた場合随時、動作状態ログを保守センタに送信する。この動作状態ログには、現在の地点、実施した作業内容、外界と環境地図とのマッチングエラー率などが含まれる。そして、移動ロボット10は、次の目的地に向けて、上述のステップS12からの動作を継続する。   In step S17, when a need arises during the robot operation, an operation state log is transmitted to the maintenance center as needed. This operation state log includes the current location, the contents of work performed, the matching error rate between the outside world and the environment map, and the like. Then, the mobile robot 10 continues the operation from step S12 described above toward the next destination.

保守センタでは、動作ログに基づいて移動ロボット10が正常な動作を行っているかどうかを判断する。もし、例えば、移動可能物を対象とするLRF22による測定において、環境地図と所定以上の誤差をもつ測定点の割合、即ち前記マッチングエラー率が増加し、閾値を超える場合は、移動ロボット10の故障あるいは地図再作成の必要性が考えられる。また、オドメトリによる推定自己位置とLRF22による推定自己位置との差が連続して閾値を超える場合に地図再作成が必要であると判断しても良い。   In the maintenance center, it is determined whether or not the mobile robot 10 is operating normally based on the operation log. For example, in the measurement by the LRF 22 for a movable object, if the ratio of measurement points having an error more than a predetermined value with the environment map, that is, the matching error rate increases and exceeds the threshold value, the mobile robot 10 is broken. Or the necessity of map re-creation is considered. Further, when the difference between the estimated self-position based on odometry and the estimated self-position based on LRF 22 continuously exceeds a threshold value, it may be determined that map re-creation is necessary.

例えば、物体(固定物及び移動可能物)までの距離に関して、測定値と地図情報から得られる距離との誤差の程度を表す指数値が増加している場合は、移動ロボット10の精度不良が発生しているため精度検査が必要と判断できる。
また、移動可能物までの距離に関して、測定値と地図情報から得られる距離との誤差の程度を表す指数値が増加し、固定物までの距離に関して、測定値と地図情報から得られる距離との誤差の程度を表す指数値が増加していない場合は、移動可能物の移動、出現、消失が発生したため地図再作成が必要と判断できる。
For example, regarding the distance to an object (a fixed object and a movable object), if the index value indicating the degree of error between the measured value and the distance obtained from the map information is increasing, the accuracy of the mobile robot 10 is poor. Therefore, it can be judged that an accuracy inspection is necessary.
In addition, the index value indicating the degree of error between the measured value and the distance obtained from the map information is increased with respect to the distance to the movable object, and the distance between the measured value and the map information is obtained with respect to the distance to the fixed object. If the index value indicating the degree of error has not increased, it can be determined that map re-creation is necessary because of the movement, appearance, and disappearance of movable objects.

なお、移動ロボット10は、電池残量が閾値以下になったことを検知した場合は、作業シナリオを充電ステーションへの帰還に切り替え、所定の経路に従って充電ステーションへ移動する。   If the mobile robot 10 detects that the remaining battery level is equal to or lower than the threshold, the mobile robot 10 switches the work scenario to return to the charging station and moves to the charging station according to a predetermined route.

図8は、地図を再作成する際の移動ロボット10の動作を示すフロー図である。
地図の再作成は、例えば、上述の測定値と地図情報から得られる距離との誤差の程度を表す指数値が所定値以上になったときに、保守センタ2の保守者の判断に基づいてセンタ情報処理端末11から送信される地図再作成指示によって開始する。
FIG. 8 is a flowchart showing the operation of the mobile robot 10 when recreating a map.
For example, when the index value indicating the degree of error between the measured value and the distance obtained from the map information is equal to or greater than a predetermined value, the map is recreated based on the judgment of the maintenance person of the maintenance center 2. The processing is started by a map re-creation instruction transmitted from the information processing terminal 11.

具体的には、実際の環境が変化して、あらかじめ環境地図を作成した時の環境と異なるなどの場合には、環境変化後の夜間や休館日等において、保守者からの指示(インターネットを介した遠隔から指示可能)または、あらかじめ決められたスケジュール(例えば、所定期間経過)等のトリガにより自律的に地図を再作成する。   Specifically, if the actual environment changes and differs from the environment when the environment map was created in advance, instructions from the maintenance staff (via the Internet) at night or on closed days after the environment change. The map can be autonomously recreated by a trigger such as a predetermined schedule (for example, a predetermined period of time).

ステップS21において、固定物と移動可能物とが記載された環境地図に基づいて、閉領域を探索する。探索方法としては、ニューフロンティア法等の公知の技術を用いることができる。ステップS22において、統括コントローラ20は、LRF22に測定させると共に測定したデータを取得する。そして、ステップS23において、移動可能物位置取得処理(図9)を実行する。ステップS23は、固定物の位置を基に自己位置を補正した後、この補正自己位置を基に移動可能物の正確な位置を求めることを目的とする。   In step S21, the closed area is searched based on the environment map in which the fixed object and the movable object are described. As a search method, a known technique such as a New Frontier method can be used. In step S22, the overall controller 20 causes the LRF 22 to measure and obtain the measured data. In step S23, a movable object position acquisition process (FIG. 9) is executed. The purpose of step S23 is to obtain an accurate position of the movable object based on the corrected self position after correcting the self position based on the position of the fixed object.

図9は、移動可能物位置取得処理の概略の手順を示すフローチャートである。
ステップT21において、LRF22で測定した点群を同次変換する。ステップT22において、同次変換された測定値と環境地図に記載された固定物を表す点群とを対比する。ステップT23において、ICPスキャンマッチングを行って自己位置を補正する。このステップT22、T23の処理は、図6のステップT12、T13の処理と同様である。もし固定物に対応した測定点が存在しない場合は、エンコーダ21による測定値から求められた自己位置が維持される。
FIG. 9 is a flowchart showing a schematic procedure of the movable object position acquisition process.
In step T21, the point group measured by the LRF 22 is subjected to homogeneous transformation. In step T22, the measurement value subjected to the homogeneous conversion is compared with a point group representing a fixed object described in the environment map. In step T23, ICP scan matching is performed to correct the self position. The processes in steps T22 and T23 are the same as the processes in steps T12 and T13 in FIG. If there is no measurement point corresponding to the fixed object, the self-position obtained from the measurement value by the encoder 21 is maintained.

ステップT24において、固定物以外の点群を移動可能物とする。例えば、環境地図上で世界座標系で表されたそれぞれの固定物の座標点を中心とする所定の領域を設定し、その領域外にある点群を移動可能物とする。そして、補正された自己位置に基づいて上記移動可能物の位置を世界座標系で求める。   In step T24, a point group other than a fixed object is set as a movable object. For example, a predetermined area centering on the coordinate point of each fixed object represented in the world coordinate system on the environment map is set, and a point group outside the area is set as a movable object. Then, the position of the movable object is obtained in the world coordinate system based on the corrected self-position.

ステップT25において、求めた移動可能物の位置を一時的に保存する。そして、図8にリターンする。   In step T25, the obtained position of the movable object is temporarily stored. Then, the process returns to FIG.

図8のステップS24において、閉領域をくまなく探索するまで上述のステップS21〜S23を実行する。探索が終了したときは、ステップS25において、移動可能物の座標位置を集約する。
集約とは、上述の探索において多数の移動可能物の位置が得られることにより、処理効率が低下してしまうことを防止するために行う処理である。
In step S24 of FIG. 8, the above-described steps S21 to S23 are executed until the closed region is searched throughout. When the search is finished, the coordinate positions of the movable objects are collected in step S25.
Aggregation is a process performed to prevent a reduction in processing efficiency due to the location of a large number of movable objects in the search described above.

そこで、ステップS25において、得られた移動可能物の測定点を集約する。例えば、集約の方法としては、間引きによって移動可能物の測定点を選択する。例えば、n(2以上の整数)個おきに抽出した測定点を、新たな移動可能物の測定点として選択し、これを新たな移動可能物の測定点とする。なお、新たな移動可能物の測定点を求める手法としては、近隣する測定点の中から代表点を選択し、これを新たな移動可能物の測定点としても良いし、移動可能物の測定点を複数のグループにまとめ、そのグループに属する複数の測定点の位置の平均値に対応する点を、新たに移動可能物の測定点としても良い。また、要因分析を行いマハラノビス距離を用いる等により、移動可能物を複数のグループにまとめる。そしてそのグループに属する複数の点の位置の平均値を、新たに移動可能物の位置として集約しても良い。さらに、上述の方法を適宜の順番で組み合わせて新たな移動可能物の測定点を求めても良い。   Therefore, in step S25, the obtained measurement points of the movable object are collected. For example, as a method of aggregation, measurement points for movable objects are selected by thinning. For example, measurement points extracted every n (an integer of 2 or more) are selected as measurement points for a new movable object, and set as measurement points for a new movable object. In addition, as a method for obtaining a measurement point for a new movable object, a representative point is selected from neighboring measurement points, and this may be used as a measurement point for a new movable object, or a measurement point for a movable object. The points corresponding to the average value of the positions of the plurality of measurement points belonging to the group may be newly set as the measurement points of the movable object. Also, moveable objects are grouped into multiple groups, for example by factor analysis and using Mahalanobis distance. Then, the average value of the positions of a plurality of points belonging to the group may be newly aggregated as the position of the movable object. Furthermore, the above-described methods may be combined in an appropriate order to obtain a new movable object measurement point.

ここで、環境地図上で世界座標系で表されたそれぞれの固定物の座標点を中心とする所定の領域内であれば固定物であり、領域外であれば移動可能物であるが、環境地図上にこれらを合成した後に一定の範囲内に存在する複数の点は、処理効率向上のためにマージして以降の処理では1点として扱う。   Here, if it is within a predetermined area centered on the coordinate point of each fixed object represented in the world coordinate system on the environment map, it is a fixed object, and if it is outside the area, it is a movable object. A plurality of points existing within a certain range after combining them on the map are merged to improve processing efficiency and treated as one point in the subsequent processing.

ステップS26において、集約した移動可能物の位置データをデータ蓄積装置25に保存すると共にステップS27において、通信部23を介してセンタ情報処理端末11に送信する。
送信された集約した移動可能物の位置データは、センタ情報処理端末11のデータ蓄積装置32に格納される。センタ情報処理端末11は、更にこの位置データに基づいて環境地図を作成し保守者に提示する。保守者は提示された環境地図をさらに編集して所望の環境地図を再作成する。
In step S26, the collected position data of the movable object is stored in the data storage device 25 and transmitted to the center information processing terminal 11 via the communication unit 23 in step S27.
The transmitted location data of the movable object is stored in the data storage device 32 of the center information processing terminal 11. The center information processing terminal 11 further creates an environmental map based on the position data and presents it to the maintenance person. The maintenance person further edits the presented environmental map to recreate a desired environmental map.

なお、集約した移動可能物の位置データをセンタ情報処理端末11に送信するのは伝送量を低減するためであるが、もちろん集約した移動可能物の位置データを含めた環境地図をセンタ情報処理端末11に送信しても良い。   Note that the aggregated movable object position data is transmitted to the center information processing terminal 11 in order to reduce the transmission amount, but of course, an environment map including the aggregated movable object position data is used as the center information processing terminal. 11 may be transmitted.

[実施の形態の効果]
以上説明した実施の形態によれば、地図再作成において次の効果を挙げることができる。
[Effect of the embodiment]
According to the embodiment described above, the following effects can be obtained in map re-creation.

移動ロボット10は、自動で自己位置を補正しつつ移動し、さらに自動で地図を再作成する。従って、恒常的に高精度の地図を作成し、ユーザの経済的、時間的負担を軽減することができる。   The mobile robot 10 moves while automatically correcting its own position, and further automatically recreates a map. Accordingly, it is possible to constantly create a high-precision map and reduce the user's economic and time burden.

更に、移動ロボット10は環境地図にある固定物に基づいて自己位置を補正し、補正した自己位置に基づいて移動可能物を特定すると共にその位置を算出する。そして、移動可能物の位置を集約して新たな移動可能物の位置を取得する。この結果、移動可能物の位置精度が良くなると共に、高精度の地図を効率的に作成することができる。   Furthermore, the mobile robot 10 corrects its own position based on a fixed object on the environment map, specifies a movable object based on the corrected self position, and calculates its position. Then, the position of the movable object is aggregated to obtain a new position of the movable object. As a result, the position accuracy of the movable object is improved and a highly accurate map can be efficiently created.

更には、移動ロボット10はLRFによる推定自己位置の算出を、環境地図に基づいて移動可能物、固定物に分けて実施する。そして、移動可能物を基にしたLRFによる推定自己位置と、固定物を基にしたLRFによる推定自己位置と、エンコーダによる推定自己位置とを融合することにより各センサの誤差を相殺することができる。その結果、精確な自己位置補正を行うことができる。   Furthermore, the mobile robot 10 performs the calculation of the estimated self-position by the LRF separately for the movable object and the fixed object based on the environment map. Then, the error of each sensor can be canceled by fusing the estimated self-position by the LRF based on the movable object, the estimated self-position by the LRF based on the fixed object, and the estimated self-position by the encoder. . As a result, accurate self-position correction can be performed.

また、移動ロボットは、作業中においてLRFでの測定値と地図情報から得られる距離との誤差の程度を表す指数値を算出して保守センタに伝送する。従って、保守センタでは、この指数値を管理することにより移動ロボットの精度検査の要否、地図再作成の要否を現地に赴かなくても把握することができる。   In addition, the mobile robot calculates an index value representing the degree of error between the LRF measurement value and the distance obtained from the map information during work, and transmits it to the maintenance center. Therefore, the maintenance center can grasp the necessity of the accuracy inspection of the mobile robot and the necessity of re-creating the map without going to the site by managing the index value.

なお、上述の実施の形態で説明した各機能は、ハードウエアを用いて構成しても良く、また、ソフトウエアを用いて各機能を記載したプログラムをコンピュータに読み込ませて実現しても良い。また、各機能は、適宜ソフトウエア、ハードウエアのいずれかを選択して構成するものであっても良い。   Each function described in the above embodiment may be configured using hardware, or may be realized by reading a program describing each function into a computer using software. Each function may be configured by appropriately selecting either software or hardware.

更に、各機能は図示しない記録媒体に格納したプログラムをコンピュータに読み込ませることで実現させることもできる。ここで本実施の形態における記録媒体は、プログラムを記録でき、かつコンピュータが読み取り可能な記録媒体であれば、その記録形式は何れの形態であってもよい。   Furthermore, each function can be realized by causing a computer to read a program stored in a recording medium (not shown). Here, as long as the recording medium in the present embodiment can record a program and can be read by a computer, the recording format may be any form.

尚、本発明は、上記実施形態そのままに限定されるものではなく、実施段階ではその要旨を逸脱しない範囲で構成要素を変形して具体化できる。
また、上記実施形態に開示されている複数の構成要素の適宜な組み合せにより種々の発明を形成できる。例えば、実施形態に示される全構成要素から幾つかの構成要素を削除してもよい。更に、異なる実施形態に亘る構成要素を適宜組み合せてもよい。
Note that the present invention is not limited to the above-described embodiment as it is, and can be embodied by modifying the constituent elements without departing from the scope of the invention in the implementation stage.
Further, various inventions can be formed by appropriately combining a plurality of constituent elements disclosed in the embodiment. For example, some components may be deleted from all the components shown in the embodiment. Furthermore, you may combine suitably the component covering different embodiment.

1…博物館、2…保守センタ、10…移動ロボット、11…センタ情報処理端末、12…インターネット、13…無線LANルータ、14…ユーザ情報処理端末、20…統括コントローラ、21…エンコーダ、22…レーザレンジファインダ、23…通信部、24…リモートコントローラ、25…データ蓄積装置、31…入出力装置、32…データ蓄積装置。     DESCRIPTION OF SYMBOLS 1 ... Museum, 2 ... Maintenance center, 10 ... Mobile robot, 11 ... Center information processing terminal, 12 ... Internet, 13 ... Wireless LAN router, 14 ... User information processing terminal, 20 ... General controller, 21 ... Encoder, 22 ... Laser Range finder, 23 ... communication unit, 24 ... remote controller, 25 ... data storage device, 31 ... input / output device, 32 ... data storage device.

本発明は、環境地図の再作成に要するコストを低減し、かつ環境地図をタイムリーに再作成することのできるロボット及び情報処理装置のプログラムに関する。 The present invention reduces the cost of re-creating the environmental map, and a program for the robot及 beauty information processing apparatus capable of re-creating an environmental map in a timely manner.

上記課題を解決するための本発明は、所定領域内を自動で移動するロボットと、該ロボットと通信回線を介して接続する情報処理装置とからなるシステムにおけるロボット及び情報処理装置の制御方法であって、前記ロボットは、前記情報処理装置からの指令または予め決められたスケジュールに従って、前記所定領域内の固定物と移動可能物との位置情報を含む地図情報に基づいて前記所定領域内を探索し、測定した固定物の位置を基に移動可能物の位置情報を収集するステップと、収集した移動可能物の位置情報を前記情報処理装置に送信するステップとを有し、前記情報処理装置は、前記ロボットにより送信された移動可能物の位置情報に基づいて地図情報を更新して提示するステップと、入力される操作指示に従って、前記ロボットの移動する経路及び動作を規定する作業シナリオと新たな地図情報とを編集するステップと、編集された前記地図情報と前記作業シナリオとを前記ロボットに送信するステップとを有し、前記ロボットは、送信された前記地図情報と前記作業シナリオとに従って前記所定領域内を自動で移動するステップを有する。 The present invention for solving the above problems is a robot and a control method for an information processing apparatus in a system including a robot that automatically moves within a predetermined area and an information processing apparatus connected to the robot via a communication line. The robot searches the predetermined area based on map information including position information of the fixed object and the movable object in the predetermined area according to a command from the information processing apparatus or a predetermined schedule. Collecting the position information of the movable object based on the measured position of the fixed object, and transmitting the collected position information of the movable object to the information processing apparatus, In accordance with the step of updating and presenting map information based on the position information of the movable object transmitted by the robot, and according to the input operation instruction Editing a work scenario that defines a moving route and an operation and new map information; and transmitting the edited map information and the work scenario to the robot. And automatically moving in the predetermined area according to the map information and the work scenario.

また本発明は、所定領域内を自動で移動するロボットと、該ロボットと通信回線を介して接続する情報処理装置とからなるシステムにおけるロボット及び情報処理装置を制御するプログラムであって、前記ロボットに搭載されたコンピュータに、前記情報処理装置からの指令または予め決められたスケジュールに従って、前記所定領域内の固定物と移動可能物との位置情報を含む地図情報に基づいて前記所定領域内を探索し、測定した固定物の位置を基に移動可能物の位置情報を収集するステップと、収集した移動可能物の位置情報を前記情報処理装置に送信するステップとを実行させ、前記情報処理装置に搭載されたコンピュータに、前記ロボットにより送信された移動可能物の位置情報に基づいて地図情報を更新して提示するステップと、入力される操作指示に従って、前記ロボットの移動する経路及び動作を規定する作業シナリオと新たな地図情報とを編集するステップと、編集された前記地図情報と前記作業シナリオとを前記ロボットに送信するステップとを実行させ、前記ロボットに搭載されたコンピュータに、送信された前記地図情報と前記作業シナリオとに従って前記所定領域内を自動で移動するステップを実行させる。 Further, the present invention is a program for controlling a robot and an information processing apparatus in a system including a robot that automatically moves within a predetermined area and an information processing apparatus connected to the robot via a communication line. In the installed computer, in accordance with a command from the information processing apparatus or a predetermined schedule, the inside of the predetermined area is searched based on map information including position information of the fixed object and the movable object in the predetermined area. Mounting the position information of the movable object on the basis of the measured position of the fixed object and the step of transmitting the collected position information of the movable object to the information processing apparatus. Updating and presenting the map information to the computer based on the position information of the movable object transmitted by the robot; Editing a work scenario that defines the path and movement of the robot and new map information in accordance with an input operation instruction; and transmitting the edited map information and the work scenario to the robot. And the computer mounted on the robot is caused to execute a step of automatically moving in the predetermined area according to the transmitted map information and the work scenario.

Claims (5)

所定領域内を自動で移動するロボットを制御するプログラムであって、
前記所定領域内の固定物の配置位置を含む地図情報を記憶するステップ、
外部から地図再作成の指示を受付けた際、前記所定領域内を前記ロボットを移動させつつ(1)乃至(5)のステップを繰返し実行するステップ、
(1)エンコーダの測定値を積算して前記ロボットの自己位置を算出するステップ、
(2)前記ロボットの所定視野角範囲内にある前記固定物及び移動可能物までの距離を水平面の特定角度毎に測定するステップ、
(3)測定した距離と、前記地図情報から得られる前記固定物までの距離とを処理して、前記算出した自己位置を補正した補正自己位置を求めるステップ、
(4)前記測定値の内、前記移動可能物までの距離を表す測定値を抽出するステップ、
(5)前記抽出した測定値と前記補正自己位置とから前記移動可能物の配置位置を算出するステップ、
前記算出した移動可能物の配置位置を集約処理して新たな配置位置を求めるステップ、
前記求めた新たな配置位置を外部に出力するステップ、
を前記ロボットに搭載されるコンピュータに実行させるためのプログラム。
A program for controlling a robot that automatically moves within a predetermined area,
Storing map information including an arrangement position of a fixed object in the predetermined area;
A step of repeatedly executing the steps (1) to (5) while moving the robot in the predetermined area when receiving an instruction to re-create the map from the outside;
(1) a step of calculating the self-position of the robot by integrating the measured values of the encoder;
(2) measuring a distance to the fixed object and the movable object within a predetermined viewing angle range of the robot for each specific angle of a horizontal plane;
(3) processing the measured distance and the distance to the fixed object obtained from the map information to obtain a corrected self-position obtained by correcting the calculated self-position;
(4) extracting a measurement value representing a distance to the movable object among the measurement values;
(5) calculating an arrangement position of the movable object from the extracted measurement value and the corrected self-position;
A step of aggregating the calculated arrangement position of the movable object to obtain a new arrangement position;
Outputting the determined new arrangement position to the outside;
For causing a computer mounted on the robot to execute the program.
請求項1に記載のプログラムであって、
前記地図情報には前記所定領域内の移動可能物の配置位置がさらに含まれ、
前記測定した距離と、前記地図情報から得られる前記固定物及び移動可能物までの距離との誤差の程度を表すそれぞれの指数を算出するステップ、
前記算出したそれぞれの指数を外部に出力するステップ、
を前記ロボットに搭載されるコンピュータに更に実行させるためのプログラム。
The program according to claim 1,
The map information further includes an arrangement position of the movable object within the predetermined area,
Calculating each index representing the degree of error between the measured distance and the distance to the fixed object and the movable object obtained from the map information;
Outputting each calculated index to the outside,
For causing the computer mounted on the robot to further execute the above.
前記集約処理では、前記算出した移動可能物の配置位置に対して間引き処理を実行することを特徴とする請求項1に記載のプログラム。   The program according to claim 1, wherein in the aggregation process, a thinning process is performed on the calculated arrangement position of the movable object. 情報処理装置のプログラムであって、
請求項1乃至3の内の1項に記載のプログラムを搭載した前記ロボットが出力した前記移動可能物についての新たな配置位置を入力するステップ、
前記新たな配置位置をユーザに提示するステップ、
この新たな配置位置に基づくユーザの操作に対応して地図を再作成するステップ、
を前記情報処理装置に搭載したコンピュータに実行させるためのプログラム。
An information processing apparatus program,
A step of inputting a new arrangement position of the movable object output by the robot loaded with the program according to claim 1;
Presenting the new location to the user;
Re-creating a map in response to a user operation based on this new location,
For causing a computer mounted on the information processing apparatus to execute the program.
情報処理装置のプログラムであって、
請求項2に記載のプログラムを搭載した前記ロボットが出力した前記固定物及び移動可能物それぞれについての誤差の程度を表す指数を入力するステップ、
前記誤差の程度を表す指数をユーザに提示するステップ、
この指数に基づくユーザの操作に対応して地図再作成の指示を前記ロボットに出力するステップ、
を前記情報処理装置に搭載したコンピュータに実行させるためのプログラム。
An information processing apparatus program,
A step of inputting an index representing a degree of error for each of the fixed object and the movable object output by the robot loaded with the program according to claim 2;
Presenting to the user an index representing the degree of the error;
Outputting a map re-creation instruction to the robot in response to a user operation based on the index;
For causing a computer mounted on the information processing apparatus to execute the program.
JP2012024994A 2012-02-08 2012-02-08 Robot and information processing apparatus program Active JP5429901B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2012024994A JP5429901B2 (en) 2012-02-08 2012-02-08 Robot and information processing apparatus program

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2012024994A JP5429901B2 (en) 2012-02-08 2012-02-08 Robot and information processing apparatus program

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP2010078912A Division JP5068840B2 (en) 2010-03-30 2010-03-30 Robot program and information processing apparatus program

Publications (2)

Publication Number Publication Date
JP2012089174A true JP2012089174A (en) 2012-05-10
JP5429901B2 JP5429901B2 (en) 2014-02-26

Family

ID=46260646

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2012024994A Active JP5429901B2 (en) 2012-02-08 2012-02-08 Robot and information processing apparatus program

Country Status (1)

Country Link
JP (1) JP5429901B2 (en)

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101508860B1 (en) 2013-12-31 2015-04-07 고려대학교 산학협력단 Method for evaluating distance type of measured distance measured by laser range finder and method for localization of mobile robot using the same
JP2015111336A (en) * 2013-12-06 2015-06-18 トヨタ自動車株式会社 Mobile robot
JP2016045330A (en) * 2014-08-22 2016-04-04 株式会社Ihi Method and device for aligning three-dimensional point group data and mobile body system thereof
JP2017107425A (en) * 2015-12-10 2017-06-15 カシオ計算機株式会社 Autonomous mobile device, autonomous moving method and program
US9802619B2 (en) 2014-11-28 2017-10-31 Murata Machinery, Ltd. Moving amount estimating apparatus, autonomous mobile body, and moving amount estimating method
JP2017538915A (en) * 2014-09-17 2017-12-28 ヴァレオ・シャルター・ウント・ゼンゾーレン・ゲーエムベーハー Positioning / mapping method and positioning / mapping system
JP2018521371A (en) * 2015-03-24 2018-08-02 エックス デベロップメント エルエルシー Associating semantic location data with automatic environment mapping
WO2018230852A1 (en) * 2017-06-15 2018-12-20 엘지전자 주식회사 Method for identifying moving object in three-dimensional space and robot for implementing same
WO2019044500A1 (en) * 2017-09-04 2019-03-07 日本電産株式会社 Location estimation system and mobile body comprising location estimation system
US10296009B2 (en) 2015-12-16 2019-05-21 Casio Computer Co., Ltd. Autonomous movement device, autonomous movement method and non-transitory recording medium
US10296002B2 (en) 2016-03-14 2019-05-21 Casio Computer Co., Ltd. Autonomous movement device, autonomous movement method, and non-transitory recording medium
WO2020054547A1 (en) 2018-09-10 2020-03-19 Telexistence株式会社 Robot control device, robot control method, and robot control system
US10970521B2 (en) 2016-12-22 2021-04-06 Toshiba Tec Kabushiki Kaisha Image processing apparatus and image processing method

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63124114A (en) * 1986-11-14 1988-05-27 Hitachi Ltd Recognizing device for environment of traveling object
JP2002215238A (en) * 2001-01-16 2002-07-31 Hokuyo Automatic Co Obstruction detection sensor for unmanned carrier
JP2003345438A (en) * 2002-05-29 2003-12-05 Mitsubishi Heavy Ind Ltd Mobile robot
JP2004033340A (en) * 2002-07-01 2004-02-05 Hitachi Home & Life Solutions Inc Robot vacuum cleaner and robot vacuum cleaner control program
JP2008250905A (en) * 2007-03-30 2008-10-16 Sogo Keibi Hosho Co Ltd Mobile robot, self-location correction method and self-location correction program
JP2009093308A (en) * 2007-10-05 2009-04-30 Hitachi Industrial Equipment Systems Co Ltd Robot system
JP2009271513A (en) * 2008-04-30 2009-11-19 Samsung Electronics Co Ltd Robot and method of building map therefor
JP2010061484A (en) * 2008-09-05 2010-03-18 Hitachi Industrial Equipment Systems Co Ltd Mobile object and recovery method from position prediction error state of mobile object

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63124114A (en) * 1986-11-14 1988-05-27 Hitachi Ltd Recognizing device for environment of traveling object
JP2002215238A (en) * 2001-01-16 2002-07-31 Hokuyo Automatic Co Obstruction detection sensor for unmanned carrier
JP2003345438A (en) * 2002-05-29 2003-12-05 Mitsubishi Heavy Ind Ltd Mobile robot
JP2004033340A (en) * 2002-07-01 2004-02-05 Hitachi Home & Life Solutions Inc Robot vacuum cleaner and robot vacuum cleaner control program
JP2008250905A (en) * 2007-03-30 2008-10-16 Sogo Keibi Hosho Co Ltd Mobile robot, self-location correction method and self-location correction program
JP2009093308A (en) * 2007-10-05 2009-04-30 Hitachi Industrial Equipment Systems Co Ltd Robot system
JP2009271513A (en) * 2008-04-30 2009-11-19 Samsung Electronics Co Ltd Robot and method of building map therefor
JP2010061484A (en) * 2008-09-05 2010-03-18 Hitachi Industrial Equipment Systems Co Ltd Mobile object and recovery method from position prediction error state of mobile object

Cited By (21)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2015111336A (en) * 2013-12-06 2015-06-18 トヨタ自動車株式会社 Mobile robot
WO2015102212A1 (en) * 2013-12-31 2015-07-09 고려대학교 산학협력단 Method for evaluating type of distance measured by laser range finder and method for estimating positon of mobile robot by using same
KR101508860B1 (en) 2013-12-31 2015-04-07 고려대학교 산학협력단 Method for evaluating distance type of measured distance measured by laser range finder and method for localization of mobile robot using the same
US10107897B2 (en) 2013-12-31 2018-10-23 Korea University Research And Business Foundation Method for evaluating type of distance measured by laser range finder and method for estimating position of mobile robot by using same
JP2016045330A (en) * 2014-08-22 2016-04-04 株式会社Ihi Method and device for aligning three-dimensional point group data and mobile body system thereof
JP2017538915A (en) * 2014-09-17 2017-12-28 ヴァレオ・シャルター・ウント・ゼンゾーレン・ゲーエムベーハー Positioning / mapping method and positioning / mapping system
US9802619B2 (en) 2014-11-28 2017-10-31 Murata Machinery, Ltd. Moving amount estimating apparatus, autonomous mobile body, and moving amount estimating method
JP2018521371A (en) * 2015-03-24 2018-08-02 エックス デベロップメント エルエルシー Associating semantic location data with automatic environment mapping
US10108199B2 (en) 2015-12-10 2018-10-23 Casio Computer Co., Ltd. Autonomous movement device, autonomous movement method and non-transitory recording medium
CN106859504A (en) * 2015-12-10 2017-06-20 卡西欧计算机株式会社 Autonomous device, autonomous method
JP2017107425A (en) * 2015-12-10 2017-06-15 カシオ計算機株式会社 Autonomous mobile device, autonomous moving method and program
US10296009B2 (en) 2015-12-16 2019-05-21 Casio Computer Co., Ltd. Autonomous movement device, autonomous movement method and non-transitory recording medium
US10296002B2 (en) 2016-03-14 2019-05-21 Casio Computer Co., Ltd. Autonomous movement device, autonomous movement method, and non-transitory recording medium
US10970521B2 (en) 2016-12-22 2021-04-06 Toshiba Tec Kabushiki Kaisha Image processing apparatus and image processing method
WO2018230852A1 (en) * 2017-06-15 2018-12-20 엘지전자 주식회사 Method for identifying moving object in three-dimensional space and robot for implementing same
KR20180136833A (en) * 2017-06-15 2018-12-26 엘지전자 주식회사 Method of identifying movable obstacle in 3-dimensional space and robot implementing thereof
KR102326077B1 (en) * 2017-06-15 2021-11-12 엘지전자 주식회사 Method of identifying movable obstacle in 3-dimensional space and robot implementing thereof
US11602850B2 (en) 2017-06-15 2023-03-14 Lg Electronics Inc. Method for identifying moving object in three-dimensional space and robot for implementing same
WO2019044500A1 (en) * 2017-09-04 2019-03-07 日本電産株式会社 Location estimation system and mobile body comprising location estimation system
WO2020054547A1 (en) 2018-09-10 2020-03-19 Telexistence株式会社 Robot control device, robot control method, and robot control system
US11911905B2 (en) 2018-09-10 2024-02-27 Telexistence Inc. Robot control apparatus, robot control method, and robot control system

Also Published As

Publication number Publication date
JP5429901B2 (en) 2014-02-26

Similar Documents

Publication Publication Date Title
JP5429901B2 (en) Robot and information processing apparatus program
JP5068840B2 (en) Robot program and information processing apparatus program
EP3660618B1 (en) Map building and positioning of robot
EP3590016B1 (en) Method and system for simultaneous localization and sensor calibration
EP3612906B1 (en) Method and system for environment map generation and alignment
KR101976241B1 (en) Map building system and its method based on multi-robot localization
CN112525202A (en) SLAM positioning and navigation method and system based on multi-sensor fusion
CN103884330A (en) Information processing method, mobile electronic device, guidance device, and server
US11797023B2 (en) Controller, control method, and program
EP4088884A1 (en) Method of acquiring sensor data on a construction site, construction robot system, computer program product, and training method
WO2020144970A1 (en) Action planning device, action planning method, and program
CN113566808A (en) Navigation path planning method, device, equipment and readable storage medium
Luo et al. Topological map generation for intrinsic visual navigation of an intelligent service robot
Zali et al. Localization of an indoor mobile robot using decentralized data fusion
CN113359739A (en) Intelligent movement device based on energy substitution technology and movement control method thereof
JP2017129681A (en) Map creation method
CN117128975B (en) Navigation method, system, medium and equipment for switch cabinet inspection operation robot
Joshi et al. Simultaneous Navigator for Autonomous Identification and Localization Robot
Du et al. Simultaneous Localization and Mapping of Mobile Robot with Research and Implementation
Zheng et al. The Navigation Based on Hybrid A Star and TEB Algorithm Implemented in Obstacles Avoidance
JP2021196489A (en) Map correction system, and map correction program
Zhang et al. Analysis on Simultaneous Localization and Mapping of Mobile Robot Based on Two Multi-sensor Fusion Algorithm
Ma et al. SLAM and Navigation of Indoor Wheeled Robot based on Ros with Intelligent Voice Recognition
Huang et al. Research on laser-based mobile robot SLAM and autonomous navigation
Chen et al. Simultaneous localization and mapping based on particle filter for sparse environment

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20120305

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20120305

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20130403

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20130416

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20130612

RD02 Notification of acceptance of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7422

Effective date: 20130806

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

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20131029

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20131128

R150 Certificate of patent or registration of utility model

Ref document number: 5429901

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250