JP2017045432A - Road surface state recognizing device, program for the same, and mobile body system - Google Patents
Road surface state recognizing device, program for the same, and mobile body system Download PDFInfo
- Publication number
- JP2017045432A JP2017045432A JP2015169850A JP2015169850A JP2017045432A JP 2017045432 A JP2017045432 A JP 2017045432A JP 2015169850 A JP2015169850 A JP 2015169850A JP 2015169850 A JP2015169850 A JP 2015169850A JP 2017045432 A JP2017045432 A JP 2017045432A
- Authority
- JP
- Japan
- Prior art keywords
- road surface
- moving body
- hardness
- value
- estimated
- 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
- 238000001514 detection method Methods 0.000 claims abstract description 35
- 230000008859 change Effects 0.000 claims description 30
- 230000006870 function Effects 0.000 claims description 3
- 238000012545 processing Methods 0.000 description 4
- 230000007704 transition Effects 0.000 description 4
- 230000007613 environmental effect Effects 0.000 description 3
- 238000012544 monitoring process Methods 0.000 description 3
- 230000004044 response Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 238000000034 method Methods 0.000 description 2
- 230000002123 temporal effect Effects 0.000 description 2
- 230000036962 time dependent Effects 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 206010037844 rash Diseases 0.000 description 1
- 230000002441 reversible effect Effects 0.000 description 1
- 239000004576 sand Substances 0.000 description 1
- 230000035807 sensation Effects 0.000 description 1
- 239000002689 soil Substances 0.000 description 1
- 230000000392 somatic 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 a road surface situation recognition device, a program thereof, and a mobile system, and more specifically, a road surface situation recognition device and a program thereof for recognizing a road surface situation when the mobile body moves on the road surface, and the road surface. The present invention relates to a moving body system that performs operation control of a moving body in accordance with a road surface situation recognized by a situation recognition device.
日本では、土砂崩れや噴火などの多岐に亘る自然災害に悩まされており、近年では、災害の予知や状況把握等の理由から環境モニタリングに対する需要が増加している。そこで、本発明者らは、このような社会的需要を受け、森林などの特別な環境で長時間自律作業が可能な環境モニタリングロボットの研究を行っている。ここで、屋外環境には、木や石などの障害物や沼や草地などの走行の障害となる場が多く散在するため、ロボットを自律移動させるためには、ロボットが屋外環境を正しく認識し、それに併せてロボットの走行制御を行う必要がある。 In Japan, we are suffering from a wide range of natural disasters such as landslides and eruptions. In recent years, demand for environmental monitoring is increasing for reasons such as predicting disasters and understanding the situation. Accordingly, the present inventors have been researching an environmental monitoring robot that can perform long-term autonomous work in a special environment such as a forest in response to such social demand. Here, in the outdoor environment, there are many places where obstacles such as trees and stones and running obstacles such as swamps and grassland are scattered, so in order to move the robot autonomously, the robot correctly recognizes the outdoor environment. In conjunction with this, it is necessary to control the traveling of the robot.
ところで、下記特許文献1、2及び3には、ロボット等の移動体に搭載され、当該移動体が走行する路面の形状や種類を推定する装置が開示されている。すなわち、特許文献1には、レーザレンジファインダを用い、走行可能領域内に存在する起伏が斜面か段差かを判別する走行領域判別装置が開示されている。また、特許文献2には、車両進行方向の路面画像を取得し、当該取得画像と、予め記憶された砂利道等の複数の路面種類を表す基準パターン画像との対比により、最も近い基準パターン画像を特定して路面の種類を推定する路面状態推定装置が開示されている。更に、特許文献3には、足底部と路面との接地状態を検出する圧力センサの実測値と、砂地、コンクリート等の路面の種類に対応して予め記憶された圧力センサの記憶値とを対比することにより、現在走行している路面の種類を判定するロボット装置が開示されている。
By the way, the following
しかしながら、前記各引用文献の装置にあっては、路面の形状や種類の特定に留まり、路面の状況、すなわち、路面の硬さや凹凸の程度まで検出することができない。従って、前記各引用文献の装置では、例えば、山間部の土の路面のように、路面が同一の形状や種類であっても、降雨の前後による路面の軟弱性の変化までの情報を得ることはできず、このような特別な屋外環境において、ロボット等の移動体の正確な走行制御を行うことができない。加えて、遠隔操作によって環境モニタリングを行う災害対応用の小型の移動ロボットについては、前記各引用文献のような大型の装備やセンサ類の搭載に限界があり、路面状況の特定のために新たな機器類を設けることは実用的ではない。 However, the devices disclosed in the above cited documents are not limited to specifying the shape and type of the road surface, and cannot detect the road surface condition, that is, the road surface hardness and unevenness. Therefore, in the devices of the above cited references, even when the road surface is the same shape or type, for example, the road surface of the soil in a mountainous area, information on the change in the softness of the road surface due to the rainfall before and after is obtained. In such a special outdoor environment, it is impossible to perform accurate traveling control of a moving body such as a robot. In addition, small-sized mobile robots for disaster response that perform environmental monitoring by remote control have limitations in mounting large-scale equipment and sensors such as those cited above, and a new one for identifying road surface conditions. Providing equipment is not practical.
本発明は、このような課題を解決するために案出されたものであり、その目的は、比較的簡易な構成や装備により、移動体が走行する路面の硬さや凹凸の程度等の路面状況を検出することができ、当該路面状況に基づき移動体の走行制御を正確に行うことに寄与する路面状況認識装置、そのプログラム、及び移動体システムを提供することにある。 The present invention has been devised to solve such problems, and its purpose is to provide road conditions such as the hardness of the road surface on which the mobile body travels and the degree of unevenness with a relatively simple configuration and equipment. It is possible to detect a road surface situation recognition apparatus that contributes to accurately performing traveling control of a mobile body based on the road surface situation, its program, and a mobile body system.
前記目的を達成するため、本発明は、主として、アクチュエータの動力により、複数の脚部で路面への接触及び非接触を繰り返し行いながら移動する移動体の移動時に、前記路面の状況を認識する路面状況認識装置において、移動時における前記移動体の状態を検出する検出手段と、当該検出手段の検出結果に基づいて、前記路面の状況に対応した路面情報を求める情報決定手段とを備え、前記検出手段は、前記アクチュエータに対する負荷を検出する負荷検出部を備え、前記情報決定手段は、前記電流検出部で検出された前記負荷の経時的変化に基づき、前記路面の硬さに対応した硬さ推定値を求める硬さ推定部を備える、という構成を採っている。 In order to achieve the above object, the present invention mainly provides a road surface for recognizing the state of the road surface when the moving body moves while repeatedly contacting and non-contacting the road surface with a plurality of legs by the power of the actuator. In the situation recognition apparatus, the detection unit includes a detection unit that detects a state of the moving body during movement, and an information determination unit that obtains road surface information corresponding to the road surface state based on a detection result of the detection unit. The means includes a load detection unit that detects a load on the actuator, and the information determination unit estimates the hardness corresponding to the hardness of the road surface based on a change with time of the load detected by the current detection unit. A configuration is adopted in which a hardness estimation unit for obtaining a value is provided.
なお、本特許請求の範囲及び本明細書において、「路面」は、道路の表面のみならず、移動体の走行時に脚部が接触する走行面全般を意味する用語として用いる。 In the claims and the specification, the “road surface” is used as a term meaning not only the surface of the road but also the entire traveling surface with which the leg contacts when the mobile body is traveling.
本発明によれば、路面の柔軟性や路面の凹凸の程度等、移動体の走行に影響を与え得る路面の状況を推定することができ、自律移動する移動体の走行制御を正確に行うために寄与できる。また、移動体の脚部を動作させるアクチュエータに対する負荷の経時的変化や、移動体の姿勢情報の経時的変化により、路面状況を認識できるため、当該路面状況の認識のために新たな機器や装備等を移動体に設ける必要が少なく、移動体の動作に利用される幾つかの機器を併用することができる。すなわち、本発明では、力センサやレーザレンジファインダなどの高価格や計算負荷が大きくなるセンサ類を必要とせずに、比較的簡単な構成や装備により路面状況を認識することができ、小型の移動体にも適用可能となる。 According to the present invention, it is possible to estimate the road surface conditions that can affect the traveling of the moving body, such as the flexibility of the road surface and the unevenness of the road surface, and to accurately perform the traveling control of the moving body that moves autonomously. Can contribute. In addition, since the road surface condition can be recognized by the time-dependent change of the load on the actuator that operates the leg of the moving object and the time-dependent change of the posture information of the moving object, new equipment and equipment are provided for the recognition of the road condition. Etc. are not required to be provided on the moving body, and several devices used for the operation of the moving body can be used together. In other words, in the present invention, a road surface condition can be recognized with a relatively simple configuration and equipment without requiring high-price sensors such as a force sensor and a laser range finder and a calculation load, and a small movement Applicable to the body.
以下、本発明の実施形態について図面を参照しながら説明する。 Hereinafter, embodiments of the present invention will be described with reference to the drawings.
図1には、本実施形態における移動体システムの構成を表すブロック図が示されている。この図において、移動体システム10は、種々の路面を移動可能な脚式の移動体としての移動ロボット11と、移動ロボット11の移動時に路面の状況を認識する路面状況認識装置12と、操作者からの指令や路面状況認識装置12で認識された路面の状況に基づいて、移動ロボット11の動作制御を行う制御装置14とを備えている。なお、特に限定されるものではないが、路面状況認識装置12及び制御装置14は、一体的に設けても別体に設けても良く、また、移動ロボット11と離れて設けられていても一体であっても良い。
FIG. 1 is a block diagram showing the configuration of the mobile system in the present embodiment. In this figure, a mobile body system 10 includes a
前記移動ロボット11は、図示しないコンピュータからなる端末からの操作者の遠隔指令により、所定領域を自律移動可能となっている。この移動ロボット11は、図2及び図3に示されるように、箱型のロボット本体16と、ロボット本体16の側方の複数箇所に設けられ、路面G(図3参照)に対して接触及び非接触を繰り返し行うことで、ロボット本体16を移動させる脚部18と、ロボット本体16の内部に収容され、脚部18の動力として駆動するアクチュエータとしてのモータ19(図2参照)とを備えている。
The
なお、以下の説明において、移動ロボット11について位置や方向を説明する際に用いる「前」、「後」、「左」、「右」、「上」、「下」は、特に明記しない限り、図2に示された移動ロボット11の位置を基準とし、同中x軸に沿う方向を前後方向とし、同図中y軸方向を左右方向とし、同図中z軸方向を上下方向とする。
In the following description, “front”, “rear”, “left”, “right”, “upper”, and “lower” used when describing the position and direction of the
前記脚部18は、ロボット本体16の左側面に設けられた左側の脚部18Lと、同右側面に設けられた右側の脚部18Rとからなる。左右両側の脚部18L,18Rは、相互に同一の構成となっており、それぞれ、同一の形状及びサイズを有する楕円円盤状の楕円脚20,21,22が3箇所ずつ設けられている。各楕円脚20,21,22は、ロボット本体16側に繋がる回転軸24にそれぞれ固定されている。当該各回転軸24は、モータ19の駆動により回転し、当該回転に伴って各楕円脚20,21,22が回転するようになっている。また、各回転軸24は、各楕円脚20,21,22の外周縁寄りに固定されており、楕円脚20,21,22と回転軸24の中心がずれた状態で相互に取り付けられている。従って、楕円脚20,21,22は、モータ19の駆動によってロボット本体16に対して偏心回転することになる。
The
左右それぞれの楕円脚20,21,22は、前後方向に次のように配置されている。すなわち、前後方向の両端に位置する前後の楕円脚20,22と、楕円脚20,22の間となる前後方向中央に位置する中央の楕円脚21とは、上下方向に反転した向きで取り付けられている。また、図2及び図3(B)に示されるように、前後の楕円脚20,22と、中央の楕円脚21とは、左右方向に相互にシフトして配置されており、中央の楕円脚21が、前後の楕円脚20,22よりも外側に配置され、各楕円脚20,21,22が相互に干渉せずに偏心回転可能となっている。また、前後の楕円脚20,22と、中央の楕円脚21は、移動ロボット11の移動に際してそれぞれが回転する過程で、前後の楕円脚20,22と中央の楕円脚21の何れか一方が路面Gに接触している際には、何れか他方が路面Gから離れるようになっている。
The left and right
前記モータ19は、電気モータであり、図2に示されるように、左側の脚部18Lを動作させる左側のモータ19Lと、右側の脚部18Rを動作させる右側のモータ19Rとからなる。左右両側のモータ19L,19Rは、ロボット本体16が所望の動作を行うように、制御装置14によって駆動制御がなされる。なお、本発明の本質部分でないため図示省略しているが、左側のモータ19Lと左側の脚部18Lの間、及び右側のモータ19Rと右側の脚部18Rの間には、それぞれ、モータ19L,19Rの動力を脚部18L,18Rに伝達する駆動機構が設けられている。当該駆動機構は、複数のプーリと当該プーリに掛け回されるベルト等からなり、左側のモータ19Lが回転すると、左側の脚部18Lの3箇所の楕円脚20,21,22を同期して回転させる構造となっており、右側のモータ19Rが回転すると、右側の脚部18Rの3箇所の楕円脚20,21,22を同期して回転させ構造となっている。
The
前記左右の脚部18L,18Rは、沼や草地などの不整地等で移動ロボット11を走行させる際には、後述する制御装置14によるモータ19L,19Rの駆動制御により、左右の楕円脚20,21,22が同位相となる走行モーション(以下、「同位相モーション」と称する。)が適用される。この同位相モーションは、図4(A)及び図5(A)に示されるように、左右の脚部18L,18R間で、常時、各前後の楕円脚20,22の位置姿勢が同一になるとともに、各中央の楕円脚21の位置姿勢も同一になるように、脚部18が動作する。一方、整地等で移動ロボット11を走行させる際には、後述する制御装置14によるモータ19L,19Rの駆動制御により、左右の楕円脚20,21,22が逆位相となる走行モーション(以下、「逆位相モーション」と称する。)が適用される。この逆位相モーションは、図4(B)及び図5(B)に示されるように、左右の脚部18L,18R間で、常時、各前後の楕円脚20,22の位置姿勢が180度ずれるとともに、各中央の楕円脚21の位置姿勢も180度ずれるように、脚部18が動作する。
The left and
なお、本実施形態において、脚部18は、楕円円盤状の形状をなしているが、本発明はこれに限らず、路面Gへの接触及び非接触を繰り返し行えるものであれば、その形状や構造は問わない。また、脚部18及びモータ19は、本実施形態の設置数に限定されるものではなく、更に増減した態様にも本発明を適用可能となる。
In the present embodiment, the
前記路面状況認識装置12は、図1に示されるように、移動時における移動ロボット11の状態を検出する検出手段26と、検出手段26の検出結果に基づいて、脚部18が接地している路面の状況に対応した路面情報を求める情報決定手段27とを備えている。
As shown in FIG. 1, the road surface condition recognition device 12 has a detection unit 26 that detects the state of the
前記検出手段26は、左右両側の各モータ19L,19Rに対する負荷に応じて変化する電流値をそれぞれ検出する電流検出部29(負荷検出部)と、移動ロボット11の姿勢を検出する姿勢検出部30とからなる。本実施形態において、電流検出部29は、モータ19L,19Rに流れる電流値を計測するように、当該モータ19L,19Rに付随する電流センサにより構成され、姿勢検出部30は、3次元の角速度と加速度を検出可能な慣性計測装置(IMU)により構成されているが、本発明はこれに限らず、同様の情報を検出可能な限りにおいて、他のセンサや測定機器に代替することもできる。これら電流検出部29及び姿勢検出部30からの計測値は、所定時間毎に前記情報決定手段27に送られるようになっている。
The detection means 26 includes a current detection unit 29 (load detection unit) that detects current values that change in accordance with loads on the left and
前記情報決定手段27は、電流検出部29で検出された左右両側の各モータ19L,19Rのそれぞれの電流値の経時的変化に基づき、路面の硬さに対応した硬さ推定値を求める硬さ推定部32と、姿勢検出部30で検出された移動ロボット11の姿勢情報の経時的変化に基づき、路面の凹凸の程度に対応した粗さ推定値を求める粗さ推定部33とを備えている。なお、路面状況認識装置12は、その一部がCPU等の演算処理装置及びメモリやハードディスク等の記憶装置等からなるコンピュータによって構成され、当該コンピュータを情報決定手段27として機能させるためのプログラムがインストールされている。
The information determination means 27 obtains a hardness estimation value corresponding to the hardness of the road surface based on the temporal change of the current values of the left and
前記硬さ推定部32では、次のようにして硬さ推定値が求められる。すなわち、移動ロボット11の走行時に、当該移動ロボット11が路面Gから受ける反力が大きいときに、モータ19を流れる電流値が大きくなる。換言すると、路面Gの硬さに応じて、各楕円脚20,21,22が接地する際に路面Gから受ける反力が変化することから、モータ19を流れる電流のピーク値も硬さの異なる路面Gで異なる。このことから、硬さ推定部32では、予め特定した移動ロボット11の運動周期における電流値の極大値と極小値の差に基づいて、前記硬さ推定値が求められる。具体的には、予め記憶された次の数式に、電流検出部29で検出された各モータ19L,19Rのそれぞれの電流値の極大値と極小値が代入され、硬さ推定値Hが求められる。ここで、特に限定されるものではないが、本実施形態における運動周期Tは、各脚部18L,18Rが同一の位置姿勢に戻るまでの時間に設定されている。
前記粗さ推定部33では、路面の凹凸が走行時の移動ロボット11の姿勢に大きく影響を与えることから、移動ロボット11の姿勢情報の経時的変化に基づき、路面の凹凸の程度に対応した粗さ推定値が求められる。すなわち、移動ロボット11は、不整地の路面を走行する際、前後に搖動する方向(ピッチ方向)と、左右に搖動する方向(ロール方向)に姿勢が傾く。従って、粗さ推定部33では、前記運動周期Tにおける移動ロボット11のピッチ方向とロール方向の傾きの変化に加え、路面の凹凸による影響を左右する移動ロボット11のサイズを考慮した粗さ推定値が求められる。具体的には、予め記憶された次の数式に、姿勢検出部30で検出された時刻tにおける移動ロボット11のピッチ方向の傾き角度θp(t)とロール方向の傾き角度θr(t)が代入され、粗さ推定値Uが求められる。
このように、情報決定手段27では、路面Gの硬さと粗さに関する路面情報である硬さ推定値H及び粗さ推定値Uが、前記運動周期T毎に求められ、求められた路面情報が制御装置14に送られる。 Thus, in the information determination means 27, the estimated hardness value H and the estimated roughness value U, which are road surface information relating to the hardness and roughness of the road surface G, are obtained for each motion cycle T, and the obtained road surface information is obtained. It is sent to the control device 14.
前記制御装置14は、コンピュータによって構成され、当該コンピュータを以下の各手段として機能させるためのプログラムがインストールされている。当該制御装置14は、図1に示されるように、移動ロボット11に所望の動作をさせるために各モータ19L,19Rの駆動を制御する駆動制御手段35と、路面状況認識装置12で求められた路面情報に応じて、移動ロボット11の動作を変更するように、駆動制御手段35に指令する動作変更指令手段36とを備えている。
The control device 14 is configured by a computer, and a program for causing the computer to function as the following units is installed. As shown in FIG. 1, the control device 14 is obtained by a drive control means 35 that controls driving of the
前記駆動制御手段35では、移動ロボット11から一定範囲内で離れた場所での操作者側の端末操作と、脚部18の位置や速度を測定する図示しないエンコーダを含め移動ロボット11の状態を検出する各種センサの測定値と、路面状況認識装置12での路面状況の認識とにより、左右両側の脚部18L,18Rの動作と速度が制御される。すなわち、ここでは、操作者の操作による所望の動作に、路面状況認識装置12で検出された路面状況が加味されて、次の走行パターンにより、各モータ19L,19Rの駆動状態と回転速度とが調整される。
The drive control means 35 detects the state of the
本実施形態における前記走行パターンとしては、特に限定されるものではないが、前述した同位相モーション及び逆位相モーションのそれぞれついて、2種類の速度モード(高速モード、低速モード)で、前進及び後退を可能とするパターンが設定されている。 The travel pattern in the present embodiment is not particularly limited, but for each of the in-phase motion and the anti-phase motion described above, the forward and backward movements are performed in two speed modes (high speed mode and low speed mode). A possible pattern is set.
前記同位相モーションでは、図4(A)及び図5(A)に示されるように、同一時刻で左右の脚部18L,18Rの配置関係が左右対称となる同位相になるように、左右のモータ19L,19Rの駆動が制御される。一方、前記逆位相モーションでは、図4(B)及び図5(B)に示されるように、同一時刻で左右の脚部18L,18Rの配置関係が180度ずれた時間差が生じるように、左右のモータ19L,19Rの駆動が制御される。
In the same phase motion, as shown in FIGS. 4 (A) and 5 (A), the left and right left and
前記動作変更指令手段36では、現在の移動ロボット11の走行パターンと、路面状況認識装置12で求められた現在の路面情報とから、予め記憶されたルールに従って異なる走行パターンに遷移させるように、モータ19L,19Rの駆動状態の変更が駆動制御手段35に指令される。
In the operation change command means 36, the motor is changed so that the current travel pattern of the
本実施形態では、例えば、水平整地路面等を走行する際に適用され、高速モードの逆位相モーションで前進する第1の走行パターンと、水平不整地路面等を走行する際に適用され、低速モードの同位相モーションで前進する第2の走行パターンと、水平軟弱路面等を走行する際に適用され、低速モードの同位相モーションで後退する第3の走行パターン等が設定されている。なお、第3の走行パターンでは、移動ロボット11の後退に加えて、或いは、当該後退に代えて、移動ロボット11の移動経路を再設定しても良い。
In the present embodiment, for example, it is applied when traveling on a horizontal leveling road surface or the like, and is applied when traveling on a first level traveling pattern with a reverse phase motion in a high speed mode and a horizontal uneven road surface, etc. A second traveling pattern that moves forward with the same phase motion and a third traveling pattern that is applied when traveling on a horizontal soft road surface or the like and moves backward with the same phase motion in the low speed mode are set. In the third traveling pattern, in addition to or in place of the backward movement of the
(前記第1の走行パターンでの移動時)
第1の走行パターンで移動ロボット11が移動している際に、粗さ推定値Uが予め設定された第1の閾値以上になった場合には、移動ロボット11に影響を与える凹凸を有する不整地の路面に入ったとして、移動ロボット11を低速で前進させる第2の走行パターンに遷移される。また、第1の走行パターンで移動ロボット11が移動している際に、硬さ推定値Hが予め設定された第2の閾値以下になった場合には、移動ロボット11が軟弱路面に入ったとして、移動ロボット11を低速で後退させる第3の走行パターンに遷移される。
(When moving in the first traveling pattern)
While the
(前記第2の走行パターンでの移動時)
第2の走行パターンで移動ロボット11が移動している際に、粗さ推定値Uが前記第1の閾値未満になった場合には、不整地の路面から整地された路面上の走行に変わったとして、移動ロボット11を高速で前進させる第1の走行パターンに遷移される。また、第2の走行パターンで移動ロボット11が移動している際に、硬さ推定値Hが前記第2の閾値以下になった場合、若しくは、粗さ推定値Uが前述と別に設定された第3の閾値以上になった場合には、移動ロボット11が軟弱路面に入ったとして、移動ロボット11を低速で後退させる第3の走行パターンに遷移される。ここで、前記第3の閾値は、前記第1の閾値よりも大きい値に設定されている。
(When moving in the second traveling pattern)
When the
以上の本実施形態によれば、路面の硬さに対応した硬さ推定値Hと、移動ロボット11のサイズを考慮して、当該移動ロボット11の移動に影響を与え得る路面の凹凸の状況に対応した粗さ推定値Uとを求めることができる。これら硬さ推定値H及び粗さ推定値Uを求める際には、演算処理が高負荷となる各種処理、例えば、力センサでの検出や、カメラによって撮像された画像の処理や、レーザレンジファインダ等を用いた処理等が不要である。従って、本実施形態の構成は、小型の移動ロボット11にも十分適用が可能になるという効果を得る。また、硬さ推定値Hが所定の閾値以下のときに、又は、粗さ推定値Uが所定の閾値以上のときに、移動ロボット11を後退させ、及び/又は、移動ロボット11の移動経路が再設定され、また、粗さ推定値Uの大きさに応じて移動ロボット11の移動速度が変化される。このため、人間の体性感覚に近い感覚で、路面状況に応じた移動ロボット11の移動制御が可能になる。
According to the present embodiment described above, in consideration of the estimated hardness value H corresponding to the hardness of the road surface and the size of the
なお、前記実施形態では、情報決定手段27で、硬さ推定値H及び粗さ推定値Uの双方が求められているが、必要に応じて、何れか一方のみを求める構成にしても良い。 In the above-described embodiment, both the hardness estimated value H and the roughness estimated value U are obtained by the information determining unit 27. However, only one of them may be obtained if necessary.
また、本発明は、前記実施形態の構成の移動ロボット11に対する適用に限定されるものではなく、路面への接触及び非接触を繰り返し行うように動作する複数の脚部を備えた多足歩行ロボット等、あらゆる脚式の移動体に適用することができる。
Further, the present invention is not limited to the application to the
更に、前記実施形態では、脚部18を動作させるアクチュエータとして電気モータ19を用いた脚式の移動体について説明したが、本発明はこれに限らず、アクチュエータとして油圧モータや油圧シリンダを用いた脚式の移動体への適用も可能である。この場合、前記硬さ推定部32では、アクチュエータの負荷の経時的変化として、アクチュエータに繋がる油圧系統に設けられた油圧計を用いて、アクチュエータに流れる油圧の経時的変化を検出し、前記実施形態と同様にして硬さ推定値が求められる。
Furthermore, in the above-described embodiment, the leg-type moving body using the
また、移動ロボット11には、特許第5269729号公報に記載された手法又はそれに類する手法が適用された計測装置を搭載しても良い。
Further, the
その他、本発明における装置各部の構成は図示構成例に限定されるものではなく、実質的に同様の作用を奏する限りにおいて、種々の変更が可能である。 In addition, the configuration of each part of the apparatus in the present invention is not limited to the illustrated configuration example, and various modifications are possible as long as substantially the same operation is achieved.
10 移動体システム
11 移動ロボット(移動体)
12 路面状況認識装置
14 制御装置
18 脚部
19 モータ(アクチュエータ)
26 検出手段
27 情報決定手段
29 電流検出部(負荷検出部)
30 姿勢検出部
32 硬さ推定部
33 粗さ推定部
35 駆動制御手段
36 動作変更指令手段
10
12 Road surface condition recognition device 14
26 detection means 27 information determination means 29 current detection part (load detection part)
30
Claims (9)
移動時における前記移動体の状態を検出する検出手段と、当該検出手段の検出結果に基づいて、前記路面の状況に対応した路面情報を求める情報決定手段とを備え、
前記検出手段は、前記アクチュエータに対する負荷を検出する負荷検出部を備え、
前記情報決定手段は、前記負荷検出部で検出された前記負荷の経時的変化に基づき、前記路面の硬さに対応した硬さ推定値を求める硬さ推定部を備えたことを特徴とする路面状況認識装置。 In the road surface situation recognition device for recognizing the road surface situation when the moving body moves while repeatedly making contact and non-contact with the road surface by the power of the actuator,
Detecting means for detecting the state of the moving body during movement, and information determining means for obtaining road surface information corresponding to the road surface condition based on a detection result of the detecting means;
The detection means includes a load detection unit that detects a load on the actuator,
The road surface is characterized in that the information determination means includes a hardness estimation unit that obtains a hardness estimation value corresponding to the hardness of the road surface based on a change with time of the load detected by the load detection unit. Situation recognition device.
前記硬さ推定部では、前記硬さ推定値が、前記アクチュエータ毎にそれぞれ求められ、当該アクチュエータ毎に重み付けをした状態で、当該アクチュエータ毎に求めた前記各硬さ推定値を加算することで、前記硬さ推定値の最終値が決定されることを特徴とする請求項2記載の路面状況認識装置。 A plurality of the actuators are provided to operate the legs separately.
In the hardness estimation unit, the hardness estimation value is obtained for each actuator, and in a state where weighting is performed for each actuator, by adding the hardness estimation values obtained for each actuator, The road surface condition recognition apparatus according to claim 2, wherein a final value of the estimated hardness value is determined.
前記情報決定手段は、前記姿勢検出部で検出された姿勢の経時的変化に基づき、前記路面の凹凸の程度に対応した粗さ推定値を求める粗さ推定部を更に備えたことを特徴とする請求項1、2又は3記載の路面状況認識装置。 The detection means further includes a posture detection unit that detects a posture of the moving body,
The information determination unit further includes a roughness estimation unit that obtains a roughness estimation value corresponding to the degree of unevenness of the road surface based on a change in the posture detected by the posture detection unit over time. The road surface condition recognition apparatus according to claim 1, 2 or 3.
移動時における前記移動体の状態に基づいて、前記路面の状況に対応した路面情報を求める情報決定手段として前記コンピュータを機能させ、
前記情報決定手段では、前記路面情報として、前記アクチュエータに対する負荷の経時的変化から前記路面の硬さに対応した硬さ推定値が求められ、及び/又は、前記移動体の姿勢の経時的変化から前記路面の凹凸の程度に対応した粗さ推定値が求められることを特徴とする路面状況認識装置のプログラム。 In a program for causing a computer of a road surface situation recognition device to recognize the situation of the road surface when moving a moving body that moves while repeatedly making contact and non-contact with the road surface by the power of an actuator,
Based on the state of the moving body during movement, the computer functions as information determining means for obtaining road surface information corresponding to the road surface condition,
In the information determining means, as the road surface information, an estimated hardness value corresponding to the hardness of the road surface is obtained from a change with time of the load on the actuator, and / or from a change with time of the posture of the moving body. A program for a road surface condition recognition apparatus, wherein an estimated roughness value corresponding to the degree of unevenness of the road surface is obtained.
前記移動体は、前記路面に対して接触及び非接触を繰り返し行うことで前記移動体を移動させる脚部と、当該脚部の動力として駆動するアクチュエータとを備え、
前記路面状況認識装置は、移動時における前記移動体の状態に基づいて、前記路面の状況に対応した路面情報を求める情報決定手段を備え、
前記情報決定手段では、前記路面情報として、前記アクチュエータに対する負荷の経時的変化から前記路面の硬さに対応した硬さ推定値が求められ、及び/又は、前記移動体の姿勢の経時的変化から前記路面の凹凸の程度に対応した粗さ推定値が求められ、
前記制御装置は、前記移動体に所望の動作させるために前記アクチュエータの駆動を制御する駆動制御手段と、前記路面状況認識装置で求められた前記路面情報に応じて、前記移動体の動作を変更するように、前記駆動制御手段に指令する動作変更指令手段とを備えたことを特徴とする移動体システム。 In a moving body system comprising a moving body capable of moving on a predetermined road surface, a road surface state recognition device that recognizes the state of the road surface when the moving body moves, and a control device that performs operation control of the moving body,
The moving body includes a leg portion that moves the moving body by repeatedly performing contact and non-contact with the road surface, and an actuator that is driven as power of the leg portion,
The road surface condition recognition device comprises information determining means for obtaining road surface information corresponding to the road surface condition based on the state of the moving body during movement,
In the information determining means, as the road surface information, an estimated hardness value corresponding to the hardness of the road surface is obtained from a change with time of the load on the actuator, and / or from a change with time of the posture of the moving body. A roughness estimation value corresponding to the degree of unevenness of the road surface is obtained,
The control device changes the operation of the moving body according to the road surface information obtained by the drive control means for controlling the driving of the actuator to cause the moving body to perform a desired operation and the road surface condition recognition device. Thus, a moving body system comprising an operation change command means for commanding the drive control means.
前記動作変更指令手段では、前記硬さ推定値が所定の閾値以下のときに、又は、前記粗さ推定値が所定の閾値以上のときに、前記移動体を後退させ、及び/又は、前記移動体の移動経路を再設定するように、前記駆動制御手段に指令することを特徴とする請求項7記載の移動体システム。 In the information determining means, the hardness estimated value and the roughness estimated value are obtained,
In the operation change command means, when the estimated hardness value is equal to or less than a predetermined threshold value, or when the estimated roughness value is equal to or greater than a predetermined threshold value, the moving body is moved backward and / or moved. 8. The moving body system according to claim 7, wherein the driving control means is instructed to reset the moving path of the body.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015169850A JP6601670B2 (en) | 2015-08-28 | 2015-08-28 | Road surface condition recognition device, program thereof, and mobile system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015169850A JP6601670B2 (en) | 2015-08-28 | 2015-08-28 | Road surface condition recognition device, program thereof, and mobile system |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2017045432A true JP2017045432A (en) | 2017-03-02 |
JP6601670B2 JP6601670B2 (en) | 2019-11-06 |
Family
ID=58212264
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2015169850A Active JP6601670B2 (en) | 2015-08-28 | 2015-08-28 | Road surface condition recognition device, program thereof, and mobile system |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6601670B2 (en) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109990783A (en) * | 2017-12-29 | 2019-07-09 | 深圳市优必选科技有限公司 | A kind of robot motion's paths planning method, robot and storage medium |
WO2020184318A1 (en) * | 2019-03-14 | 2020-09-17 | ソニー株式会社 | Information processing device, mobile body, and method for identifying state of mobile body |
JP2022518880A (en) * | 2019-12-26 | 2022-03-17 | ベイジン センスタイム テクノロジー デベロップメント カンパニー, リミテッド | Methods, devices, robots that control the robot to escape from the trapped state |
CN114544465A (en) * | 2022-04-26 | 2022-05-27 | 深圳市中航环海建设工程有限公司 | Road construction quality detection device |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07160334A (en) * | 1993-12-02 | 1995-06-23 | Mutoh Ind Ltd | Uneven road surface travel controller for traveling robot |
JP2005007528A (en) * | 2003-06-19 | 2005-01-13 | Seiko Epson Corp | Robot controlling device and robot controlling method |
JP2014100767A (en) * | 2012-11-20 | 2014-06-05 | Toshiba Corp | Level difference walking control device and method of multileg walking robot |
JP2014119349A (en) * | 2012-12-17 | 2014-06-30 | Ihi Aerospace Co Ltd | Mobile robot travelling area discrimination device and travelling area discrimination method |
JP2014200880A (en) * | 2013-04-04 | 2014-10-27 | トヨタ自動車株式会社 | Robot device, robot device controlling method and program |
-
2015
- 2015-08-28 JP JP2015169850A patent/JP6601670B2/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07160334A (en) * | 1993-12-02 | 1995-06-23 | Mutoh Ind Ltd | Uneven road surface travel controller for traveling robot |
JP2005007528A (en) * | 2003-06-19 | 2005-01-13 | Seiko Epson Corp | Robot controlling device and robot controlling method |
JP2014100767A (en) * | 2012-11-20 | 2014-06-05 | Toshiba Corp | Level difference walking control device and method of multileg walking robot |
JP2014119349A (en) * | 2012-12-17 | 2014-06-30 | Ihi Aerospace Co Ltd | Mobile robot travelling area discrimination device and travelling area discrimination method |
JP2014200880A (en) * | 2013-04-04 | 2014-10-27 | トヨタ自動車株式会社 | Robot device, robot device controlling method and program |
Non-Patent Citations (1)
Title |
---|
田中 克明,他7名: "自律移動型環境モニタリングロボットの開発", 第31回日本ロボット学会学術講演会, JPN6019022223, 4 September 2013 (2013-09-04), JP, pages 447 - 450, ISSN: 0004057197 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109990783A (en) * | 2017-12-29 | 2019-07-09 | 深圳市优必选科技有限公司 | A kind of robot motion's paths planning method, robot and storage medium |
CN109990783B (en) * | 2017-12-29 | 2021-03-02 | 深圳市优必选科技有限公司 | Robot motion path planning method, robot and storage medium |
WO2020184318A1 (en) * | 2019-03-14 | 2020-09-17 | ソニー株式会社 | Information processing device, mobile body, and method for identifying state of mobile body |
JP2022518880A (en) * | 2019-12-26 | 2022-03-17 | ベイジン センスタイム テクノロジー デベロップメント カンパニー, リミテッド | Methods, devices, robots that control the robot to escape from the trapped state |
CN114544465A (en) * | 2022-04-26 | 2022-05-27 | 深圳市中航环海建设工程有限公司 | Road construction quality detection device |
CN114544465B (en) * | 2022-04-26 | 2022-07-29 | 深圳市中航环海建设工程有限公司 | Road construction quality detection device |
Also Published As
Publication number | Publication date |
---|---|
JP6601670B2 (en) | 2019-11-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6601670B2 (en) | Road surface condition recognition device, program thereof, and mobile system | |
US11530920B2 (en) | Controlling movement of a machine using sensor fusion | |
CN103412565B (en) | A kind of robot localization method with the quick estimated capacity of global position | |
JP6900897B2 (en) | Obstacle detector for construction machinery | |
US11921508B2 (en) | Systems and methods for ground plane estimation | |
JP5310285B2 (en) | Self-position estimation apparatus and self-position estimation method | |
JP2009096335A (en) | Legged robot | |
CN113390411B (en) | Foot type robot navigation and positioning method based on variable configuration sensing device | |
JP2016024598A (en) | Control method of autonomous mobile apparatus | |
WO2019239668A1 (en) | System including work machine, method executed by computer, production method for learned position-estimation model, and learning data | |
WO2015137169A1 (en) | Terrain determination device, legged mobile robot, robot system, control method for legged mobile robot, and control method for robot system | |
WO2020167299A1 (en) | Printing systems | |
JP7275553B2 (en) | MOBILE BODY, MOBILE BODY CONTROL METHOD AND PROGRAM | |
JP2024514793A (en) | Method and system for determining machine condition - Patents.com | |
Piyathilaka et al. | An experimental study on using visual odometry for short-run self localization of field robot | |
KR101061066B1 (en) | Sensor assembly for terrain detecting and autonomous vehicle having the same | |
Lee et al. | Sensor information analysis for a humanoid robot | |
JP5895682B2 (en) | Obstacle detection device and moving body equipped with the same | |
Reina | Methods for wheel slip and sinkage estimation in mobile robots | |
Awashima et al. | Safeness visualization of terrain for teleoperation of mobile robot using 3D environment map and dynamic simulator | |
Marques et al. | Autonomous robot for mapping using ultrasonic sensors | |
US9970770B1 (en) | Method for tracking movement of a mobile robotic device | |
JP2009006982A (en) | Leg wheel type robot | |
WO2019159278A1 (en) | Work machine | |
JP2020051066A (en) | Construction machine |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20180803 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A821 Effective date: 20180803 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20190531 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20190621 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20190704 |
|
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: 20190905 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20190925 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6601670 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 |