JP2007152470A - Robot with self-diagnostic function - Google Patents
Robot with self-diagnostic function Download PDFInfo
- Publication number
- JP2007152470A JP2007152470A JP2005349117A JP2005349117A JP2007152470A JP 2007152470 A JP2007152470 A JP 2007152470A JP 2005349117 A JP2005349117 A JP 2005349117A JP 2005349117 A JP2005349117 A JP 2005349117A JP 2007152470 A JP2007152470 A JP 2007152470A
- Authority
- JP
- Japan
- Prior art keywords
- robot
- diagnosis
- unit
- self
- output signal
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Withdrawn
Links
Images
Abstract
Description
本発明は、自己診断機能付きロボットに関する。 The present invention relates to a robot with a self-diagnosis function.
ロボットには、正確な動作のため、もしくは安全を確保するために、各種のセンサが設けられている。
このため、ロボットには、各センサに故障が生じていないかどうかを判定する自己診断機能を設けることが求められている。
センサの診断部としては、例えば後記の特許文献１に記載のガスセンサの診断部が知られている。
このガスセンサの診断部は、第一の検知手段と、第二の検知手段と、これら第一、第二の検知手段の出力値を比較する比較手段とを有しており、第一の検知手段の出力値と第二の検知手段の出力値とがほぼ等しくなる条件下でこれらの出力値の差が設定値以上となった場合にセンサが異常であると診断するものである。
For this reason, the robot is required to have a self-diagnosis function for determining whether or not a failure has occurred in each sensor.
As a sensor diagnosis unit, for example, a gas sensor diagnosis unit described in Patent Document 1 described below is known.
The diagnostic unit of the gas sensor includes first detection means, second detection means, and comparison means for comparing the output values of the first and second detection means. When the difference between these output values is equal to or larger than the set value under the condition that the output value of the second detection means is substantially equal to the output value of the second detection means, the sensor is diagnosed as abnormal.
しかしながら、このようにセンサを二重化すると、コストがかかってしまうので、好ましくない。 However, duplicating the sensor in this way is not preferable because it costs more.
本発明は、上記問題を解決するためになされたもので、低コストで自己診断を行うことができる自己診断機能付きロボットを提供することを目的とする。 The present invention has been made to solve the above problems, and an object thereof is to provide a robot with a self-diagnosis function capable of performing self-diagnosis at low cost.
上記課題を解決するために、本発明は以下の手段を採用する。
本発明は、ロボット本体と、該ロボット本体に設けられる距離センサと、前記ロボット本体に設けられるアームと、該アームの動作を制御する駆動制御部と、前記距離センサ、前記アーム、及び前記駆動制御部の診断を行う診断部とを有しており、該診断部が、前記駆動制御部に、前記アームを前記距離センサの検出領域内と該検出領域外との間で移動させる動作指令を送ったのちに、前記距離センサの出力信号に変動が生じなかった場合に、故障が生じていると判定する自己診断機能付きロボットを提供する。
In order to solve the above problems, the present invention employs the following means.
The present invention provides a robot main body, a distance sensor provided in the robot main body, an arm provided in the robot main body, a drive control unit that controls the operation of the arm, the distance sensor, the arm, and the drive control. A diagnosis unit that performs diagnosis of the unit, and the diagnosis unit sends an operation command to move the arm between the detection area of the distance sensor and the outside of the detection area to the drive control unit. A robot with a self-diagnosis function that determines that a failure has occurred when there is no change in the output signal of the distance sensor is provided.
このように構成される自己診断機能付きロボットでは、自己診断を行うにあたって、診断部が、駆動制御部に、アームを距離センサの検出領域内と検出領域外との間で移動させる動作指令を送る。
このとき、距離センサ、アーム、駆動制御部の全てが正常に機能している場合には、動作指令のとおりにアームが距離センサの検出領域内と検出領域外との間で移動するので、距離センサの出力信号には、なんらかの変動が生じる。
言い換えれば、診断部が動作指令を発しても、距離センサの出力信号に変化が見られない場合は、距離センサ、アーム、駆動制御部のうちの少なくともいずれか一つが故障しているということである。
このように、本発明に係る自己診断機能付きロボットでは、センサを二重化することなしに、自身に設けられている構成のみを用いて、自身の故障の有無を診断することができる。
In the robot with the self-diagnosis function configured as described above, in performing the self-diagnosis, the diagnosis unit sends an operation command for moving the arm between the detection area of the distance sensor and the outside of the detection area to the drive control unit. .
At this time, if all of the distance sensor, arm, and drive control unit are functioning normally, the arm moves between the detection area of the distance sensor and the outside of the detection area according to the operation command. Some variation occurs in the output signal of the sensor.
In other words, even if the diagnosis unit issues an operation command, if there is no change in the output signal of the distance sensor, it means that at least one of the distance sensor, the arm, and the drive control unit has failed. is there.
Thus, the robot with a self-diagnosis function according to the present invention can diagnose the presence or absence of its own failure using only the configuration provided in itself without duplicating the sensor.
ここで、距離センサ、アーム、駆動制御部の全てが機能していて、アームが動作指令に従って動作すると、距離センサによってアームの動作が検出される。このときの距離センサの出力信号には、アームの動作パターンを反映した波形が現れる。
言い換えれば、距離センサの実際の出力信号波形と、アームが動作指令に忠実に従って動作した場合に検出されるであろう出力信号波形（予想出力信号波形）とを比較し、これらの差が大きい場合には、アームが動作指令のとおりに動作していないか、距離センサが故障していると判断することができる。
そこで、診断部を、駆動制御部に対してアームを距離センサの検出領域内で所定のパターンで動作させる動作指令を送ったのちに、距離センサの実際の出力信号波形と、予想出力信号波形とを比較し、これらの差が基準範囲を超えた場合には、故障と判断する構成とすることで、より高精度に故障の判定を行うことができる。
Here, when the distance sensor, the arm, and the drive control unit are all functioning and the arm operates according to the operation command, the operation of the arm is detected by the distance sensor. At this time, a waveform reflecting the operation pattern of the arm appears in the output signal of the distance sensor.
In other words, when the actual output signal waveform of the distance sensor is compared with the output signal waveform (expected output signal waveform) that would be detected when the arm moved according to the operation command, and the difference between them is large It can be determined that the arm is not operating according to the operation command or that the distance sensor is malfunctioning.
Therefore, after sending the operation command for operating the arm in a predetermined pattern within the detection area of the distance sensor to the drive control unit, the diagnosis unit outputs the actual output signal waveform and the expected output signal waveform of the distance sensor. If these differences exceed the reference range, it is possible to determine a failure with higher accuracy by adopting a configuration in which a failure is determined.
また、本発明は、ロボット本体と、該ロボット本体に設けられるマイクロフォンと、前記ロボット本体に設けられるスピーカと、該スピーカの動作を制御する音声処理部と、前記マイクロフォン、前記スピーカ、及び前記音声処理部の診断を行う診断部とを有しており、該診断部が、前記音声処理部に、前記スピーカから音声を出力させる動作指令を送ったのちに、前記マイクロフォンの出力信号に変動が生じなかった場合に、故障が生じていると判定する自己診断機能付きロボットを提供する。 The present invention also provides a robot main body, a microphone provided in the robot main body, a speaker provided in the robot main body, a sound processing unit that controls the operation of the speaker, the microphone, the speaker, and the sound processing. The microphone output signal does not change after the diagnosis unit sends an operation command to output sound from the speaker to the sound processing unit. A robot with a self-diagnosis function that determines that a failure has occurred is provided.
このように構成される自己診断機能付きロボットでは、自己診断を行うにあたって、診断部が、音声処理部に、スピーカから音声を出力させる動作指令を送る。
このとき、マイクロフォン、スピーカ、音声処理部の全てが正常に機能している場合には、動作指令のとおりにスピーカから音声が出力されるので、マイクロフォンの出力信号には、なんらかの変動が生じる。
言い換えれば、診断部が動作指令を発しても、マイクロフォンの出力信号に変化が見られない場合は、マイクロフォン、スピーカ、音声処理部のうちの少なくともいずれか一つが故障しているということである。
このように、本発明に係る自己診断機能付きロボットでは、センサを二重化することなしに、自身に設けられている構成のみを用いて、自身の故障の有無を診断することができる。
In the robot with the self-diagnosis function configured as described above, when performing the self-diagnosis, the diagnosis unit sends an operation command for outputting sound from the speaker to the sound processing unit.
At this time, if all of the microphone, the speaker, and the sound processing unit are functioning normally, the sound is output from the speaker as instructed by the operation command, so that some variation occurs in the output signal of the microphone.
In other words, even if the diagnosis unit issues an operation command, if no change is observed in the output signal of the microphone, it means that at least one of the microphone, the speaker, and the sound processing unit has failed.
Thus, the robot with a self-diagnosis function according to the present invention can diagnose the presence or absence of its own failure using only the configuration provided in itself without duplicating the sensor.
ここで、マイクロフォン、スピーカ、音声処理部の全てが機能していて、スピーカが動作指令に従って動作すると、マイクロフォンによってスピーカが出力した音声が検出される。このときのマイクロフォンの出力信号には、スピーカが出力した音声パターンを反映した波形が現れる。
言い換えれば、マイクロフォンの実際の出力信号波形と、スピーカが動作指令に忠実に従って動作した場合に検出されるであろう出力信号波形（予想出力信号波形）とを比較し、これらの差が大きい場合には、スピーカが動作指令のとおりに動作していないか、マイクロフォンが故障していると判断することができる。
そこで、診断部を、音声処理部に対してスピーカから所定の音声を出力させる動作指令を送ったのちに、マイクロフォンの実際の出力信号波形と、予想出力信号波形とを比較し、これらの差が基準範囲を超えた場合には、故障と判断する構成とすることで、より高精度に故障の判定を行うことができる。
Here, when the microphone, the speaker, and the sound processing unit are all functioning and the speaker operates according to the operation command, the sound output from the speaker is detected by the microphone. At this time, a waveform reflecting the sound pattern output from the speaker appears in the output signal of the microphone.
In other words, when the actual output signal waveform of the microphone is compared with the output signal waveform (expected output signal waveform) that will be detected when the speaker operates in accordance with the operation command, and the difference between these is large Can determine that the speaker is not operating according to the operation command or that the microphone is malfunctioning.
Therefore, after sending the operation command to output a predetermined sound from the speaker to the sound processing unit, the diagnosis unit compares the actual output signal waveform of the microphone with the expected output signal waveform, and the difference between them is When it exceeds the reference range, it is possible to determine a failure with higher accuracy by adopting a configuration in which a failure is determined.
本発明に係る自己診断機能付きロボットによれば、センサを二重化することなしに、自己診断を行うことができるので、コストを低減することができる。 According to the robot with a self-diagnosis function according to the present invention, the self-diagnosis can be performed without duplicating the sensor, and thus the cost can be reduced.
以下に、本発明に係る自己診断機能付きロボット（以下、単に「ロボット」という。）の一実施形態について、図面を参照して説明する。
図１は、本発明の一の実施形態に係るロボットの正面図、図２は、図１に示したロボットの左側面図である。
図１および図２に示すように、ロボット本体１には、頭部２と、この頭部２を下方から支持する胸部３と、この胸部３の右側に設けられた右腕部４ａ（アーム）、胸部３の左側に設けられた左腕部４ｂ（アーム）と、胸部３の下方に接続された腰部５と、この腰部５の下方に接続されたスカート部６と、このスカート部６の下方に接続された脚部７とが設けられている。
Hereinafter, an embodiment of a robot with a self-diagnosis function (hereinafter simply referred to as “robot”) according to the present invention will be described with reference to the drawings.
FIG. 1 is a front view of a robot according to an embodiment of the present invention, and FIG. 2 is a left side view of the robot shown in FIG.
As shown in FIGS. 1 and 2, the robot body 1 includes a
頭部２には、頭頂部近傍に全方位カメラ１１（周辺状況撮影装置）が一つ設けられている。この全方位カメラ１１の外周に沿って複数の赤外線ＬＥＤ１２が所定の間隔で円環上に配置されている。
頭部２の前面の中央近傍には、図１に示すように、前方を撮像するための前方カメラ１３が正面視して右側に一つ、マイクロフォン１４が正面視して左側に一つ、それぞれ設けられている。
The
In the vicinity of the center of the front surface of the
胸部３の前面の中央近傍には、モニタ１５が一つ設けられている。このモニタ１５の上方には、人を検知するための超音波距離センサ１６が一つ設けられている。モニタ１５の下方には、電源スイッチ１７が一つ設けられている。超音波距離センサ１６の上方には、２つのスピーカ１８が左右に一つずつ設けられている。また、図２に示すように、胸部３の背面には、荷物を収納することができるランドセル部３３が設けられている。ランドセル部３３には、上部に設けたヒンジ周りに回動可能な開閉扉３３ａが設けられている。
One
図１に示すように、胸部３の左右の肩部には、マンマシンインターフェースとして機能する肩スイッチ１９がそれぞれ一つずつ設けられている。肩スイッチ１９には、例えば、タッチセンサが採用されている。
ここで、本実施形態では、ユーザが肩スイッチ１９を所定時間（例えば５秒間）押しつづけることで、後述する制御装置５１がロボット本体１の現在の動作モードを中止させたり、直前に終了した各種認識処理をやり直すようになっている。
このように、肩スイッチ１９をユーザが直接押圧することで、音声認識や画像認識等、外的要因によって精度が低下する可能性のある手段を用いて制御装置５１にユーザの意思を伝達する場合よりも、確実かつ直感的にユーザの意思を制御装置５１に伝達することが可能である。
As shown in FIG. 1, one
Here, in this embodiment, when the user keeps pressing the
As described above, when the user directly presses the
右腕部４ａおよび左腕部４ｂには、多関節構造が採用されている。右腕部４ａ、左腕部４ｂにおいて、胸部３との接続部近傍には、体や物の挟み込みを検知して腕の動作を止めるための脇スイッチ２０がそれぞれ設けられている。図１に示すように、右腕部４ａの手のひら部分には、マンマシンインターフェースとして機能する握手スイッチ２１が内蔵されている。これら脇スイッチ２０や握手スイッチ２１には、例えば、押圧センサが採用される。
ここで、本実施形態では、ユーザが握手スイッチ２１を所定時間（例えば５秒間）押し続けることで、制御装置５１が、現在のロボット本体５１の動作またはユーザに対する確認に対して、ユーザの承認が下りたと判断するようになっている。
また、このように、握手スイッチ２１をユーザが直接押圧することで、音声認識や画像認識等、外的要因によって精度が低下する可能性のある手段を用いて制御装置５１にユーザの意思を伝達する場合よりも、確実かつ直感的にユーザの意思を制御装置５１に伝達することが可能である。
A multi-joint structure is adopted for the
Here, in the present embodiment, when the user continues to press the
In addition, when the user directly presses the
腰部５の前面の中央近傍には、人を検知するための超音波距離センサ２２が左右に一つずつ設けられている。これら超音波距離センサ２２の下方には、複数の赤外線センサ２３が配列されたセンサ領域２４が設けられている。これら赤外線センサ２３は、ロボット本体１の下方前方にある障害物等を検出するためのものである。図１および図２に示すように、腰部５の下方には、前面および背面において、音源方向を検出するためのマイクロフォン２５が左右に一つずつ、計４つ設けられている。図２に示すように、腰部５の側面の左右には、本体を持ち上げるときに使用する取手部２６がそれぞれ一つずつ設けられている。取手部２６は、凹所とされており、操作者の手が挿入できるようになっている。
In the vicinity of the center of the front surface of the
スカート部６の前面下方には、段差を検出するための赤外線センサ２７が、中央および左右に計３つ設けられている。図２に示すように、スカート部６の背面には、充電コネクタ２８が設けられている。
Below the front surface of the
図１に示すように、脚部７の前面には、側方の距離を検出するための赤外線センサ２９が左右に一つずつ設けられている。これら赤外線センサ２９は、主に段差検出に用いられるものである。
図２に示すように、脚部７の背面には、充電ステーションにロボット本体１を位置固定するためのフック３０が設けられている。脚部７は、走行用車輪３１および４つのボールキャスタ３２を備えた台車とされている。
上述したロボットにおいて、胸部３の超音波距離センサ１６、腰部５の超音波距離センサ２２およびマイクロフォン２５は、ロボット周辺にいる人物を検知する人検知センサ３４として機能する。
As shown in FIG. 1, one
As shown in FIG. 2, a
In the robot described above, the
このようなロボットは、ロボット本体１に内蔵されたバッテリからの電源供給により、作業空間を自立的に移動することが可能な構成を備えており、一般家庭等の屋内を作業空間として人間と共存し、例えば、一般家庭内でロボットの所有者や操作者などのユーザの生活を補助・支援・介護するための各種サービスを提供するために用いられる。
そのため、ロボットは、ユーザとの会話を実現させる会話機能のほか、ユーザの行動を見守ったり、ユーザの行動を補助したり、ユーザと一緒に行動したりする機能を備えている。このような機能は、例えば、後述するロボット本体１の内部に内蔵されたマイクロコンピュータ等からなる制御装置により実現されるものである。制御装置には、図１および図２に示した各種カメラや各種センサ等が接続されており、カメラからの画像情報やセンサからのセンサ検出情報を取得し、これらの情報に基づいて各種プログラムを実行することにより、上述した各種機能を実現させる。なお、ロボット本体１の形状としては、図１および図２に示した形状に限られず、愛玩用に動物を模したものなど、種々のものを採用することが可能である。
Such a robot has a configuration capable of moving independently in a work space by supplying power from a battery built in the robot body 1, and coexists with a human being as a work space indoors. For example, it is used to provide various services for assisting, supporting, and caring for the lives of users such as robot owners and operators in general households.
Therefore, in addition to a conversation function that realizes a conversation with the user, the robot has a function of watching the user's action, assisting the user's action, and acting with the user. Such a function is realized by, for example, a control device including a microcomputer or the like built in the robot body 1 described later. Various cameras and various sensors shown in FIGS. 1 and 2 are connected to the control device, acquire image information from the cameras and sensor detection information from the sensors, and execute various programs based on these information. By executing this, the various functions described above are realized. The shape of the robot body 1 is not limited to the shape shown in FIGS. 1 and 2, and various shapes such as a model imitating an animal for pets can be adopted.
以下、ロボット本体１に内蔵されるロボットの電気的構成について図３を参照して説明する。図３において、図１乃至図２と同様の構成要素には、同一の符号を付している。
図３に示すように、本実施形態に係るロボットは、その本体内部に、制御装置５１、画像処理部５２、音声処理部５３、表示制御部５４、無線通信部５５、駆動制御部５６、駆動機構５７、及びバッテリ５８を備えている。
画像処理部５２、音声処理部５３、表示制御部５４、無線通信部５５、及び駆動制御部５６は、制御装置５１と互いに接続されており、制御装置５１からの制御信号に基づいて各種処理を実行するとともに、その処理結果や各種センサからの情報等を制御装置５１へ提供する。バッテリ５８は、各構成要素に対して電力を供給する電源装置として機能する。
Hereinafter, the electrical configuration of the robot built in the robot body 1 will be described with reference to FIG. 3, the same components as those in FIGS. 1 and 2 are denoted by the same reference numerals.
As shown in FIG. 3, the robot according to the present embodiment includes a
The
画像処理部５２は、制御装置５１からの制御信号に基づいて、図１に示した全方位カメラ１１、前方カメラ１３によって撮影された画像を処理して、制御装置５１へ出力する。
音声処理部５３は、制御装置５１からの制御信号に基づいて、マイクロフォン１４から入力される音声信号を認識する音声認識処理を実行し、この音声認識結果を制御装置５１へ出力する。更に、音声処理部５３は、制御装置５１から供給される音声データに基づいて、スピーカ１８から発すべき音声信号を生成する音声合成処理を実行し、この音声信号をスピーカ１８へ出力する。すなわち、制御装置５１内の発話に関する情報処理、並びに、上記音声処理部５３、マイクロフォン１４、およびスピーカ１８等により、このロボット本体１の発話手段が構成される。
表示制御部５４は、制御装置５１から与えられた画像データを処理して、モニタ１５に表示させる。
The
The
The
無線通信部５５は、アンテナ５５ａを介して外部との無線通信を実行する。具体的には、無線通信部５５は、外部に設けられた情報管理装置（図示せず）とネットワークを介して接続することにより、両者間での情報の授受を実現させる。
駆動制御部５６は、制御装置５１からの指令に応じて走行用駆動機構５７を制御することにより、走行用車輪３１を駆動してロボット本体１の走行および操舵を実行する。更に、駆動制御部５６は、頭部２と胸部３との間の首関節や、胸部３と右腕部４ａ間、胸部３と左腕部４ｂ間の肩関節、右腕部４ａ、左腕部４ｂ内の肘関節、手首関節等を駆動するためにそれぞれ設けられている各駆動機構（図示略）を制御することにより、ロボットの腕等を駆動し、様々な動作を実現させる。
例えば、ユーザに意思確認を求める状況になった場合には、制御装置５１から駆動制御部５６に動作指令が送られて、握手スイッチ２１が設けられた右腕部４ａをロボット本体１の前方に差し出して、握手スイッチ２１による意思確認をユーザに促すようになっている。
また、上記頭部２の顔表情についても、モータ等の駆動機構を制御することにより可変となっている。
バッテリ５８は、充電コネクタ２８が家庭内に設けられた充電ステーション（図示せず）に電気的に接続することにより自動的に充電される。
The
The
For example, when the user is asked to confirm his / her intention, an operation command is sent from the
The facial expression of the
The
制御装置５１は、上述したように、ロボット本体１の各構成要素を制御するものであり、動作モード設定部６１、動作モード実行部６２、ユーザ認識部（顔認識処理部）６３、自己位置認識部６４、光源位置判定部６５、撮影状況通知部６６、サービス用スケジュール情報管理部７０、動作アプリケーション記憶部７２、診断部７３等を備えている。
As described above, the
上記サービス用スケジュール情報管理部７０は、ユーザにより予約されたサービス用スケジュール情報を管理する。このサービス用スケジュール情報は、予約を登録したユーザの識別番号、予約されたサービスの内容、該サービスの開始時間ならびに終了時間が互いに対応付けられた情報である。サービス用スケジュール情報管理部７０は、一定時間間隔でこのサービス用スケジュール情報を参照し、予約開始時刻になると、予約開始時刻となったサービスの内容、終了時間、ユーザの識別番号等を予約開始情報として動作モード設定部６１へ出力する。
The service schedule
動作アプリケーション記憶部７２には、後述する各種動作モードを実現させるために必要となる各種動作アプリケーションが格納されているほか、該動作アプリケーションを実行するのに必要となる付加情報等、例えば、家庭内の地図情報、ユーザへの話かけを行うための音声データ、ユーザとの会話時やユーザとの対話時における身振り動作の駆動データ等が格納されている。
上記地図情報は、ロボット本体１が家庭内を自律的に移動するために必要となるマップ情報であり、家庭内での後述するマーカの位置、ユーザにより予め登録された家庭内の所定の位置（例えば、テラス、リビング、寝室、玄関等の各任意位置）に関する位置情報、後述する巡回モードにおいて巡回を行う各巡回ポイントの位置情報、充電ステーションの位置情報、並びに、これらを移動するために必要となる経路情報等が含まれている。
The operation
The map information is map information necessary for the robot body 1 to move autonomously in the home, and the position of a marker to be described later in the home, a predetermined location in the home registered in advance by the user ( For example, location information on each of the terraces, living rooms, bedrooms, entrances, etc.), location information of each traveling point for patrol in the patrol mode described later, location information of the charging station, and necessary to move these Route information and the like.
動作モード設定部６１は、上記サービス用スケジュール情報管理部７０および音声処理部５３から入力されたユーザからのサービス要求指令に基づいて、動作モード実行部６２に実行させる動作モードを現在のモードとして設定する。
動作モード実行部６２は、動作モード設定部６１により現在のモードとして設定された動作モードに対応する動作アプリケーションを動作アプリケーション記憶部７２から読み出し、この動作アプリケーションを実行することにより、各種動作モードに基づくサービス等をユーザに提供する。
The operation
The operation
ユーザ認識部６３は、画像処理部５２から受け付けた画像に基づいて顔認証を行うことにより、予め登録されているユーザを識別する。顔認証によるユーザ認証の手法については、公知の技術を採用することが可能である。
The
自己位置認識部６４は、画像処理部５２から受け付けた画像情報に基づいてロボット本体１の位置および方位（向き、姿勢）を認識するとともに、上記地図情報を参照することにより、家庭内における現在位置を特定する。
ここで、ロボット本体１が運用される作業空間では、各室内に、赤外線を反射する複数のマーカが設けられている。これにより、制御装置５１が赤外線ＬＥＤ１２を発光させると、全方位カメラ１１にマーカからの赤外線の反射光が撮影され、全方位カメラ１１の撮影画像から、画像処理部５２によってマーカの位置が認識される。
自己位置認識部６４は、画像処理部５２が認識したマーカの位置と、予め取得しておいたこのマーカの位置情報とに基づいて、ロボット本体１の現在位置と向きとを特定する。
このように、自己の位置を常に把握するこのできる自己位置認識部６４を備えているので、当該ロボットは、自律的に家庭内を移動することができる。
The self
Here, in the work space in which the robot body 1 is operated, a plurality of markers that reflect infrared rays are provided in each room. As a result, when the
The self-
As described above, since the self-
診断部７３は、赤外線ＬＥＤ１２の発光動作を制御し、音声処理部５３へはスピーカ１８の動作指令を送り、駆動制御部５６へは右腕部４ａ及び左腕部４ｂの動作指令を送り、その後の制御装置５１の出力、画像処理部５２の出力、音声処理部５３の出力に基づいて、ロボット本体１の各部について故障の有無を判定する。診断部７３による故障の判定方法については後述する。
The
上述した制御装置５１は、例えば、ＣＰＵ（中央演算装置）、ＲＯＭ（Read Only Memory）、ＲＡＭ（Random Access Memory）等を備えるマイクロコンピュータ等により構成されている。上述した各部を実現するための一連の処理手順は、プログラムの形式でＲＯＭ等に記録されており、このプログラムをＣＰＵがＲＡＭ等に読み出して、情報の加工・演算処理を実行することにより、上述の動作モード設定部６１、動作モード実行部６２等の機能や各動作モードの実行によるサービスの提供が実現される。
The
次に、本実施形態に係るロボットの動作について説明する。
まず、図３の動作モード設定部６１は、ロボットが起動された後は、動作モードを自己診断モードに移行して、ロボットに各部の自己診断を行わせる。なお、自己診断の詳細については後述する。
動作モード設定部６１は、自己診断を終えたのちは、自己診断モードを終了させ、動作モードに対応する各種キーワード等が音声により入力された場合、或いは、サービス用スケジュール情報管理部７０から予約開始情報を受け付けた場合に、対応する動作モードを現在のモードとして設定する。
Next, the operation of the robot according to this embodiment will be described.
First, after the robot is activated, the operation
After completing the self-diagnosis, the operation
上記のように、所定の動作モードが現在のモードとして設定されると、動作モード実行部６２は、現在のモードとして設定された動作モードに対応する動作アプリケーションを動作アプリケーション記憶部７２から読み出して実行する。これにより、各種動作モードに対応する動作が提供されたり、各動作モードに対応するサービスがユーザに対して提供されることとなる。
また、上述のようなサービスの提供と並行して、ユーザ認識部６３によりサービスを提供している相手であるユーザの認証が行われる。
As described above, when the predetermined operation mode is set as the current mode, the operation
In parallel with the provision of the service as described above, the
以下、このロボットの自己診断の流れについて、図４のフローチャートを参照して詳細に説明する。なお、以下では、一例として、超音波距離センサ１６，２２、右腕部４ａ、左腕部４ｂ、及び駆動制御部５６の自己診断の流れについて説明する。
動作モードが自己診断モードに設定されると、制御装置５１は、診断部７３に、自己診断指令を出力する。
診断部７３は、自己診断指令を受けることで、音声処理部５３に、ユーザに自己診断開始を通知するような音声データ（例えば「今日の調子はどうかな？」といったセリフの音声データ）を発するように動作指令を送る。音声処理部５３がこの音声データに基づく音声信号をスピーカ１８へ出力することにより、この音声がスピーカ１８から発せられることとなる（ステップＳ１）。
Hereinafter, the flow of the self-diagnosis of the robot will be described in detail with reference to the flowchart of FIG. In the following, the flow of self-diagnosis of the
When the operation mode is set to the self-diagnosis mode, the
Upon receiving the self-diagnosis command, the
その後、診断部７３は、肩スイッチ１９が押されたかどうかを監視し（ステップＳ２）、肩スイッチ１９が所定時間以上押されたことを検出すると、自己診断処理を停止して、動作モード設定部６１に他の動作モードを現在のモードとして設定させる（ステップＳ３）。
Thereafter, the
一方、肩スイッチ１９が押されていない場合には、診断部７３は、自己診断処理を継続する。
自己診断処理が継続される場合には、診断部７３は、まず、駆動制御部５６に、右腕部４ａまたは左腕部４ｂを、超音波距離センサ１６，２２の検出領域外から検出領域内に進入させるよう、動作指令を出力する（ステップＳ４）。
これにより、右腕部４ａまたは左腕部４ｂが正常であれば、超音波距離センサ１６、２２の検出領域外から検出領域内に進入する。具体的には、右腕部４ａが右側の超音波距離センサ２２の検出領域に進入させられ、左腕部４ｂが左側の超音波距離センサ２２の検出領域に進入させられる。ここで、胸部３に設けられた超音波距離センサ１６の検出領域には、右腕部４ａと左腕部４ｂとのうちのどちらが進入させられても良い。
On the other hand, when the
When the self-diagnosis process is continued, the
Thereby, if the
診断部７３は、駆動制御部５６に動作指令を出力したのちは、超音波距離センサ１６，２２の出力信号をそれぞれ監視する（ステップＳ５）。そして、この出力信号に変化が生じた場合には、右腕部４ａまたは左腕部４ｂが動作して、超音波距離センサ１６，２２の検出領域に進入し、これが超音波距離センサ１６，２２によって検出されたと判断して（すなわち故障が生じていないと判断して）、自己診断処理を終了し、動作モード設定部６１に他の動作モードを現在のモードとして設定させる（ステップＳ６）。
After outputting the operation command to the
一方、診断部７３は、超音波距離センサ１６，２２の出力信号に変化が生じなかった場合には、ロボットの動作履歴を参照して、自己診断処理を開始してから再起動処理を経験したかどうかを判定する（ステップＳ７）。まだ再起動を経験していない場合には、ロボットを再起動して各装置を一旦初期化したのち（ステップＳ８）、改めて自己診断モードを開始させる。
ここで、ステップＳ７において、すでに再起動を経験している場合には、診断部７３は、右腕部４ａ、左腕部４ｂ、超音波距離センサ１６，２２、駆動制御部５６のうちの少なくともいずれかが正しく動作していないと判断して（すなわち故障が生じていると判断して）、この故障情報を検証することができるように、無線通信部５５に動作指令を送って、故障が生じている旨の履歴情報を外部の情報管理装置に送信して記録させ、その後、自己診断処理を含むロボットの全ての動作を停止させる。（ステップＳ９）。
On the other hand, when there is no change in the output signals of the
Here, in step S <b> 7, when restarting has already been experienced, the
また、診断部７３は、上記の超音波距離センサ１６，２２に関連する自己診断と前後して、もしくは超音波距離センサ１６，２２に関連する自己診断と並行して、他のセンサに関連する自己診断を行う。
以下では、音声処理部５３、スピーカ１８、及びマイクロフォン１４，２５の自己診断の流れについて、図５のフローチャートを用いて説明する。
なお、音声処理部５３、スピーカ１８、及びマイクロフォン１４，２５の自己診断の流れは、超音波距離センサ１６，２２に関連する自己診断の流れと、ステップＳ３までが共通しており、ステップＳ４以降の処理が独自の処理となる。
The
Below, the flow of the self-diagnosis of the
Note that the flow of the self-diagnosis of the
具体的には、ステップＳ２において、肩スイッチ１９が押されておらず、自己診断処理が継続される場合には、診断部７３は、まず、音声処理部５３に、スピーカ１８から任意の音声を出力させる動作指令を送る。（ステップＳ１４）。
Specifically, in step S2, when the
診断部７３は、音声処理部５３に動作指令を出力したのちは、マイクロフォン１４，２５の出力信号をそれぞれ監視する（ステップＳ１５）。そして、この出力信号に変化が生じた場合には、スピーカ１８が音声を発して、この音声がマイクロフォン１４，２５によって検出されたと判断して（すなわち故障が生じていないと判断して）、自己診断処理を終了し、動作モード設定部６１に他の動作モードを現在のモードとして設定させる（ステップＳ１６）。
After outputting the operation command to the
一方、診断部７３は、マイクロフォン１４，２５の出力信号に変化が生じなかった場合には、ロボットの動作履歴を参照して、自己診断処理を開始してから再起動処理を経験したかどうかを判定する（ステップＳ１７）。まだ再起動を経験していない場合には、ロボットを再起動して各装置を一旦初期化したのち（ステップＳ１８）、改めて自己診断モードを開始させる。
ここで、ステップＳ１７において、すでに再起動を経験している場合には、診断部７３は、音声処理部５３、スピーカ１８、及びマイクロフォン１４，２５のうちの少なくともいずれかが正しく動作していないと判断して（すなわち故障が生じていると判断して）、無線通信部５５に動作指令を送って、故障が生じている旨の履歴情報を、外部の情報管理装置に送信して記録させ、その後、自己診断処理を含むロボットの全ての動作を停止させる。（ステップＳ１９）。
On the other hand, if there is no change in the output signals of the
Here, if restart has already been experienced in step S17, the
次に、赤外線ＬＥＤ１２、全方位カメラ１１、及び画像処理部５２の自己診断の流れについて説明する。なお、赤外線ＬＥＤ１２、全方位カメラ１１、及び画像処理部５２の自己診断の流れは、超音波距離センサ１６，２２に関連する自己診断の流れと、ステップＳ３までが共通しており、ステップＳ４以降の処理が独自の処理となる。
Next, the flow of self-diagnosis of the
具体的には、ステップＳ２において、肩スイッチ１９が押されておらず、自己診断処理が継続される場合には、診断部７３は、まず、赤外線ＬＥＤ１２を発光させるとともに、以降は、画像処理部５２の出力信号を監視する。そして、この出力信号に変化が生じた場合、もしくはマーカが一個でも認識された場合には、赤外線ＬＥＤが発光して、この光が全方位カメラ１１によって検出されたと判断して（すなわち故障が生じていないと判断して）、自己診断処理を終了し、動作モード設定部６１に他の動作モードを現在のモードとして設定させる。
Specifically, in step S2, when the
一方、診断部７３は、画像処理部５２の出力信号に変化が生じなかった場合には、ロボットの動作履歴を参照して、自己診断処理を開始してから再起動処理を経験したかどうかを判定する。まだ再起動を経験していない場合には、ロボットを再起動して各装置を一旦初期化したのち、改めて自己診断モードを開始させる。
ここで、ロボットがすでに再起動を経験している場合には、診断部７３は、赤外線ＬＥＤ１２、全方位カメラ１１、画像処理部５２のうちの少なくともいずれかが正しく動作していないと判断して（すなわち故障が生じていると判断して）、無線通信部５５に動作指令を送って、故障が生じている旨の履歴情報を、外部の情報管理装置に送信して記録させ、その後、自己診断処理を含むロボットの全ての動作を停止させる。
On the other hand, if there is no change in the output signal of the
Here, when the robot has already experienced the restart, the
ここで、障害物検出用の赤外線センサ２３、段差検出用の赤外線センサ２７，２９の自己診断にあたっては、診断部７３は、前記の地図情報から判断して周囲に障害物や段差のないと思われる領域で、各赤外線センサ２３，２７，２９を作動させて、障害物や段差が検出されない場合にはこれらセンサが正常であると判断して通常動作に移行させ、障害物や段差が検出された場合には故障が生じていると判断して、無線通信部５５に動作指令を送って、故障が生じている旨の履歴情報を、外部の情報管理装置に送信して記録させ、その後、自己診断処理を含むロボットの全ての動作を停止させる。
Here, in the self-diagnosis of the
このように、本実施形態にかかるロボットによれば、センサの二重化を行わずに、自身に設けられている構成のみを用いて、自身の故障の有無を診断することができるので、コストを抑えることができる。 As described above, according to the robot according to the present embodiment, it is possible to diagnose the presence / absence of the own failure without using dual sensors and using only the configuration provided in the robot. be able to.
ここで、上記実施形態では、診断部７３が、自己診断の過程で各センサの出力信号に変化があった場合には、このセンサに関連する装置に故障がないと判断する構成を示したが、これに限られることなく、より詳細に各センサ及びこのセンサに関連する装置の状態を検出する構成としても良い。
Here, in the above embodiment, a configuration has been described in which the
例えば、超音波距離センサ１６，２２、右腕部４ａ、左腕部４ｂ、駆動制御部５６の全てが機能していて、右腕部４ａ及び左腕部４ｂが動作指令に従って動作すると、超音波距離センサ１６，２２によって右腕部４ａまたは左腕部４ｂの動作が検出される。このときの超音波距離センサ１６，２２の出力信号には、右腕部４ａまたは左腕部４ｂの動作パターンを反映した波形が現れる。
そこで、前記の超音波距離センサ１６（または超音波距離センサ２２）に関連する自己診断の際に、図６のフローチャートに示すように、ステップＳ４を終えたのちは、超音波距離センサ１６の実際の出力信号波形Ｒ（図７（ａ）参照）と、右腕部４ａ（または左腕部４ｂ）が動作指令に忠実に従って動作した場合に検出されるであろう出力信号波形（予想出力信号波形Ｉ、図７（ｂ）参照）とを比較し（ステップＳ２１、Ｓ２２）、一定時間範囲内でのこれらの差Ｄ（図８参照）が大きい場合には、右腕部４ａまたは左腕部４ｂが動作指令のとおりに動作していないか、超音波距離センサ１６，２２が故障していると判断する。
これにより、右腕部４ａ（または左腕部４ｂ）や超音波距離センサ１６（または超音波距離センサ２２）の故障の判定を、さらに高精度に行うことができる。
For example, when all of the
Therefore, at the time of self-diagnosis related to the ultrasonic distance sensor 16 (or ultrasonic distance sensor 22), as shown in the flowchart of FIG. Output signal waveform R (see FIG. 7A) and an output signal waveform (expected output signal waveform I, which will be detected when the
Thereby, the determination of the failure of the
以上、本発明の実施形態について図面を参照して詳述してきたが、具体的な構成はこの実施形態に限られるものではなく、本発明の要旨を逸脱しない範囲の設計変更等も含まれる。 The embodiment of the present invention has been described in detail with reference to the drawings. However, the specific configuration is not limited to this embodiment, and includes design changes and the like within a scope not departing from the gist of the present invention.
１ ロボット本体
４ａ 右腕部（アーム）
４ｂ 左腕部（アーム）
１４，２５ マイクロフォン
１６，２２ 超音波距離センサ
１８ スピーカ
５３ 音声処理部
５６ 駆動制御部
７３ 診断部
1
4b Left arm (arm)
14, 25
Claims (4)
該ロボット本体に設けられる距離センサと、
前記ロボット本体に設けられるアームと、
該アームの動作を制御する駆動制御部と、
前記距離センサ、前記アーム、及び前記駆動制御部の診断を行う診断部とを有しており、
該診断部が、前記駆動制御部に、前記アームを前記距離センサの検出領域内と該検出領域外との間で移動させる動作指令を送ったのちに、前記距離センサの出力信号に変動が生じなかった場合に、故障が生じていると判定する自己診断機能付きロボット。 The robot body,
A distance sensor provided in the robot body;
An arm provided in the robot body;
A drive control unit for controlling the operation of the arm;
A diagnostic unit for diagnosing the distance sensor, the arm, and the drive control unit;
After the diagnosis unit sends an operation command to the drive control unit to move the arm between the detection area of the distance sensor and the outside of the detection area, the output signal of the distance sensor fluctuates. A robot with a self-diagnosis function that determines that a failure has occurred if there is not.
該ロボット本体に設けられるマイクロフォンと、
前記ロボット本体に設けられるスピーカと、
該スピーカの動作を制御する音声処理部と、
前記マイクロフォン、前記スピーカ、及び前記音声処理部の診断を行う診断部とを有しており、
該診断部が、前記音声処理部に、前記スピーカから音声を出力させる動作指令を送ったのちに、前記マイクロフォンの出力信号に変動が生じなかった場合に、故障が生じていると判定する自己診断機能付きロボット。 The robot body,
A microphone provided in the robot body;
A speaker provided in the robot body;
An audio processing unit for controlling the operation of the speaker;
A diagnostic unit for diagnosing the microphone, the speaker, and the voice processing unit;
The diagnosis unit determines that a failure has occurred when the microphone output signal does not change after the operation command to output sound from the speaker is sent to the sound processing unit. Robot with function.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2005349117A JP2007152470A (en) | 2005-12-02 | 2005-12-02 | Robot with self-diagnostic function |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2005349117A JP2007152470A (en) | 2005-12-02 | 2005-12-02 | Robot with self-diagnostic function |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JP2007152470A true JP2007152470A (en) | 2007-06-21 |
Family
ID=38237464
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2005349117A Withdrawn JP2007152470A (en) | 2005-12-02 | 2005-12-02 | Robot with self-diagnostic function |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2007152470A (en) |
Cited By (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2009050970A (en) * | 2007-08-28 | 2009-03-12 | Nec Access Technica Ltd | Robot system and rescue robot |
| JP2009196030A (en) * | 2008-02-21 | 2009-09-03 | Nachi Fujikoshi Corp | Output torque limit circuit of industrial robot |
| WO2013168285A1 (en) * | 2012-05-11 | 2013-11-14 | トヨタ自動車株式会社 | Pressure sensor failure diagnosis device and pressure sensor failure diagnosis method |
| WO2014167700A1 (en) * | 2013-04-12 | 2014-10-16 | 株式会社日立製作所 | Mobile robot and sound source position estimation system |
| WO2016157944A1 (en) * | 2015-03-31 | 2016-10-06 | シャープ株式会社 | Robot |
| JP2018153880A (en) * | 2017-03-16 | 2018-10-04 | トヨタ自動車株式会社 | Failure diagnosis support system and failure diagnosis support method of robot |
| US10471601B2 (en) | 2016-12-07 | 2019-11-12 | Hanwha Precision Machinery Co., Ltd. | Apparatus and method of controlling robot arm |
| US10664334B2 (en) | 2016-09-23 | 2020-05-26 | Casio Computer Co., Ltd. | Robot that diagnoses failure, failure diagnosis system, failure diagnosis method, and recording medium |
| CN112441158A (en) * | 2019-08-30 | 2021-03-05 | 北京京东乾石科技有限公司 | Sensor assembly, chassis and robot |
-
2005
- 2005-12-02 JP JP2005349117A patent/JP2007152470A/en not_active Withdrawn
Cited By (13)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2009050970A (en) * | 2007-08-28 | 2009-03-12 | Nec Access Technica Ltd | Robot system and rescue robot |
| JP2009196030A (en) * | 2008-02-21 | 2009-09-03 | Nachi Fujikoshi Corp | Output torque limit circuit of industrial robot |
| WO2013168285A1 (en) * | 2012-05-11 | 2013-11-14 | トヨタ自動車株式会社 | Pressure sensor failure diagnosis device and pressure sensor failure diagnosis method |
| JPWO2014167700A1 (en) * | 2013-04-12 | 2017-02-16 | 株式会社日立製作所 | Mobile robot and sound source position estimation system |
| WO2014167700A1 (en) * | 2013-04-12 | 2014-10-16 | 株式会社日立製作所 | Mobile robot and sound source position estimation system |
| US9989626B2 (en) | 2013-04-12 | 2018-06-05 | Hitachi, Ltd. | Mobile robot and sound source position estimation system |
| WO2016157944A1 (en) * | 2015-03-31 | 2016-10-06 | シャープ株式会社 | Robot |
| JP2016193466A (en) * | 2015-03-31 | 2016-11-17 | シャープ株式会社 | robot |
| US10664334B2 (en) | 2016-09-23 | 2020-05-26 | Casio Computer Co., Ltd. | Robot that diagnoses failure, failure diagnosis system, failure diagnosis method, and recording medium |
| US10471601B2 (en) | 2016-12-07 | 2019-11-12 | Hanwha Precision Machinery Co., Ltd. | Apparatus and method of controlling robot arm |
| JP2018153880A (en) * | 2017-03-16 | 2018-10-04 | トヨタ自動車株式会社 | Failure diagnosis support system and failure diagnosis support method of robot |
| US10713486B2 (en) | 2017-03-16 | 2020-07-14 | Toyota Jidosha Kabushiki Kaisha | Failure diagnosis support system and failure diagnosis support method of robot |
| CN112441158A (en) * | 2019-08-30 | 2021-03-05 | 北京京东乾石科技有限公司 | Sensor assembly, chassis and robot |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP2007152470A (en) | Robot with self-diagnostic function | |
| US9427863B2 (en) | Robot cleaner and method of caring for human using the same | |
| JP5033994B2 (en) | Communication robot | |
| US7222000B2 (en) | Mobile videoconferencing platform with automatic shut-off features | |
| WO2020071060A1 (en) | Information processing apparatus, information processing method, computer program, and package receipt support system | |
| JP2002352354A (en) | Remote care method | |
| KR100857578B1 (en) | Assistance robot for visually impaired | |
| US20070291109A1 (en) | Remote controlled mobile robot with auxillary input ports | |
| JP2007160473A (en) | Interactive object identifying method in robot and robot | |
| JP2009222969A (en) | Speech recognition robot and control method for speech recognition robot | |
| JP4658891B2 (en) | Robot control device | |
| JP2006007342A (en) | Robot control program updating method and system | |
| JP2009050970A (en) | Robot system and rescue robot | |
| KR20170098621A (en) | Companion animal friend robot based internet of things companion animal management system using the same | |
| KR20130060952A (en) | Remote control system for service robot | |
| JP2018075192A (en) | Vacuum cleaner | |
| JP2007156689A (en) | Light source position detection device and face recognition device using the same and self-propelled robot | |
| JP2007156688A (en) | User authentication device and its method | |
| JP2007152444A (en) | Self-propelled robot and information management system | |
| JP2007226634A (en) | Person status recognition device, method, program, robot and life support system | |
| JP2019220145A (en) | Operation terminal, voice input method, and program | |
| JP6730087B2 (en) | Monitoring system | |
| KR101324168B1 (en) | Robot cleaner, method for the robot cleaner and remote controlling system for the same | |
| JP2007152446A (en) | Robot system | |
| CN106384471A (en) | Electronic dog |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A300 | Withdrawal of application because of no request for examination |
Free format text: JAPANESE INTERMEDIATE CODE: A300 Effective date: 20090203 |