JP2010092279A - Autonomous mobile body and movement control method for the autonomous mobile body - Google Patents
Autonomous mobile body and movement control method for the autonomous mobile body Download PDFInfo
- Publication number
- JP2010092279A JP2010092279A JP2008261821A JP2008261821A JP2010092279A JP 2010092279 A JP2010092279 A JP 2010092279A JP 2008261821 A JP2008261821 A JP 2008261821A JP 2008261821 A JP2008261821 A JP 2008261821A JP 2010092279 A JP2010092279 A JP 2010092279A
- Authority
- JP
- Japan
- Prior art keywords
- subgoal
- subgoals
- robot
- current position
- unit
- 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
Links
- 238000000034 method Methods 0.000 title claims description 20
- 238000004364 calculation method Methods 0.000 claims abstract description 55
- 238000000605 extraction Methods 0.000 claims abstract description 38
- 239000000284 extract Substances 0.000 claims abstract description 10
- 239000013598 vector Substances 0.000 claims description 24
- 238000006243 chemical reaction Methods 0.000 claims 1
- 230000007246 mechanism Effects 0.000 description 12
- 230000008859 change Effects 0.000 description 11
- 230000005540 biological transmission Effects 0.000 description 6
- 238000009499 grossing Methods 0.000 description 4
- 230000009467 reduction Effects 0.000 description 4
- 230000003068 static effect Effects 0.000 description 4
- 230000015572 biosynthetic process Effects 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 238000003786 synthesis reaction Methods 0.000 description 3
- 230000009471 action Effects 0.000 description 2
- 239000002131 composite material Substances 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 241000282414 Homo sapiens Species 0.000 description 1
- 230000012447 hatching Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
本発明は、自律移動体及び当該自律移動体の移動制御方法に関する。詳細には、ある地点から別の地点までの間に複数設定されたサブゴールを参照して移動する自律移動体に関する。 The present invention relates to an autonomous mobile body and a movement control method for the autonomous mobile body. Specifically, the present invention relates to an autonomous moving body that moves by referring to a plurality of subgoals set between a certain point and another point.
近年、オフィス及び工場等、障害物の存在する実環境で様々なサービスを提供するロボットが提案され、開発が行われている。このようなロボットには種々の機能が要求されるが、中でも重要な機能の１つに、目的地への自律的な移動がある。 In recent years, robots that provide various services in real environments where obstacles exist, such as offices and factories, have been proposed and developed. Such a robot is required to have various functions, and one of the important functions is autonomous movement to a destination.
ロボットなどの自律移動体を或る地点から目的地へと移動させる制御方法としては、分岐点、曲がり角、固定障害物の設置状況などから、環境に応じた経由地点（サブゴール）を設定し、当該サブゴールを目標にして移動させる方法が知られている。実際には障害物を回避する行動を行うこと等があるので厳密にサブゴールを辿らない場合もあるが、目的地までの間に何らかの中間的な移動目標が設定されるのが一般的である。このような構成のロボットとしては、例えば特許文献１が開示する移動ロボットがある。特許文献１が開示するのは、サブゴール間を結ぶ線分に追従して移動するロボットである。
しかし、上記のようにサブゴールを目標として移動する構成のロボットにおいては、或るサブゴールに辿り着いて移動目標を次のサブゴールに切り替えるときに、移動方向が大きく変化し、滑らかな移動を実現することが困難であった。この点、上記特許文献１では、ロボットが追従する対象とする線分をサブゴールに到達するよりも前に切り替えることで、サブゴールの近くでもロボットを滑らかに移動させることができるとしている。しかし、上記特許文献１の構成であっても、線分同士の角度が急な場合には、追従する線分の切り替え時にロボットに急な方向転換が発生してしまう。このようにロボットに急な方向転換が必要とされると、アクチュエータ（例えばモータ）の容量を大きくせざるを得ず、コストが掛かるとともに消費電力の点でも改善の余地があった。 However, in a robot configured to move with a subgoal as a target as described above, when the movement target is switched to the next subgoal when reaching a certain subgoal, the moving direction is greatly changed to realize smooth movement. It was difficult. In this regard, in Patent Document 1 described above, the robot can be moved smoothly even near the subgoal by switching the line segment that the robot follows to before reaching the subgoal. However, even in the configuration of Patent Document 1, if the angle between the line segments is steep, the robot suddenly changes direction when the following line segments are switched. Thus, when the robot needs to change direction rapidly, the capacity of the actuator (for example, a motor) has to be increased, which increases costs and leaves room for improvement in terms of power consumption.
上記のような問題を解決するため、サブゴールの設置間隔を狭くすることが考えられる。これにより、サブゴールを切り替えるときの移動方向の変化が少なくなり、ロボットの滑らかな移動を実現することができる。しかしながら、サブゴールの間隔を狭くすることにより大量のサブゴール情報をロボットに保持させなければならず、メモリなどの記憶領域を圧迫してしまう。 In order to solve the above problems, it is conceivable to reduce the installation interval of the subgoals. Thereby, the change of the moving direction when switching the subgoal is reduced, and a smooth movement of the robot can be realized. However, by reducing the interval between the subgoals, a large amount of subgoal information must be held by the robot, and the storage area such as a memory is compressed.
また、上記のようにサブゴールを目標として移動させる方法に代えて、例えば人工ポテンシャル場を環境情報として保持させ、引力ポテンシャルと斥力ポテンシャルからロボットの移動方向を演算することによってロボットを移動させる構成も考えられる。しかし、この方法においても人工ポテンシャル場を保存するために大量の記憶領域が必要であり、またポテンシャル場からロボットの移動方向を計算する際の計算負荷も大きい。 Also, instead of the method of moving the subgoal as a target as described above, for example, a configuration in which an artificial potential field is held as environmental information and the robot is moved by calculating the moving direction of the robot from the attractive potential and the repulsive potential is also considered. It is done. However, this method also requires a large storage area to store the artificial potential field, and the calculation load when calculating the moving direction of the robot from the potential field is large.
また、特許文献１は、ロボットが追従する線分を切り替える条件として、以下の２つの条件を開示している。その条件の１つ目は、ロボットが現在向かっているサブゴールと、当該ロボットと、の距離が所定の閾値よりも小さい場合である。また２つ目の条件は、ロボットが現在追従している線分と当該ロボットの位置との誤差よりも、次の線分と当該ロボットとの誤差の方が小さい場合である。 Patent Document 1 discloses the following two conditions as conditions for switching the line segment that the robot follows. The first of the conditions is when the distance between the subgoal that the robot is currently heading and the robot is smaller than a predetermined threshold. The second condition is that the error between the next line segment and the robot is smaller than the error between the line segment currently being followed by the robot and the position of the robot.
しかし、上記の条件では、ロボットが現在向かっているサブゴール上に障害物があると、追従する対象とする線分を切り替えることができず、ロボットが先に進むことができない場合があるという問題があった。即ち、上記１つ目の条件では、半径が前記所定の閾値よりも大きい障害物がサブゴール上に存在していた場合は、当該サブゴールに前記所定の閾値よりも近づくことができないので、サブゴールを切り替えることができない。また、上記２つ目の条件では、前記障害物を小さく回避した場合は、現在追従している線分からロボットの位置が大きく外れることがないので、現在追従している線分との誤差が次の線分との誤差よりも大きくならず、サブゴールを切り替えることができない。 However, under the above conditions, if there is an obstacle on the subgoal that the robot is currently facing, the line segment to be followed cannot be switched, and the robot may not be able to move forward. there were. That is, under the first condition, when an obstacle having a radius larger than the predetermined threshold exists on the subgoal, the subgoal cannot be moved closer than the predetermined threshold, so the subgoal is switched. I can't. In the second condition, if the obstacle is avoided small, the robot position does not deviate greatly from the currently following line segment. It is not larger than the error with the line segment, and the subgoal cannot be switched.
本願発明は以上の事情に鑑みてされたものであり、その主要な目的は、記憶領域と演算量を抑えつつ目的地まで滑らかに移動することが可能な自律移動体を提供することにある。 The present invention has been made in view of the above circumstances, and a main object thereof is to provide an autonomous mobile body capable of smoothly moving to a destination while suppressing a storage area and a calculation amount.
本発明の解決しようとする課題は以上の如くであり、次にこの課題を解決するための手段とその効果を説明する。 The problems to be solved by the present invention are as described above. Next, means for solving the problems and the effects thereof will be described.
本発明の観点によれば、以下の構成の自律移動体が提供される。即ち、この自律移動体は、サブゴール記憶部と、現在位置取得部と、最短サブゴール探索部と、サブゴール抽出部と、仮想移動目標演算部と、を備える。前記サブゴール記憶部は、第１地点から第２地点に至るまでの経路に複数設定されたそれぞれのサブゴールの位置と、前記第１地点又は前記第２地点からの前記サブゴールの順序と、を記憶している。前記現在位置取得部は、自機の現在位置を取得する。前記最短サブゴール探索部は、前記サブゴール記憶部が記憶しているサブゴールの中で、前記現在位置から最短距離にあるサブゴールを探索する。前記サブゴール抽出部は、前記最短距離にあるサブゴールを含み、前記現在位置を中心とした所定領域内に位置するサブゴールを抽出する。前記仮想移動目標演算部は、前記サブゴール抽出部によって抽出された各サブゴールの位置に基づいて自機の仮想的な移動目標を演算する。 According to the viewpoint of this invention, the autonomous mobile body of the following structures is provided. That is, the autonomous mobile body includes a subgoal storage unit, a current position acquisition unit, a shortest subgoal search unit, a subgoal extraction unit, and a virtual movement target calculation unit. The subgoal storage unit stores a plurality of subgoal positions set on a route from the first point to the second point, and the order of the subgoals from the first point or the second point. ing. The current position acquisition unit acquires the current position of the own device. The shortest subgoal search unit searches for a subgoal at the shortest distance from the current position among the subgoals stored in the subgoal storage unit. The subgoal extraction unit extracts a subgoal that includes the subgoal at the shortest distance and is located within a predetermined area centered on the current position. The virtual movement target calculation unit calculates a virtual movement target of the own device based on the position of each subgoal extracted by the subgoal extraction unit.
以上の構成で、移動体の近傍に複数のサブゴールがある場合、当該複数のサブゴールの位置を総合的に考慮して仮想的な移動目標を決定することができる。これにより、１つのサブゴールのみを移動目標として移動する構成と比べて、移動目標が大きく変化することがなくなり、円滑な移動を行うことができる。従って、サブゴールを切り替える際の急な方向転換が発生しにくくなるので、アクチュエータの負荷を抑えることが可能となり、省電力化及びコストダウンを実現することができる。また、移動を円滑にするためにサブゴールを細かい間隔で設定する必要が無いので、サブゴール記憶部の記憶容量等を抑えることができる。また、サブゴールへの到達を目標とするのではなく、サブゴールから求めた仮想的な移動目標に追従するように移動することで、サブゴールに到達することなく第２地点まで移動することが可能である。即ち、必ずしもサブゴールの近傍を経由する必要がないので、サブゴール上に障害物がある場合や、障害物回避により経路から外れた場合であっても、従来の構成のように先に進めなくなることが無く、第２地点に向かって効率的な移動が可能になる。 With the above configuration, when there are a plurality of subgoals in the vicinity of the moving body, it is possible to determine a virtual movement target by comprehensively considering the positions of the plurality of subgoals. Thereby, compared with the structure which moves only one subgoal as a movement target, a movement target does not change a lot and smooth movement can be performed. Therefore, since a sudden change of direction when switching the subgoals is less likely to occur, it is possible to suppress the load on the actuator, and to realize power saving and cost reduction. Further, since it is not necessary to set the subgoals at fine intervals in order to make the movement smooth, the storage capacity of the subgoal storage unit can be suppressed. In addition, it is possible to move to the second point without reaching the subgoal by moving to follow the virtual moving target obtained from the subgoal instead of aiming at reaching the subgoal. . In other words, it is not always necessary to go through the vicinity of the subgoal, so even if there is an obstacle on the subgoal or when it is off the route due to obstacle avoidance, it may not proceed as in the conventional configuration. There is no efficient movement toward the second point.
前記の自律移動体においては、以下のように構成されていることが好ましい。即ち、前記仮想移動目標演算部は、前記サブゴール抽出部によって抽出された前記各サブゴールの位置を、前記現在位置を原点とする相対座標に座標変換する。そして、前記仮想移動目標演算部は、当該相対座標における前記各サブゴールの位置ベクトルを合成した合成ベクトルの方向に基づいて前記仮想的な移動目標を演算する。 The autonomous mobile body is preferably configured as follows. That is, the virtual movement target calculation unit converts the position of each subgoal extracted by the subgoal extraction unit into relative coordinates with the current position as the origin. Then, the virtual movement target calculation unit calculates the virtual movement target based on the direction of a combined vector obtained by combining the position vectors of the subgoals in the relative coordinates.
これにより、複数のサブゴールを考慮しつつ、ベクトルの合成という比較的簡単な演算によって移動体の仮想的な移動目標を決定することができる。 Thereby, the virtual movement target of the moving body can be determined by a relatively simple calculation of vector synthesis while considering a plurality of subgoals.
前記の自律移動体においては、前記サブゴール抽出部は、前記所定領域の外側近傍に位置するサブゴールがある場合は、当該サブゴールの位置を前記所定領域の境界上に置換して追加的に抽出することが好ましい。 In the autonomous mobile body, when there is a subgoal located near the outside of the predetermined area, the subgoal extraction unit additionally extracts the subgoal by replacing the position of the subgoal on the boundary of the predetermined area. Is preferred.
これにより、遠い位置にあるサブゴールを予め考慮に入れておくことができるので、より滑らかに移動することができる。また、所定領域の境界上の位置に置換することにより、相対座標に座標変換したときの位置ベクトルの長さを制限できるので、遠い位置のサブゴールと近い位置のサブゴールをバランス良く考慮して移動することができる。 Thereby, since the subgoal in a far position can be taken into consideration beforehand, it can move more smoothly. In addition, by replacing the position with the position on the boundary of the predetermined area, the length of the position vector when the coordinate is converted into relative coordinates can be limited, so that the subgoal at a position close to the subgoal at a far position is moved in a balanced manner. be able to.
前記の自律移動体においては、前記仮想移動目標演算部は、前記現在位置を中心とした所定領域内に位置するサブゴールのうち、前記最短距離にあるサブゴールよりも前記第１地点側であるサブゴールを除いた残りの各サブゴールの位置に基づいて、自機の仮想的な移動目標を演算することが好ましい。 In the autonomous mobile body, the virtual movement target calculation unit calculates a subgoal that is closer to the first point than a subgoal that is at the shortest distance among subgoals that are located within a predetermined area centered on the current position. It is preferable to calculate the virtual movement target of the own device based on the positions of the remaining subgoals.
これにより、最短距離にあるサブゴールと、それより第２地点側のサブゴールのみを考慮して移動方向を決定できるので、第２地点に対してより効率良く移動することができる。 As a result, since the moving direction can be determined in consideration of only the subgoal that is at the shortest distance and the subgoal on the second point side from that, it is possible to move more efficiently to the second point.
本発明の別の観点によれば、第１地点から第２地点に至るまでの経路に複数設定されたそれぞれのサブゴールの位置と、前記第１地点又は第２地点からの前記サブゴールの順序と、を記憶したサブゴール記憶部を備えた自律移動体の移動制御方法であって、以下のステップを含む移動制御方法が提供される。即ち、この自律移動体の移動制御方法は、現在位置取得ステップと、最短サブゴール探索ステップと、サブゴール抽出ステップと、仮想移動目標演算ステップと、を含んでいる。前記現在位置取得ステップでは、自機の現在位置を取得する。前記最短サブゴール探索ステップでは、前記サブゴール記憶部が記憶しているサブゴールの中で、前記現在位置から最短距離にあるサブゴールを探索する。前記サブゴール抽出ステップでは、前記最短距離にあるサブゴールを含み、前記現在位置を中心とした所定領域内に位置するサブゴールを抽出する。前記仮想移動目標演算ステップでは、前記サブゴール抽出ステップで抽出された各サブゴールの位置に基づいて自機の仮想的な移動目標を演算する。 According to another aspect of the present invention, the position of each subgoal set in a plurality of paths from the first point to the second point, the order of the subgoals from the first point or the second point, There is provided a movement control method for an autonomous mobile body including a subgoal storage unit that stores the following, which includes the following steps. That is, this autonomous mobile body movement control method includes a current position acquisition step, a shortest subgoal search step, a subgoal extraction step, and a virtual movement target calculation step. In the current position acquisition step, the current position of the own device is acquired. In the shortest subgoal search step, a subgoal located at the shortest distance from the current position is searched for among the subgoals stored in the subgoal storage unit. In the subgoal extraction step, a subgoal that includes the subgoal at the shortest distance and is located within a predetermined area centered on the current position is extracted. In the virtual movement target calculation step, the virtual movement target of the own device is calculated based on the position of each subgoal extracted in the subgoal extraction step.
以上の方法で、移動体の近傍に複数のサブゴールがある場合、当該複数のサブゴールの位置を総合的に考慮して仮想的な移動目標を決定することができる。これにより、１つのサブゴールのみを移動目標として移動する構成と比べて、移動目標が大きく変化することがなくなり、円滑な移動を行うことができる。従って、サブゴールを切り替える際の急な方向転換が発生しにくくなるので、アクチュエータの負荷を抑えることが可能となり、省電力化及びコストダウンを実現することができる。また、移動を円滑にするためにサブゴールを細かい間隔で設定する必要が無いので、サブゴール記憶部の記憶容量等を抑えることができる。また、サブゴールへの到達を目標とするのではなく、サブゴールから求めた仮想的な移動目標に追従するように移動することで、サブゴールに到達することなく第２地点まで移動することが可能である。即ち、必ずしもサブゴールの近傍を経由する必要がないので、サブゴール上に障害物がある場合や、障害物回避により経路から外れた場合であっても、従来の構成のように先に進めなくなることが無く、第２地点に向かって効率的な移動が可能になる。 With the above method, when there are a plurality of subgoals in the vicinity of the moving body, it is possible to determine a virtual movement target by comprehensively considering the positions of the plurality of subgoals. Thereby, compared with the structure which moves only one subgoal as a movement target, a movement target does not change a lot and smooth movement can be performed. Therefore, since a sudden change of direction when switching the subgoals is less likely to occur, it is possible to suppress the load on the actuator, and to realize power saving and cost reduction. Further, since it is not necessary to set the subgoals at fine intervals in order to make the movement smooth, the storage capacity of the subgoal storage unit can be suppressed. In addition, it is possible to move to the second point without reaching the subgoal by moving to follow the virtual moving target obtained from the subgoal instead of aiming at reaching the subgoal. . In other words, it is not always necessary to go through the vicinity of the subgoal, so even if there is an obstacle on the subgoal or when it is off the route due to obstacle avoidance, it may not proceed as in the conventional configuration. There is no efficient movement toward the second point.
次に、発明の実施の形態を説明する。図１は本発明の一実施形態に係るロボット１１の全体的な構成を模式的に示した側面図である。
Next, embodiments of the invention will be described. FIG. 1 is a side view schematically showing the overall configuration of a
図１に示す自律移動体としてのロボット１１は、本体１２と、オムニホイール機構（移動部）１３と、レーザレンジファインダ（検知部）１４と、走行制御コントローラ（移動制御部）１５と、を備えている。
A
前記本体１２は縦方向に細長く形成されており、その下端部に、ロボットを自走させるためのオムニホイール機構１３が取り付けられている。オムニホイール機構１３は、周方向に９０°の間隔で並べて配置された４つのオムニホイール２１と、このオムニホイール２１に対応して設置される４つのモータ２２と、を備えている。
The
以下、図２を参照して、オムニホイール機構１３の構成を具体的に説明する。図２はオムニホイール機構１３を示す底面図である。
The configuration of the
このオムニホイール機構１３は図２に示すように、前記本体１２の底面に配置された４つのホイール駆動ユニット２３を備えている。このホイール駆動ユニット２３は、枠組状に形成されたモータ支持フレーム２４と、このモータ支持フレーム２４に固定されたモータ２２と、を備えている。前記モータ支持フレーム２４の一端部は、本体１２の底面にブラケット２５を介して固定されている。
As shown in FIG. 2, the
モータ２２は、図略のロータを回転可能に支持するハウジング２６を備え、このハウジング２６は前記モータ支持フレーム２４の内部に配置されている。モータ２２の出力軸２７はモータ支持フレーム２４から外側へ突出しており、この出力軸２７の端部に前記オムニホイール２１が取り付けられている。それぞれのホイール駆動ユニット２３におけるオムニホイール２１は、その回転軸がロボット１１の正面方向に対してなす角が４５°又は１３５°となるように配置されている。
The
それぞれのオムニホイール２１は、前記モータ２２の出力軸２７に固定されるローラ状の本体３１と、この本体３１の外周に並べて配置された複数のフリーローラ３２と、を備えている。フリーローラ３２は回転可能となるように本体３１に支持され、当該フリーローラ３２の外周面は床面に接触可能となっている。また、前記フリーローラ３２の回転軸は、本体３１の回転軸に対して垂直に向けられている。
Each
この構成で、モータ２２が駆動されて本体３１が回転することにより、フリーローラ３２は本体３１と一体的に回転し、その駆動力を床面に伝達する。一方、接地しているフリーローラ３２が回転することにより、オムニホイール２１は、その本体３１の回転軸に平行な方向にも容易に移動することができる。以上の構成により、ロボット１１の全方位移動が実現される。
With this configuration, when the
４つのホイール駆動ユニット２３が備えるモータ２２は、走行制御コントローラ１５からの走行指令（移動指令）に基づき、４つのオムニホイール２１の回転方向及び回転速度をそれぞれ独立して制御する。これにより、ロボット１１を任意の方向に移動させる制御（全方位移動制御）を実現している。
The
図１に示すレーザレンジファインダ１４は、図略のトランスミッタから照射したレーザを回転ミラーで反射させることで、ロボット１１の正面側を平面視で扇状に走査することができる。そして、照射されたレーザが物体で反射して戻ってくるまでの時間を計測することにより、物体までの距離を測定することができる。このレーザレンジファインダ１４はロボット１１の視覚を実現する手段として使用され、静止又は移動している物体（障害物）の検知等に用いられる。
The
次に、図３を参照して走行制御コントローラ１５について説明する。図３はロボット１１の移動制御のための電気的構成を示すブロック図である。
Next, the
走行制御コントローラ１５はマイクロコンピュータとして構成されており、図示しないが、演算部としてのＣＰＵと、記憶部としてのＲＯＭ、ＲＡＭ等を備えている。また、前記ＲＯＭには、ロボット１１の自律的な移動を実現するための制御プログラムが記憶されている。
The
図３に示すように、走行制御コントローラ１５は、マップ記憶部５１と、目標位置記憶部５２と、自機情報取得部５３と、障害物情報取得部５４と、を備えている。また、走行制御コントローラ１５は、サブゴール演算部５５と、サブゴール記憶部５６と、最短サブゴール探索部５７と、サブゴール抽出部５８と、仮想移動目標演算部５９と、走行指令送信部６４と、を備えている。これらの各部は、上述したハードウェアとソフトウェアの組合せにより構築されている。
As illustrated in FIG. 3, the
マップ記憶部５１は、ロボット１１の行動範囲における静的障害物を示すマップを記憶可能に構成されている。ここで静的障害物とは、消えたり位置が変化したりすることのない障害物をいい、具体的には壁、柱等の静的構造物及び重量物等である。このマップを作成するには、人間等の動的障害物を全て取り除いた状態で、当該ロボット１１を移動させつつ、レーザレンジファインダ１４で障害物を走査する。これにより、ロボット１１は静的障害物の位置及び形状を認識してマップを自動的に作成し、適宜のメモリに記憶することができる。
The
目標位置記憶部５２は、ロボット１１を移動させるべき目標位置の情報を記憶可能に構成されている。この目標位置は、オペレータがロボット１１を適宜操作することにより指定され、前記マップにおける座標の形で記憶される。
The target
自機情報取得部５３は、自機の現在位置及び速度を計算して取得する。従って、この自機情報取得部５３は現在位置取得部であるといえる。この自機情報は、レーザレンジファインダ１４から得られた周囲の障害物の情報と前記マップとを照合した結果と、オムニホイール機構１３の各モータ２２の出力軸２７の回転角度の情報と、を総合的に考慮して決定される。なお、モータ２２の出力軸２７の回転角度は、当該出力軸２７に取り付けられた図略のエンコーダにより取得することができる。
The own device
障害物情報取得部５４は、レーザレンジファインダ１４から得られた、ロボット動作中にロボットが所有している環境地図上にない静止又は移動している障害物を検出し、その位置及び速度を取得する。
The obstacle
サブゴール演算部５５は、当該ロボット１１がセットされた初期位置（ロボット１１の現在位置を含む）と、目標位置記憶部５２に記憶された目標位置と、の間を移動するための経路を計画し、当該経路中に経過目標地点としてのサブゴールを複数設定する。なお、サブゴールの設定については後述する。
The
サブゴール記憶部５６は、サブゴール演算部５５が設定した各サブゴールの位置、及び初期位置から目標位置に至るまでの順番を記憶可能に構成されている。
The
最短サブゴール探索部５７は、サブゴール記憶部５６が記憶しているサブゴールの中で、自機情報取得部５３が取得した現在位置から最も近いサブゴールを探索するように構成されている。
The shortest
サブゴール抽出部５８は、サブゴール記憶部５６が記憶しているサブゴールの中で、自機情報取得部５３が取得した現在位置から所定距離内に位置しているサブゴールを抽出するように構成されている。なお、サブゴールの抽出については後述する。
The
仮想移動目標演算部５９は、サブゴール抽出部５８の抽出結果に基づいて、当該ロボット１１の仮想的な移動目標（仮想移動目標）を演算するように構成されている。なお、仮想移動目標の演算については後述する。
The virtual movement
走行指令送信部６４は、仮想移動目標演算部５９で得られた仮想移動目標に対してロボット１１を移動させるように走行指令を生成し、オムニホイール機構１３に対し送信することにより、ロボット１１を走行させる。
The travel
次に、以上のように構成されたロボット１１の自律移動の制御方法について、図４を参照して説明する。図４は、本実施形態のロボット１１の走行制御コントローラ１５が、当該ロボット１１の自律移動のために行う制御の流れを示したフローチャートである。なお、このフローの開始時点で、マップ記憶部５１にはマップが、目標位置記憶部５２には目標位置が、予め記憶されているものとする。
Next, a method of controlling the autonomous movement of the
まず、オペレータはロボット１１を所望の初期位置に配置して所定の操作を行う（Ｓ１０１）。これにより、図５のフローが開始される。
First, the operator places the
次に、サブゴール演算部５５によってサブゴールの設定処理（目標位置までの経路計画）が行われる（Ｓ１０２）。以下、このサブゴールの設定処理について具体的に説明する。
Next, the
一例として、図５に示すようなマップがマップ記憶部５１に記憶されている場合について説明する。図に示すように、このマップは障害物１６が存在する領域と存在しない領域を表した図であって、ロボット１１の移動平面における障害物１６の位置及びサイズが記憶されている。なお、参考のため、図５のマップの右側にはロボット１１の直径を表す円が図示されている。この図５に示すように、マップにおいてロボット１１を、その平面視での外形輪郭を含む適宜の大きさの円として表現することにより、制御を簡素化でき、演算負荷を減らすことができる。
As an example, a case where a map as shown in FIG. 5 is stored in the
まず、サブゴール演算部５５は、マップ記憶部５１から前記マップを読み込み、ロボット１１と障害物１６との領域の和（Ｍｉｎｋｏｗｓｋｉ和）を求める。このとき、ロボット１１の領域（形状）は、前述したように円形とすることができる。このようにＭｉｎｋｏｗｓｋｉ和を求めた結果の例が図６に示してある。この図６は、斜線のハッチングが施された領域にロボット１１の円の中心点が接触しないように制御する限り、ロボット１１が障害物１６に接触することを回避できることを表している。これにより、以降の処理ではロボット１１を点として取り扱うことができる。
First, the
次に、サブゴール演算部５５は、図６に示す斜線のハッチングが施されていない領域（即ち、ロボット１１が通過することができる領域）を、公知のＨｉｌｄｉｔｃｈの細線化条件によって細線化する。この細線化の結果の例を図７に示す。このとき細線化によって得られた線のそれぞれは、ロボット１１が採り得る大まかな経路として考えることができる。
Next, the
次に、サブゴール演算部５５は、目標位置記憶部５２から目標位置の座標を読み込むとともに、自機情報取得部５３によってロボット１１の現在位置（前記マップ上の座標（絶対座標）で表した位置）の取得を行う。この時点においてはロボット１１は未だ移動を開始していないので、このとき取得した現在位置がロボット１１の初期位置（移動開始位置）となる。
Next, the
更に、サブゴール演算部５５は、細線化によって得られた経路の各分岐点にサブゴールノード７２を配置する。このときの内部的な様子を概念的に例示すると、図８のようになる。例えば、図に示すように、サブゴール演算部５５の演算開始時点におけるロボット１１の現在位置が符号７０の位置であると、その位置が初期位置（第１地点）７０として設定される。また、図８には、目標位置記憶部５２に記憶されている目標位置（第２地点）７１も図示してある。そして、図に示すように、初期位置７０と目標位置７１との間の経路の各分岐点には、それぞれサブゴールノード７２が配置されている。
Further, the
続いて、サブゴール演算部５５は、初期位置７０から目標位置７１までの最短経路を探索する。本実施形態では、公知のＡ＊アルゴリズムを用いて最短経路の探索を行う。このとき、或るサブゴールノード７２から目標位置７１までの移動コストを表すヒューリスティック関数として、当該サブゴールノード７２から目標位置７１までのユークリッド距離を用いることにより、演算量を削減することができる。上記の最短経路探索で決定された最短経路の例を、図９に太線で表す。
Subsequently, the
上記のようにして初期位置７０から目標位置７１までの最短経路を決定した後、サブゴール演算部５５は、障害物１６と干渉しない範囲で経路の直線化を行う。直線化を行った結果の例を図１０に示す。続いて、サブゴール演算部５５は、経路の平滑化（障害物１６と干渉しない範囲で経路の角を丸めること）を行う。平滑化を行った結果の例を図１１に示す。
After determining the shortest path from the
以上のようにして、初期位置７０から目標位置７１までの間に複数のサブゴールノード７２が配置されて、ロボット１１の移動経路が確定する。最終的に得られた各サブゴールノード７２の位置を、ロボット１１の自律移動制御に実際に用いるサブゴールの位置とする。そして、上記のようにして得られた各サブゴールの順序と、当該サブゴールの位置（マップ上の絶対座標で表した座標）が、サブゴール記憶部５６に記憶される。なお、本実施形態においてサブゴールの順序は、初期位置７０に最も近いものが１番目、次に近いのが２番目、・・・というように定められ、この順序を表す数値データがサブゴール記憶部５６に記憶される。
As described above, a plurality of
サブゴールが設定されると、走行制御コントローラ１５は、ロボット１１の自律移動を開始する（図４のＳ１０３）。走行制御コントローラ１５は、以下に説明する自律制御ループ（図４のＳ１０４からＳ１１１）を繰り返し実行することにより、目標位置までロボット１１の自律移動制御を行う。以下、一例として、サブゴールが図１２のように設定されている場合について説明する。図１２には、サブゴール記憶部５６が記憶している複数のサブゴール８１，８２，８３，８４，８５の位置を絶対座標系（図中のｘｙ直交座標系）にプロットした様子を概念的に示してある。また、図１２には、目標位置記憶部５２が記憶している目標位置９０と、自機情報取得部５３が取得したロボット１１の現在位置もプロットして示してある。図に示すように、サブゴールが８１，８２，８３，８４，８５の順で設定され、最後に目標位置９０が設定されている。
When the subgoal is set, the
まず、自機情報取得部５３が、ロボット１１の現在位置を取得する（現在位置取得ステップ、Ｓ１０４）。
First, the own device
そして、取得した現在位置が目標位置に到達していれば（Ｓ１０５の判断）、自律移動の目的を達成しているので、自律制御ループを抜けてフローを終了する。 If the acquired current position has reached the target position (determination in S105), the object of autonomous movement has been achieved, and the flow is terminated through the autonomous control loop.
ロボット１１が未だ目標位置に到達していない場合は、現在位置から直線距離で最短距離にあるサブゴールを探索する（最短サブゴール探索ステップ、Ｓ１０６）。図１２の場合においては、ロボット１１の現在位置から最短距離にあるのはサブゴール８２であるから、サブゴール８２が選択される。
If the
続いて、サブゴール抽出部５８によって、最短距離にあるサブゴールを含む所定領域内のサブゴールの抽出が行われる（サブゴール抽出ステップ、Ｓ１０７）。以下、この点について具体的に説明する。
Subsequently, the
前記の所定領域としては、例えば図１３に示すように、ロボット１１を中心とした所定半径の領域円１００の内側の領域とすることができる。なお、最短距離のサブゴール８２を領域円１００内に含ませるために、前記領域円１００の半径としては、当該サブゴール８２とロボット１１との間の距離以上の値を設定するものとする。図１３の例では、領域円１００の内側にはサブゴール８１，８２，８３があるので、前記サブゴール８１，８２，８３が抽出される。
As the predetermined region, for example, as shown in FIG. 13, a region inside a
更に、サブゴール抽出部５８は、所定領域の外側に位置するものの前記所定領域に近いサブゴールを領域の外周上にあるものとみなして、サブゴールを追加的に抽出することができる。例えば図１３の例では、領域円１００の外側近傍にサブゴール８４が位置している。このサブゴール８４とロボット１１とを結んだ直線と前記領域円１００との交点（領域円１００の外周上）を求め、この交点上にサブゴール８４の位置を置き換える（置換サブゴール８６）。この置換サブゴール８６をロボット１１から見た方向は、元のサブゴール８４をロボット１１から見た方向と一致する。そして、この置換サブゴール８６をサブゴールの抽出結果に含めることで、遠い位置にあるサブゴールを予め考慮することにより滑らかな移動を実現することができる。また、遠い位置にあるサブゴールを領域の外周上に置換しているので、ベクトル合成（後述）の際に、遠い位置にある（即ちベクトルが大きい）サブゴールの影響が過大になってしまうことを回避することができる。
Further, the
次に、サブゴール抽出部５８は、サブゴール記憶部５６に記憶されているサブゴールの順番を取得し、現在位置から最短距離にあるサブゴールよりも順序が前（即ち、初期位置７０側）のサブゴールを、前記抽出結果から取り除く。図１３の例では、抽出されたサブゴールの中で、最短距離のサブゴール８２よりも前のサブゴールはサブゴール８１であるので、このサブゴール８１を取り除く。即ち、ロボット１１はサブゴール８１を既に通り過ぎていると見なせるので、自律移動の考慮の対象から除外するのである。
Next, the
なお、サブゴールの順序は当初から決まっているので、領域円１００の内側のサブゴールを抽出する段階で、最短距離のサブゴール８２よりも順序が前のサブゴール８１を除いた状態で抽出することもできる。このようにすれば、所定領域内にあるか否かをサブゴール抽出部５８で判断しなければならないサブゴールの数が減るので、演算量を削減できる点で有利である。要は、後述の仮想移動目標演算部５９による仮想移動目標８８の演算の際に、当該サブゴール８１の位置を考慮に入れずに計算することができれば良い。
In addition, since the order of the subgoals is determined from the beginning, it is also possible to extract the subgoals in the state where the
次に、仮想移動目標演算部５９によって、ロボット１１の仮想的な移動目標が演算される（仮想移動目標演算ステップ、Ｓ１０８）。以下、この点について具体的に説明する。
Next, the virtual movement
まず、仮想移動目標演算部５９は、サブゴール抽出部５８によって抽出されたサブゴール（前記の例の場合は、サブゴール８２，８３及び置換サブゴール８６）の座標を、ロボット１１の相対座標系（ローカル座標系）に座標変換する。この相対座標系は任意の座標系とすることができるが、例えば図１３に示すｖ軸とｗ軸による直交座標系のようにロボット１１を座標中心（原点）とした直交座標系とすれば、後述のベクトル合成の演算が簡単になるため好適である。抽出されたサブゴールを相対座標系に座標変換してプロットした概念的な様子を図１４に示す。
First, the virtual movement
続いて、仮想移動目標演算部５９は、前記相対座標系において、ロボット１１の現在位置から各サブゴールへ向かうベクトルを求め、それぞれのベクトルを合成した合成ベクトルを求める。図１４の例では、ロボット１１は相対座標系の原点に位置しているので、各サブゴール（サブゴール８２，８３及び置換サブゴール８６）の位置ベクトルを求め、各位置ベクトルを合成することで合成ベクトル８７を得る。
Subsequently, the virtual movement
そして、仮想移動目標演算部５９は、合成ベクトル８７と領域円１００との交点に、仮想移動目標８８を配置する。なお、合成ベクトル８７の長さが領域円１００の半径よりも短い場合は、合成ベクトル８７の延長線と領域円１００との交点に仮想移動目標８８を配置すれば良い。
Then, the virtual movement
以上のようにして仮想移動目標８８が得られると、走行指令送信部６４は、仮想移動目標８８の位置を絶対座標系に座標変換する。図１５に、仮想移動目標８８を絶対座標系にプロットした様子を概念的に示す。そして、走行指令送信部６４は、この仮想移動目標８８に向かってロボット１１を移動するように、オムニホイール機構１３に対して走行指令を送信する（図４のＳ１０９）。なお、このときのロボット１１の移動速度は、前記合成ベクトル８７の大きさに関係した速度でも良いし、これとは全く別に決定されても良い。
When the
ロボット１１の移動中においては、障害物情報取得部５４がレーザレンジファインダ１４から障害物に関する情報を取得する。そして、障害物があった場合（Ｓ１１０の判断）は、走行指令送信部６４は、オムニホイール機構１３を駆動して、ロボット１１を当該障害物から回避させるように移動させる（Ｓ１１１）。
While the
以上の処理が終了した場合、走行制御コントローラ１５はＳ１０４のステップまで戻り、ロボット１１の制御周期毎に前記処理（Ｓ１０４からＳ１１１の処理）を繰り返し実行する。このループ処理により、仮想移動目標８８の位置は、ロボット１１の移動に伴って常に更新され続ける。従って、ロボット１１は、一定距離離れた仮想移動目標８８を常に追いかけるようにして移動することになる。これにより、サブゴールの絶対位置を目標として移動する構成に比べ、滑らかな移動目標を生成することが可能となり、ロボット１１の滑らかな移動制御を実現することができるのである。また、ロボット１１は仮想移動目標８８を目標として移動しているので、サブゴール上に障害物があった場合であっても、当該障害物によって進めなくなることがなく、目的地に向かって移動を続けることができる。
When the above processing is completed, the traveling
以上で説明したように、本実施形態のロボット１１は、サブゴール記憶部５６と、自機情報取得部５３と、最短サブゴール探索部５７と、サブゴール抽出部５８と、仮想移動目標演算部５９と、を備えている。サブゴール記憶部５６は、初期位置から目標位置に至るまでの経路に複数設定されたそれぞれのサブゴールの位置と、初期位置からの前記サブゴールの順序と、を記憶している。自機情報取得部５３は、自機の現在位置を取得する。最短サブゴール探索部５７は、サブゴール記憶部５６が記憶しているサブゴールの中で、現在位置から最短距離にあるサブゴールを探索する。サブゴール抽出部５８は、前記最短距離にあるサブゴールを含み、現在位置を中心とした所定領域内に位置するサブゴールを抽出する。仮想移動目標演算部５９は、サブゴール抽出部５８によって抽出された各サブゴールの位置に基づいて仮想移動目標８８を演算する。
As described above, the
以上の構成で、ロボット１１の近傍に複数のサブゴールがある場合、当該複数のサブゴールの位置を総合的に考慮して仮想移動目標８８を決定することができる。これにより、１つのサブゴールのみを移動目標として移動する構成と比べて、移動目標が大きく変化することがなくなり、円滑な移動を行うことができる。従って、サブゴールを切り替える際の急な方向転換が発生しにくくなるので、アクチュエータの負荷を抑えることが可能となり、省電力化及びコストダウンを実現することができる。また、移動を円滑にするためにサブゴールを細かい間隔で設定する必要が無いので、サブゴール記憶部５６の記憶容量等を抑えることができる。また、サブゴールへの到達を目標とするのではなく、サブゴールから求めた仮想的な移動目標に追従するように移動することで、サブゴールに到達することなく目標位置まで移動することが可能である。即ち、必ずしもサブゴールの近傍を経由する必要がないので、サブゴール上に障害物がある場合や、障害物回避により経路から外れた場合であっても、従来の構成のように先に進めなくなることが無く、目標位置に向かって効率的な移動が可能になる。
With the above configuration, when there are a plurality of subgoals in the vicinity of the
また、本実施形態のロボット１１は、以下のように構成されている。即ち、仮想移動目標演算部５９は、サブゴール抽出部５８によって抽出された各サブゴールの位置を、現在位置を原点とする相対座標に座標変換する。そして、仮想移動目標演算部５９は、相対座標における各サブゴールの位置ベクトルを合成した合成ベクトル８７の方向に基づいて仮想移動目標８８を演算する。
Further, the
これにより、複数のサブゴールを考慮しつつ、ベクトルの合成という比較的簡単な演算によってロボット１１の仮想移動目標８８を決定することができる。
Thereby, the
また、本実施形態のロボット１１において、サブゴール抽出部５８は、前記所定領域の外側近傍に位置するサブゴールがある場合は、当該サブゴールの位置を前記所定領域の境界上に置換して追加的に抽出している。
Further, in the
これにより、遠い位置にあるサブゴールを予め考慮に入れておくことができるので、より滑らかに移動することができる。また、所定領域の境界上の位置に置換することにより、相対座標に座標変換したときの位置ベクトルの長さを制限できるので、遠い位置のサブゴールと近い位置のサブゴールをバランス良く考慮して移動することができる。 Thereby, since the subgoal in a far position can be taken into consideration beforehand, it can move more smoothly. In addition, by replacing the position with the position on the boundary of the predetermined area, the length of the position vector when the coordinate is converted into relative coordinates can be limited, so that the subgoal at a position close to the subgoal at a far position is moved in a balanced manner. be able to.
また、本実施形態のロボット１１において、仮想移動目標演算部５９は、自機の現在位置を中心とした所定領域内に位置するサブゴールのうち、前記最短距離にあるサブゴールよりも初期位置側であるサブゴールを除いた残りの各サブゴールの位置に基づいて、仮想移動目標８８を演算している。
Further, in the
これにより、最短距離にあるサブゴールと、それより目標位置側のサブゴールのみを考慮して移動方向を決定できるので、目標位置に対してより効率良く移動することができる。 As a result, the moving direction can be determined in consideration of only the subgoal at the shortest distance and the subgoal closer to the target position, so that it is possible to move more efficiently with respect to the target position.
また、本実施形態のロボット１１の移動制御方法は、現在位置取得ステップ（Ｓ１０４）と、最短サブゴール探索ステップ（Ｓ１０６）と、サブゴール抽出ステップ（Ｓ１０７）と、仮想移動目標演算ステップ（Ｓ１０８）と、を含んでいる。現在位置取得ステップでは、自機の現在位置を取得する。最短サブゴール探索ステップでは、サブゴール記憶部５６が記憶しているサブゴールの中で、現在位置から最短距離にあるサブゴールを探索する。サブゴール抽出ステップでは、前記最短距離にあるサブゴールを含み、現在位置を中心とした所定領域内に位置するサブゴールを抽出する。仮想移動目標演算ステップでは、サブゴール抽出ステップで抽出された各サブゴールの位置に基づいて自機の仮想的な移動目標を演算する。
Further, the movement control method of the
以上の方法で、ロボット１１の近傍に複数のサブゴールがある場合、当該複数のサブゴールの位置を総合的に考慮して仮想移動目標８８を決定することができる。これにより、１つのサブゴールのみを移動目標として移動する構成と比べて、移動目標が大きく変化することがなくなり、円滑な移動を行うことができる。従って、サブゴールを切り替える際の急な方向転換が発生しにくくなるので、アクチュエータの負荷を抑えることが可能となり、省電力化及びコストダウンを実現することができる。また、移動を円滑にするためにサブゴールを細かい間隔で設定する必要が無いので、サブゴール記憶部５６の記憶容量等を抑えることができる。また、サブゴールへの到達を目標とするのではなく、サブゴールから求めた仮想的な移動目標に追従するように移動することで、サブゴールに到達することなく目標位置まで移動することが可能である。即ち、必ずしもサブゴールの近傍を経由する必要がないので、サブゴール上に障害物がある場合や、障害物回避により経路から外れた場合であっても、従来の構成のように先に進めなくなることが無く、目標位置に向かって効率的な移動が可能になる。
With the above method, when there are a plurality of subgoals in the vicinity of the
以上に本発明の好適な実施の形態について説明したが、上記の構成は例えば以下のように変更することができる。 Although the preferred embodiment of the present invention has been described above, the above configuration can be changed as follows, for example.
レーザレンジファインダ１４に代えて、又はそれに加えて、ステレオカメラ、単眼カメラ、超音波センサ、赤外線センサ等をロボット１１に備え、これらによって障害物を検知する構成に変更することができる。
Instead of or in addition to the
サブゴールを設定する方法としては、上記の方法に限られず、適宜の方法を用いることができる。例えば、Ａ＊アルゴリズムの代りにダイクストラ法を用いて最短経路を探索しても良い。また例えば、平滑化を行った後で直線化を行っても良い。 The method of setting the subgoal is not limited to the above method, and an appropriate method can be used. For example, the shortest path may be searched using the Dijkstra method instead of the A * algorithm. Further, for example, linearization may be performed after smoothing.
また、経路の平滑化を行う際に、例えばカーブの急なところにはサブゴールを密に配置し、直線状の区間にはサブゴールを広い間隔で配置するように構成することができる。これによれば、カーブの急なところで、ロボット１１を更に滑らかに移動させることができる。
Further, when performing the smoothing of the route, for example, the subgoals can be arranged densely at a steep portion of the curve, and the subgoals can be arranged at wide intervals in a straight section. According to this, the
また、サブゴール抽出部５８によって所定領域内のサブゴールを抽出する際、当該所定領域の外側近傍にあるサブゴールは考慮しないように構成しても良い。
Further, when the
サブゴールの順序は、上記実施形態と逆に、目標位置９０に最も近いものが１番目、次に近いのが２番目、・・・というように定めてサブゴール記憶部５６に記憶することもできる。
Contrary to the above embodiment, the order of subgoals may be determined such that the closest to the
サブゴール記憶部５６に記憶された各サブゴールには、速度に関する情報を関連付けて記憶しておいても良い。例えば、通路の狭い部分に配置されたサブゴールにはロボット１１をゆっくりと移動させるような情報を、広い部分に配置されたサブゴールには速度を上げる情報を関連付けるように構成する。この場合、ロボット１１の移動速度を決定する際には、例えば、最短サブゴール探索部５７によって選択された最短距離のサブゴールに関連付けられた速度でロボットを移動させるように構成することができる。
Information regarding speed may be associated with each subgoal stored in the
仮想移動目標演算部５９において、サブゴールを相対座標に座標変換する処理を省略し、絶対座標のままでベクトル演算を行ってもよい。
The virtual movement
領域円１００の半径は、状況に応じて随時変更可能とすることができる。この場合、例えば、各サブゴールに通路の幅に関する情報を関連付けて記憶しておき、ロボット１１が移動している通路の幅に応じて領域円１００の半径を変更する構成とすることができる。即ち、狭い通路では領域円１００の半径を小さくすることで、サブゴール抽出部５８で抽出されるサブゴールの数を減らし、ロボット１１がサブゴール列で表される経路から大きく外れないように制御することができる。また、このように構成する場合は、ロボット１１の移動速度を領域円１００の半径に関連付けて制御するようにしても良い。
The radius of the
ロボット１１を移動させるためのオムニホイール機構１３は、オムニホイール２１が４つのものに代えて、例えば６つ又は３つ配置される構成に変更することができる。
The
また、オムニホイールを備えたロボット以外でも、例えば２足歩行ロボットや４輪の車両型ロボットなど、自律的に移動可能なロボットであれば本発明を適用できる。 In addition to robots equipped with omni wheels, the present invention can be applied to any robot that can move autonomously, such as a biped robot or a four-wheeled vehicle robot.
１１ ロボット（自律移動体）
１５ 走行制御コントローラ
５１ マップ記憶部
５２ 目標位置記憶部
５３ 自機情報取得部（現在位置取得部）
５４ 障害物情報取得部
５５ サブゴール演算部
５６ サブゴール記憶部
５７ 最短サブゴール探索部
５８ サブゴール抽出部
５９ 仮想移動目標演算部
６４ 走行指令送信部
８１，８２，８３，８４，８５ サブゴール
８８ 仮想移動目標（仮想的な移動目標）
９０ 目標位置（第２地点）
１００ 領域円（所定領域）
11 Robot (autonomous mobile body)
DESCRIPTION OF
54 Obstacle
90 Target position (second point)
100 area circle (predetermined area)
Claims (5)
自機の現在位置を取得する現在位置取得部と、
前記サブゴール記憶部が記憶しているサブゴールの中で、前記現在位置から最短距離にあるサブゴールを探索する最短サブゴール探索部と、
前記最短距離にあるサブゴールを含み、前記現在位置を中心とした所定領域内に位置するサブゴールを抽出するサブゴール抽出部と、
前記サブゴール抽出部によって抽出された各サブゴールの位置に基づいて自機の仮想的な移動目標を演算する仮想移動目標演算部と、
を備えることを特徴とする自律移動体。 A subgoal storage unit that stores a plurality of subgoal positions set in a route from the first point to the second point, and the order of the subgoals from the first point or the second point;
A current position acquisition unit for acquiring the current position of the aircraft;
Among the subgoals stored in the subgoal storage unit, a shortest subgoal search unit that searches for a subgoal that is at the shortest distance from the current position;
A subgoal extracting unit that includes a subgoal at the shortest distance and extracts a subgoal located in a predetermined area centered on the current position;
A virtual movement target calculation unit that calculates a virtual movement target of the own machine based on the position of each subgoal extracted by the subgoal extraction unit;
An autonomous mobile body characterized by comprising:
前記仮想移動目標演算部は、前記サブゴール抽出部によって抽出された前記各サブゴールの位置を、前記現在位置を原点とする相対座標に座標変換するとともに、当該相対座標における前記各サブゴールの位置ベクトルを合成した合成ベクトルの方向に基づいて前記仮想的な移動目標を演算することを特徴とする自律移動体。 The autonomous mobile body according to claim 1,
The virtual movement target calculation unit performs coordinate conversion of the position of each subgoal extracted by the subgoal extraction unit into relative coordinates with the current position as an origin, and synthesizes a position vector of each subgoal in the relative coordinates An autonomous moving body, wherein the virtual moving target is calculated based on the direction of the synthesized vector.
前記サブゴール抽出部は、前記所定領域の外側近傍に位置するサブゴールがある場合は、当該サブゴールの位置を前記所定領域の境界上に置換して追加的に抽出することを特徴とする自律移動体。 The autonomous mobile body according to claim 2,
The subgoal extracting unit, when there is a subgoal located near the outside of the predetermined area, substitutes the position of the subgoal on the boundary of the predetermined area and additionally extracts the autonomous moving body.
前記仮想移動目標演算部は、前記現在位置を中心とした所定領域内に位置するサブゴールのうち、前記最短距離にあるサブゴールよりも前記第１地点側であるサブゴールを除いた残りの各サブゴールの位置に基づいて、自機の仮想的な移動目標を演算することを特徴とする自律移動体。 The autonomous mobile body according to any one of claims 1 to 3,
The virtual movement target calculation unit is a position of each remaining subgoal excluding a subgoal that is closer to the first point than a subgoal that is at the shortest distance among subgoals that are located within a predetermined area centered on the current position. Based on the above, an autonomous moving body that calculates a virtual movement target of its own machine.
自機の現在位置を取得する現在位置取得ステップと、
前記サブゴール記憶部が記憶しているサブゴールの中で、前記現在位置から最短距離にあるサブゴールを探索する最短サブゴール探索ステップと、
前記最短距離にあるサブゴールを含み、前記現在位置を中心とした所定領域内に位置するサブゴールを抽出するサブゴール抽出ステップと、
前記サブゴール抽出ステップで抽出された各サブゴールの位置に基づいて自機の仮想的な移動目標を演算する仮想移動目標演算ステップと、
を含むことを特徴とする自律移動体の移動制御方法。 A subgoal storage unit storing a plurality of subgoal positions set on a route from the first point to the second point and the order of the subgoals from the first point or the second point; In the movement control method of an autonomous mobile body,
A current position acquisition step for acquiring the current position of the aircraft;
Among the subgoals stored in the subgoal storage unit, a shortest subgoal search step for searching for a subgoal that is at the shortest distance from the current position;
A subgoal extraction step for extracting a subgoal that includes the subgoal at the shortest distance and is located within a predetermined area centered on the current position;
A virtual movement target calculation step of calculating a virtual movement target of the own machine based on the position of each subgoal extracted in the subgoal extraction step;
A method for controlling the movement of an autonomous mobile body, comprising:
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2008261821A JP5312894B2 (en) | 2008-10-08 | 2008-10-08 | Autonomous mobile body and movement control method for autonomous mobile body |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2008261821A JP5312894B2 (en) | 2008-10-08 | 2008-10-08 | Autonomous mobile body and movement control method for autonomous mobile body |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2010092279A true JP2010092279A (en) | 2010-04-22 |
| JP5312894B2 JP5312894B2 (en) | 2013-10-09 |
Family
ID=42254926
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2008261821A Active JP5312894B2 (en) | 2008-10-08 | 2008-10-08 | Autonomous mobile body and movement control method for autonomous mobile body |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP5312894B2 (en) |
Cited By (13)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR101220542B1 (en) * | 2010-08-04 | 2013-01-10 | 중앙대학교 산학협력단 | Method and apparatus for path planning of autonomous mobile robot |
| JP2014123200A (en) * | 2012-12-20 | 2014-07-03 | Toyota Motor Corp | Moving body control apparatus, moving body control method, and control program |
| WO2014125719A1 (en) * | 2013-02-15 | 2014-08-21 | 村田機械株式会社 | Conveyance trolley, drive control method for conveyance trolley, and drive control program for conveyance trolley |
| WO2014181647A1 (en) * | 2013-05-07 | 2014-11-13 | 村田機械株式会社 | Autonomous moving body movement control device, autonomous moving body, and autonomous moving body control method |
| JP2015060388A (en) * | 2013-09-18 | 2015-03-30 | 村田機械株式会社 | Autonomous traveling carriage, planned travel route data processing method, and program |
| CN110609278A (en) * | 2019-09-23 | 2019-12-24 | 上海机电工程研究所 | Off-axis irradiation method and system with self-adaptive capacity |
| JP2020152234A (en) * | 2019-03-20 | 2020-09-24 | クラリオン株式会社 | On-vehicle processing device, and movement support system |
| CN111714028A (en) * | 2019-03-18 | 2020-09-29 | 北京奇虎科技有限公司 | Method, device and equipment for escaping from restricted zone of cleaning equipment and readable storage medium |
| WO2020195876A1 (en) * | 2019-03-25 | 2020-10-01 | ソニー株式会社 | Movable body and control method therefor, and program |
| JP2021033685A (en) * | 2019-08-26 | 2021-03-01 | 株式会社デンソー | Learning program and learning method |
| WO2021065241A1 (en) * | 2019-09-30 | 2021-04-08 | 日本電産株式会社 | Route generation device |
| JP2021131601A (en) * | 2020-02-18 | 2021-09-09 | 株式会社豊田自動織機 | Autonomous moving body |
| WO2023158075A1 (en) * | 2022-02-15 | 2023-08-24 | 주식회사 트위니 | Autonomous robot capable of moving obstacle avoidance |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2007249631A (en) * | 2006-03-16 | 2007-09-27 | Fujitsu Ltd | Polygonal line following mobile robot, and control method for polygonal line following mobile robot |
| JP2010061442A (en) * | 2008-09-04 | 2010-03-18 | Murata Machinery Ltd | Autonomous mobile device |
| JP2010092147A (en) * | 2008-10-06 | 2010-04-22 | Murata Machinery Ltd | Autonomous mobile device |
-
2008
- 2008-10-08 JP JP2008261821A patent/JP5312894B2/en active Active
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2007249631A (en) * | 2006-03-16 | 2007-09-27 | Fujitsu Ltd | Polygonal line following mobile robot, and control method for polygonal line following mobile robot |
| JP2010061442A (en) * | 2008-09-04 | 2010-03-18 | Murata Machinery Ltd | Autonomous mobile device |
| JP2010092147A (en) * | 2008-10-06 | 2010-04-22 | Murata Machinery Ltd | Autonomous mobile device |
Cited By (20)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR101220542B1 (en) * | 2010-08-04 | 2013-01-10 | 중앙대학교 산학협력단 | Method and apparatus for path planning of autonomous mobile robot |
| JP2014123200A (en) * | 2012-12-20 | 2014-07-03 | Toyota Motor Corp | Moving body control apparatus, moving body control method, and control program |
| WO2014125719A1 (en) * | 2013-02-15 | 2014-08-21 | 村田機械株式会社 | Conveyance trolley, drive control method for conveyance trolley, and drive control program for conveyance trolley |
| JPWO2014125719A1 (en) * | 2013-02-15 | 2017-02-02 | 村田機械株式会社 | Transport cart, transport cart drive control method, and transport cart drive control program |
| WO2014181647A1 (en) * | 2013-05-07 | 2014-11-13 | 村田機械株式会社 | Autonomous moving body movement control device, autonomous moving body, and autonomous moving body control method |
| JP2014219799A (en) * | 2013-05-07 | 2014-11-20 | 村田機械株式会社 | Movement control device of autonomous mobile body, autonomous mobile body, and control method for autonomous mobile body |
| JP2015060388A (en) * | 2013-09-18 | 2015-03-30 | 村田機械株式会社 | Autonomous traveling carriage, planned travel route data processing method, and program |
| CN111714028A (en) * | 2019-03-18 | 2020-09-29 | 北京奇虎科技有限公司 | Method, device and equipment for escaping from restricted zone of cleaning equipment and readable storage medium |
| JP7393128B2 (en) | 2019-03-20 | 2023-12-06 | フォルシアクラリオン・エレクトロニクス株式会社 | In-vehicle processing equipment, mobility support system |
| JP2020152234A (en) * | 2019-03-20 | 2020-09-24 | クラリオン株式会社 | On-vehicle processing device, and movement support system |
| WO2020195876A1 (en) * | 2019-03-25 | 2020-10-01 | ソニー株式会社 | Movable body and control method therefor, and program |
| JP2021033685A (en) * | 2019-08-26 | 2021-03-01 | 株式会社デンソー | Learning program and learning method |
| US11727308B2 (en) | 2019-08-26 | 2023-08-15 | Denso Corporation | Learning system and method |
| CN110609278B (en) * | 2019-09-23 | 2023-06-30 | 上海机电工程研究所 | Off-axis illumination method and system with self-adaption capability |
| CN110609278A (en) * | 2019-09-23 | 2019-12-24 | 上海机电工程研究所 | Off-axis irradiation method and system with self-adaptive capacity |
| WO2021065241A1 (en) * | 2019-09-30 | 2021-04-08 | 日本電産株式会社 | Route generation device |
| CN114450648A (en) * | 2019-09-30 | 2022-05-06 | 日本电产株式会社 | Route generation device |
| US20220334583A1 (en) * | 2019-09-30 | 2022-10-20 | Nidec Corporation | Route generation device |
| JP2021131601A (en) * | 2020-02-18 | 2021-09-09 | 株式会社豊田自動織機 | Autonomous moving body |
| WO2023158075A1 (en) * | 2022-02-15 | 2023-08-24 | 주식회사 트위니 | Autonomous robot capable of moving obstacle avoidance |
Also Published As
| Publication number | Publication date |
|---|---|
| JP5312894B2 (en) | 2013-10-09 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP5312894B2 (en) | Autonomous mobile body and movement control method for autonomous mobile body | |
| JP5337408B2 (en) | Autonomous mobile body and its movement control method | |
| JP5086942B2 (en) | Route search device, route search method, and route search program | |
| WO2010026710A1 (en) | Route planning method, route planning unit, and autonomous mobile device | |
| JP5398489B2 (en) | Autonomous mobile object and its control method | |
| JP5560978B2 (en) | Autonomous mobile | |
| JP5398488B2 (en) | Autonomous mobile object and its control method | |
| JP5287051B2 (en) | Autonomous mobile device | |
| JP4682973B2 (en) | Travel route creation method, autonomous mobile body, and autonomous mobile body control system | |
| JP4670807B2 (en) | Travel route creation method, autonomous mobile body, and autonomous mobile body control system | |
| JP2008158868A (en) | Mobile body and control method | |
| JP2016151897A (en) | Mobile body control device and mobile body control method | |
| JP2005224265A (en) | Self-traveling vacuum cleaner | |
| WO2014048597A1 (en) | Autonomous mobile robot and method for operating the same | |
| KR102301758B1 (en) | Autonomous Mobile Robot and Method for Driving Control the same | |
| JP2008142841A (en) | Mobile robot | |
| JP5287060B2 (en) | Route planning device and autonomous mobile device | |
| US20160195875A1 (en) | Autonomous mobile robot and method for operating the same | |
| JP6348971B2 (en) | Moving body | |
| JP2008129695A (en) | Path generation system and method for traveling object | |
| JP2007249631A (en) | Polygonal line following mobile robot, and control method for polygonal line following mobile robot | |
| JP2010061355A (en) | Route planning method, route planning device, and autonomous mobile device | |
| JP2009053927A (en) | Route generation device for autonomous movement and autonomous movement device using the device | |
| WO2016009585A1 (en) | Autonomous mobile object and method of controlling same | |
| JP7360792B2 (en) | Mobile object, learning device, and learning device manufacturing method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20110819 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20121018 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20121206 |
|
| 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: 20130628 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20130703 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Ref document number: 5312894 Country of ref document: JP 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 |
|
| S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313117 |
|
| R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
| 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 |