JP2008198057A - 自走式装置誘導システム - Google Patents
自走式装置誘導システム Download PDFInfo
- Publication number
- JP2008198057A JP2008198057A JP2007034524A JP2007034524A JP2008198057A JP 2008198057 A JP2008198057 A JP 2008198057A JP 2007034524 A JP2007034524 A JP 2007034524A JP 2007034524 A JP2007034524 A JP 2007034524A JP 2008198057 A JP2008198057 A JP 2008198057A
- Authority
- JP
- Japan
- Prior art keywords
- self
- optical signal
- propelled device
- light receiving
- light
- 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.)
- Pending
Links
- 230000003287 optical effect Effects 0.000 claims description 182
- 238000001514 detection method Methods 0.000 claims description 12
- 230000007423 decrease Effects 0.000 claims description 8
- 238000000034 method Methods 0.000 description 13
- 238000012545 processing Methods 0.000 description 12
- 230000005540 biological transmission Effects 0.000 description 11
- 238000003384 imaging method Methods 0.000 description 7
- 238000012544 monitoring process Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000006698 induction Effects 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 238000003032 molecular docking Methods 0.000 description 2
- 230000004397 blinking Effects 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 238000013500 data storage Methods 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 239000000428 dust Substances 0.000 description 1
- 238000012886 linear function Methods 0.000 description 1
- 229910044991 metal oxide Inorganic materials 0.000 description 1
- 150000004706 metal oxides Chemical class 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
【課題】自走式装置と、当該自走式装置を誘導する充電装置と、を備える自走式装置誘導システムにおいて、より簡易且つより低コストな構成で、効率よく確実に自走式装置を充電装置まで誘導する。
【解決手段】充電装置2に、被受光距離が異なる複数種類の光信号Mを交互に発光する発光部22を備え、セキュリティロボット(自走式装置)に、発光部22により発光された光信号Mを受光する受光センサ452と、当該受光された光信号Mの種類を判別する判別プログラムを実行したCPUと、当該判別された光信号Mの種類に応じた回転速度で光信号Mが到来する方向にセキュリティロボットの進行方向が向くようセキュリティロボットを回転させる回転制御プログラムを実行したCPUと、当該判別された光信号Mの種類に応じた走行速度で光信号Mが到来する方向にセキュリティロボットを直進走行させる直進走行制御プログラムを実行したCPUと、を備えるよう構成した。
【選択図】図4
【解決手段】充電装置2に、被受光距離が異なる複数種類の光信号Mを交互に発光する発光部22を備え、セキュリティロボット(自走式装置)に、発光部22により発光された光信号Mを受光する受光センサ452と、当該受光された光信号Mの種類を判別する判別プログラムを実行したCPUと、当該判別された光信号Mの種類に応じた回転速度で光信号Mが到来する方向にセキュリティロボットの進行方向が向くようセキュリティロボットを回転させる回転制御プログラムを実行したCPUと、当該判別された光信号Mの種類に応じた走行速度で光信号Mが到来する方向にセキュリティロボットを直進走行させる直進走行制御プログラムを実行したCPUと、を備えるよう構成した。
【選択図】図4
Description
本発明は、自走式装置誘導システムに関する。
従来、所定の走行パターンに基づいて走行して、所与の機能や任務を遂行する自走式装置が知られている。
このような自走式装置は、例えば、当該自走式装置の駆動電源を蓄える蓄電池の充電を行うために、所定の充電装置まで自律走行できるようになっている。
このような自走式装置は、例えば、当該自走式装置の駆動電源を蓄える蓄電池の充電を行うために、所定の充電装置まで自律走行できるようになっている。
例えば、充電装置から発生されるビームに基づいて自身の位置情報を正確に補正でき、ひいては確実に充電装置まで自律走行できる自走式装置(例えば、特許文献1参照)が提案されている。
具体的には、特許文献1では、例えば、一次関数(y=ax+b)で表現できる直線状のビームを発生するビーム発生部を備えて充電装置を構成し、そして、検出したビームのビーム情報(勾配“a”やy切片“b”)を利用して自身の位置や方向角を測定して自身の位置を補正できるよう自走式装置を構成している。
具体的には、特許文献1では、例えば、一次関数(y=ax+b)で表現できる直線状のビームを発生するビーム発生部を備えて充電装置を構成し、そして、検出したビームのビーム情報(勾配“a”やy切片“b”)を利用して自身の位置や方向角を測定して自身の位置を補正できるよう自走式装置を構成している。
また、例えば、充電装置から送信される信号のコードを分析して、確実に充電装置まで自律走行できる自走式装置(例えば、特許文献2参照)も提案されている。
具体的には、特許文献2では、例えば、長距離送信部と、長距離送信部からの信号と異なるコードを有し当該信号よりも強さが小の信号を発する短距離送信部と、長距離送信部及び短距離送信部からの信号と異なるコードを有し当該信号よりも強さが小の信号を発するドッキング誘導送信部と、を備えて充電装置を構成し、そして、受信した信号のコードに応じて接近方式を変えながら、充電装置まで自律走行するよう自走式装置を構成している。
具体的には、特許文献2では、例えば、長距離送信部と、長距離送信部からの信号と異なるコードを有し当該信号よりも強さが小の信号を発する短距離送信部と、長距離送信部及び短距離送信部からの信号と異なるコードを有し当該信号よりも強さが小の信号を発するドッキング誘導送信部と、を備えて充電装置を構成し、そして、受信した信号のコードに応じて接近方式を変えながら、充電装置まで自律走行するよう自走式装置を構成している。
また、例えば、充電装置から発生される赤外線と当該充電装置から発生される超音波に基づいて自身の位置を正確に検出でき、ひいては確実に充電装置まで自律走行できる自走式装置(例えば、特許文献3参照)も提案されている。
具体的には、特許文献3では、例えば、揺動しながら当該揺動角度が変化する度に異なる周波数値を有する赤外線を発生する赤外線発生部と、超音波を発生する超音波発生部と、を備えて充電装置を構成し、そして、受信した赤外線の周波数値に基づいて充電装置との角度を判断するとともに、受信した超音波の発生から受信までの所要時間に基づいて充電装置との距離を演算し、当該判断した角度と当該演算した距離に基づいて自身の位置を検出するよう自走式装置を構成している。
具体的には、特許文献3では、例えば、揺動しながら当該揺動角度が変化する度に異なる周波数値を有する赤外線を発生する赤外線発生部と、超音波を発生する超音波発生部と、を備えて充電装置を構成し、そして、受信した赤外線の周波数値に基づいて充電装置との角度を判断するとともに、受信した超音波の発生から受信までの所要時間に基づいて充電装置との距離を演算し、当該判断した角度と当該演算した距離に基づいて自身の位置を検出するよう自走式装置を構成している。
また、例えば、充電装置から発光される光点滅信号を分析して、確実に充電装置まで自律走行できる自走式装置(例えば、特許文献4参照)も提案されている。
具体的には、特許文献4では、例えば、光点滅信号を発光する点滅光源を備えて充電装置を構成し、そして、受光した光点滅信号が発光される位置やその点滅パターンを読み取って充電装置の位置を検出し、光切断法による三角測量の原理によって充電装置までの距離を計算しながら充電装置まで自律走行するよう自走式装置を構成している。
特開2006−216062号公報
特開2006−127448号公報
特開2005−43338号公報
特開2004−151924号公報
具体的には、特許文献4では、例えば、光点滅信号を発光する点滅光源を備えて充電装置を構成し、そして、受光した光点滅信号が発光される位置やその点滅パターンを読み取って充電装置の位置を検出し、光切断法による三角測量の原理によって充電装置までの距離を計算しながら充電装置まで自律走行するよう自走式装置を構成している。
しかしながら、特許文献1では、自走式装置は、充電装置から発生されるビームを利用して自身の位置情報を補正するだけであるため、例えば、充電装置が予め決められた位置に設置されていないと、充電装置まで自律走行できない。
また、特許文献2では、自走式装置は充電装置に誘導されて自律走行するようになっているが、充電装置に、長距離送信部や短距離送信部、ドッキング誘導送信部といった複数の送信部を設ける必要があるため、充電装置の構成が複雑になる、コストがかかるという問題がある。
また、特許文献3では、充電装置に、赤外線発生部や超音波発生部といった複数の発生部を設ける必要があるため、充電装置の構成が複雑になる、コストがかかるという問題がある。また、自走式装置は、充電装置から発生される赤外線や超音波を利用して自身の位置を検出するだけであるため、例えば、充電装置が予め決められた位置に設置されていないと、充電装置まで自律走行できない。
また、特許文献4では、自走式装置は、充電装置に誘導されて自律走行するようになっているが、充電装置に接近する際に光切断法による三角測量の原理を利用するため、自走式装置に、撮像素子やレーザ光の発光源、スキャナ機構などを具備する必要があり、自走式装置の構成が複雑になる、コストがかかるという問題がある。
本発明の課題は、自走式装置と、当該自走式装置を誘導する充電装置及び発光装置と、を備える自走式装置誘導システムにおいて、より簡易且つより低コストな構成で、効率よく確実に自走式装置を充電装置及び発光装置まで誘導することにある。
上記課題を解決するために、請求項1に記載の発明は、
所定の床面上を自律走行する自走式装置と、当該自走式装置を誘導するための光信号を発光し、当該自走式装置に充電のための電力を供給する充電装置と、を備える自走式装置誘導システムにおいて、
前記充電装置は、
前記自走式装置が着脱自在であり、当該自走式装置が装着されると当該自走式装置に前記充電のための電力を供給する接触端子と、
被受光距離が異なる複数種類の前記光信号を交互に発光する発光手段と、を備え、
前記自走式装置は、
前記接触端子と接触して、当該接触端子から前記充電のための電力の供給を受ける端子と、
前記発光手段により発光された光信号を受光して当該光信号が到来する方向を検出する検出手段と、
前記検出手段により受光された前記光信号の種類を判別する判別手段と、
前記判別手段により判別された前記光信号の種類に応じた回転速度で、前記検出手段により検出された当該光信号が到来する方向に当該自走式装置の進行方向が向くよう、当該自走式装置を回転させる回転制御手段と、
前記判別手段により判別された前記光信号の種類に応じた走行速度で、前記検出手段により検出された当該光信号が到来する方向に当該自走式装置を直進走行させる直進走行制御手段と、を備え、
前記回転制御手段は、前記判別手段により判別された前記光信号の種類が多くなるにつれて前記回転速度を低下させ、
前記直進走行制御手段は、前記判別手段により判別された前記光信号の種類が多くなるにつれて前記走行速度を低下させ、
前記発光手段により発光される光信号の被受光角度は、前記被受光距離が短い光信号ほど小さいことを特徴とする。
所定の床面上を自律走行する自走式装置と、当該自走式装置を誘導するための光信号を発光し、当該自走式装置に充電のための電力を供給する充電装置と、を備える自走式装置誘導システムにおいて、
前記充電装置は、
前記自走式装置が着脱自在であり、当該自走式装置が装着されると当該自走式装置に前記充電のための電力を供給する接触端子と、
被受光距離が異なる複数種類の前記光信号を交互に発光する発光手段と、を備え、
前記自走式装置は、
前記接触端子と接触して、当該接触端子から前記充電のための電力の供給を受ける端子と、
前記発光手段により発光された光信号を受光して当該光信号が到来する方向を検出する検出手段と、
前記検出手段により受光された前記光信号の種類を判別する判別手段と、
前記判別手段により判別された前記光信号の種類に応じた回転速度で、前記検出手段により検出された当該光信号が到来する方向に当該自走式装置の進行方向が向くよう、当該自走式装置を回転させる回転制御手段と、
前記判別手段により判別された前記光信号の種類に応じた走行速度で、前記検出手段により検出された当該光信号が到来する方向に当該自走式装置を直進走行させる直進走行制御手段と、を備え、
前記回転制御手段は、前記判別手段により判別された前記光信号の種類が多くなるにつれて前記回転速度を低下させ、
前記直進走行制御手段は、前記判別手段により判別された前記光信号の種類が多くなるにつれて前記走行速度を低下させ、
前記発光手段により発光される光信号の被受光角度は、前記被受光距離が短い光信号ほど小さいことを特徴とする。
請求項2に記載の発明は、
所定の床面上を自律走行する自走式装置と、当該自走式装置を誘導するための光信号を発光する発光装置と、を備える自走式装置誘導システムにおいて、
前記発光装置は、
被受光距離が異なる複数の前記光信号を交互に発光する発光手段を備え、
前記自走式装置は、
前記発光手段により発光された光信号を受光して当該光信号が到来する方向を検出する検出手段と、
前記検出手段により受光された前記光信号の被受光距離を判別する判別手段と、
前記判別手段により判別された前記光信号の被受光距離に応じた回転速度で、前記検出手段により検出された当該光信号が到来する方向に当該自走式装置の進行方向が向くよう、当該自走式装置を回転させる回転制御手段と、
前記判別手段により判別された前記光信号の被受光距離に応じた走行速度で、前記検出手段により検出された当該光信号が到来する方向に当該自走式装置を直進走行させる直進走行制御手段と、
を備えることを特徴とする。
所定の床面上を自律走行する自走式装置と、当該自走式装置を誘導するための光信号を発光する発光装置と、を備える自走式装置誘導システムにおいて、
前記発光装置は、
被受光距離が異なる複数の前記光信号を交互に発光する発光手段を備え、
前記自走式装置は、
前記発光手段により発光された光信号を受光して当該光信号が到来する方向を検出する検出手段と、
前記検出手段により受光された前記光信号の被受光距離を判別する判別手段と、
前記判別手段により判別された前記光信号の被受光距離に応じた回転速度で、前記検出手段により検出された当該光信号が到来する方向に当該自走式装置の進行方向が向くよう、当該自走式装置を回転させる回転制御手段と、
前記判別手段により判別された前記光信号の被受光距離に応じた走行速度で、前記検出手段により検出された当該光信号が到来する方向に当該自走式装置を直進走行させる直進走行制御手段と、
を備えることを特徴とする。
請求項3に記載の発明は、
請求項2に記載の自走式装置誘導システムにおいて、
前記回転制御手段は、前記判別手段により判別された前記光信号の被受光距離が短くなるにつれて前記回転速度を低下させ、
前記直進走行制御手段は、前記判別手段により判別された前記光信号の被受光距離が短くなるにつれて前記走行速度を低下させることを特徴とする。
請求項2に記載の自走式装置誘導システムにおいて、
前記回転制御手段は、前記判別手段により判別された前記光信号の被受光距離が短くなるにつれて前記回転速度を低下させ、
前記直進走行制御手段は、前記判別手段により判別された前記光信号の被受光距離が短くなるにつれて前記走行速度を低下させることを特徴とする。
請求項4に記載の発明は、
請求項2又は3に記載の自走式装置誘導システムにおいて、
前記発光手段により発光される光信号の被受光角度は、前記被受光距離が短い光信号ほど小さいことを特徴とする。
請求項2又は3に記載の自走式装置誘導システムにおいて、
前記発光手段により発光される光信号の被受光角度は、前記被受光距離が短い光信号ほど小さいことを特徴とする。
請求項1に記載の発明によれば、充電装置は、自走式装置が着脱自在であり、当該自走式装置が装着されると当該自走式装置に充電のための電力を供給する接触端子を備え、発光手段によって、被受光距離が異なる複数種類の光信号を交互に発光することができ、そして、自走式装置は、接触端子と接触して、当該接触端子から充電のための電力の供給を受ける端子を備え、検出手段によって、発光手段により発光された光信号を受光して当該光信号が到来する方向を検出することができ、判別手段によって、検出手段により受光された光信号の種類を判別することができ、回転制御手段によって、判別手段により判別された光信号の種類に応じた回転速度で、検出手段により検出された当該光信号が到来する方向に自走式装置の進行方向が向くよう、自走式装置を回転させることができ、直進走行制御手段によって、判別手段により判別された光信号の種類に応じた走行速度で、検出手段により検出された当該光信号が到来する方向に自走式装置を直進走行させることができる。
すなわち、充電装置は、1つの発光手段によって、被受光距離がそれぞれ異なる複数種類の光信号を発光できるため、自走式装置は、受光した光信号の種類を判別するだけで、光信号を受光した位置(現在位置)から充電装置までの距離を特定することができる。さらに、自走式装置は、当該特定した距離に応じた速度で回転及び走行して、充電装置まで自律走行できるため、より簡易且つより低コストな構成で、効率よく確実に自走式装置を充電装置まで誘導することができる。
すなわち、充電装置は、1つの発光手段によって、被受光距離がそれぞれ異なる複数種類の光信号を発光できるため、自走式装置は、受光した光信号の種類を判別するだけで、光信号を受光した位置(現在位置)から充電装置までの距離を特定することができる。さらに、自走式装置は、当該特定した距離に応じた速度で回転及び走行して、充電装置まで自律走行できるため、より簡易且つより低コストな構成で、効率よく確実に自走式装置を充電装置まで誘導することができる。
また、回転制御手段は、判別手段により判別された光信号の種類が多くなるにつれて回転速度を低下させることができ、直進走行制御手段は、判別手段により判別された光信号の種類が多くなるにつれて走行速度を低下させることができる。
したがって、受光した光信号の種類が少ない場合には、現在位置から充電装置までの距離が遠いと判断して、より高速度で回転及び走行することでスムーズに充電装置の近傍まで移動でき、受光した光信号の種類が多い場合には、現在位置から充電装置までの距離が近いと判断して、より低速度で回転及び走行することで充電装置を見失うこと、或いは端子と充電装置の接触端子との接触位置がずれることを好適に防止できるため、より一層、効率よく確実に自走式装置を充電装置まで誘導することができる。
したがって、受光した光信号の種類が少ない場合には、現在位置から充電装置までの距離が遠いと判断して、より高速度で回転及び走行することでスムーズに充電装置の近傍まで移動でき、受光した光信号の種類が多い場合には、現在位置から充電装置までの距離が近いと判断して、より低速度で回転及び走行することで充電装置を見失うこと、或いは端子と充電装置の接触端子との接触位置がずれることを好適に防止できるため、より一層、効率よく確実に自走式装置を充電装置まで誘導することができる。
また、発光手段により発光される光信号の被受光角度は、被受光距離が短い光信号ほど小さい。
すなわち、発光手段により発光される光信号は、被受光距離が長い光信号ほど、被受光範囲が左右方向に拡散し、被受光距離が短い光信号ほど、被受光範囲が左右方向に収束しているため、自走式装置は、現在位置から充電装置までの距離が遠い場合には、効率よく充電装置を見つけ出すことができ、現在位置から充電装置までの距離が近い場合には、確実に充電装置まで接近して、確実に端子を充電装置の接触端子に接触させることができる。
すなわち、発光手段により発光される光信号は、被受光距離が長い光信号ほど、被受光範囲が左右方向に拡散し、被受光距離が短い光信号ほど、被受光範囲が左右方向に収束しているため、自走式装置は、現在位置から充電装置までの距離が遠い場合には、効率よく充電装置を見つけ出すことができ、現在位置から充電装置までの距離が近い場合には、確実に充電装置まで接近して、確実に端子を充電装置の接触端子に接触させることができる。
請求項2に記載の発明によれば、発光装置は、発光手段によって、被受光距離が異なる複数の光信号を交互に発光することができ、そして、自走式装置は、検出手段によって、発光手段により発光された光信号を受光して当該光信号が到来する方向を検出することができ、判別手段によって、検出手段により受光された光信号の被受光距離を判別することができ、回転制御手段によって、判別手段により判別された光信号の被受光距離に応じた回転速度で、検出手段により検出された当該光信号が到来する方向に自走式装置の進行方向が向くよう、自走式装置を回転させることができ、直進走行制御手段によって、判別手段により判別された光信号の被受光距離に応じた走行速度で、検出手段により検出された当該光信号が到来する方向に自走式装置を直進走行させることができる。
すなわち、発光装置は、1つの発光手段によって、被受光距離がそれぞれ異なる複数の光信号を発光できるため、自走式装置は、受光した光信号の被受光距離を判別するだけで、光信号を受光した位置(現在位置)から発光装置までの距離を特定することができる。さらに、自走式装置は、当該特定した距離に応じた速度で回転及び走行して、発光装置まで自律走行できるため、より簡易且つより低コストな構成で、効率よく確実に自走式装置を発光装置まで誘導することができる。
すなわち、発光装置は、1つの発光手段によって、被受光距離がそれぞれ異なる複数の光信号を発光できるため、自走式装置は、受光した光信号の被受光距離を判別するだけで、光信号を受光した位置(現在位置)から発光装置までの距離を特定することができる。さらに、自走式装置は、当該特定した距離に応じた速度で回転及び走行して、発光装置まで自律走行できるため、より簡易且つより低コストな構成で、効率よく確実に自走式装置を発光装置まで誘導することができる。
請求項3に記載の発明によれば、請求項2に記載の発明と同様の効果が得られることは無論のこと、回転制御手段は、判別手段により判別された光信号の被受光距離が短くなるにつれて回転速度を低下させることができ、直進走行制御手段は、判別手段により判別された光信号の被受光距離が短くなるにつれて走行速度を低下させることができる。
したがって、受光した光信号の被受光距離が長い場合には、現在位置から発光装置までの距離が遠いと判断して、より高速度で回転及び走行することでスムーズに発光装置の近傍まで移動でき、受光した光信号の被受光距離が短い場合には、現在位置から発光装置までの距離が近いと判断して、より低速度で回転及び走行することで発光装置を見失うことを好適に防止できるため、より一層、効率よく確実に自走式装置を発光装置まで誘導することができる。
したがって、受光した光信号の被受光距離が長い場合には、現在位置から発光装置までの距離が遠いと判断して、より高速度で回転及び走行することでスムーズに発光装置の近傍まで移動でき、受光した光信号の被受光距離が短い場合には、現在位置から発光装置までの距離が近いと判断して、より低速度で回転及び走行することで発光装置を見失うことを好適に防止できるため、より一層、効率よく確実に自走式装置を発光装置まで誘導することができる。
請求項4に記載の発明によれば、請求項2又は3に記載の発明と同様の効果が得られることは無論のこと、発光手段により発光される光信号の被受光角度は、被受光距離が短い光信号ほど小さい。
すなわち、発光手段により発光される光信号は、被受光距離が長い光信号ほど、被受光範囲が左右方向に拡散し、被受光距離が短い光信号ほど、被受光範囲が左右方向に収束しているため、自走式装置は、現在位置から発光装置までの距離が遠い場合には、効率よく発光装置を見つけ出すことができ、現在位置から発光装置までの距離が近い場合には、確実に発光装置まで接近することができる。
すなわち、発光手段により発光される光信号は、被受光距離が長い光信号ほど、被受光範囲が左右方向に拡散し、被受光距離が短い光信号ほど、被受光範囲が左右方向に収束しているため、自走式装置は、現在位置から発光装置までの距離が遠い場合には、効率よく発光装置を見つけ出すことができ、現在位置から発光装置までの距離が近い場合には、確実に発光装置まで接近することができる。
以下、図を参照して、本発明にかかる自走式装置誘導システムの最良の形態を詳細に説明する。なお、発明の範囲は、図示例に限定されない。
本実施の形態では、自走式装置としてセキュリティロボットを例示して、発光装置として充電装置を例示して、説明することとする。
本実施の形態では、自走式装置としてセキュリティロボットを例示して、発光装置として充電装置を例示して、説明することとする。
<自走式装置誘導システム>
まず、自走式装置誘導システム1の構成について、図1〜図7を参照して説明する。
自走式装置誘導システム1は、例えば、図1に示すように、所定の室内Rの床面F上を所定の走行パターンに基づいて自律走行して、室内Rに侵入する不審者等を監視するセキュリティロボット4と、セキュリティロボット4を誘導するための光信号Mを発光し、セキュリティロボット4に充電のための電力を供給する充電装置2と、などを備えて構成される。
まず、自走式装置誘導システム1の構成について、図1〜図7を参照して説明する。
自走式装置誘導システム1は、例えば、図1に示すように、所定の室内Rの床面F上を所定の走行パターンに基づいて自律走行して、室内Rに侵入する不審者等を監視するセキュリティロボット4と、セキュリティロボット4を誘導するための光信号Mを発光し、セキュリティロボット4に充電のための電力を供給する充電装置2と、などを備えて構成される。
<充電装置の構成>
充電装置2は、例えば、図1〜図3に示すように、四角柱形状に形成された本体部20と、本体部20の正面に配置された接触端子21と、本体部20の正面から光信号Mを発光する発光部22と、などを備えて構成される。
ここで、本体部20における床面Fに略直交する一側面を前側(正面)とし、正面に対向する一側面を後側とする。また、前後方向に直交し且つ床面Fに略平行する方向を左右方向とし、前後方向及び左右方向の双方に直交する方向を上下方向とする。
充電装置2は、例えば、図1〜図3に示すように、四角柱形状に形成された本体部20と、本体部20の正面に配置された接触端子21と、本体部20の正面から光信号Mを発光する発光部22と、などを備えて構成される。
ここで、本体部20における床面Fに略直交する一側面を前側(正面)とし、正面に対向する一側面を後側とする。また、前後方向に直交し且つ床面Fに略平行する方向を左右方向とし、前後方向及び左右方向の双方に直交する方向を上下方向とする。
(接触端子)
接触端子21は、例えば、セキュリティロボット4が着脱自在であり、セキュリティロボット4が装着されるとセキュリティロボット4にセキュリティロボット4の蓄電池(図示省略)の充電のための電力を供給する。
接触端子21は、例えば、セキュリティロボット4が着脱自在であり、セキュリティロボット4が装着されるとセキュリティロボット4にセキュリティロボット4の蓄電池(図示省略)の充電のための電力を供給する。
(発光部)
発光部22は、例えば、図3に示すように、赤外LED(Light Emitting Diode)221と、発光制御部222と、などを備えて構成されており、例えば、発光手段として、被受光距離が異なる複数種類の光信号Mを交互に発光する。
具体的には、発光部22は、例えば、遠距離用の光信号Mと、遠距離用の光信号Mよりも被受光距離が短い近距離用の光信号Mと、の2種類の光信号Mを一周期毎に交互に発光する。
一周期分の光信号Mは、例えば、カスタムコードと、データコードと、反転データコードと、エンドビットと、などを含んでおり、例えば、一周期分の光信号Mの発光開始から発光終了までにかかる発光時間は、例えば、108ミリ秒である。
発光部22は、例えば、図3に示すように、赤外LED(Light Emitting Diode)221と、発光制御部222と、などを備えて構成されており、例えば、発光手段として、被受光距離が異なる複数種類の光信号Mを交互に発光する。
具体的には、発光部22は、例えば、遠距離用の光信号Mと、遠距離用の光信号Mよりも被受光距離が短い近距離用の光信号Mと、の2種類の光信号Mを一周期毎に交互に発光する。
一周期分の光信号Mは、例えば、カスタムコードと、データコードと、反転データコードと、エンドビットと、などを含んでおり、例えば、一周期分の光信号Mの発光開始から発光終了までにかかる発光時間は、例えば、108ミリ秒である。
赤外LED221は、発光制御部222から入力される制御信号に従って、例えば、遠距離用の光信号Mと、近距離用の光信号Mと、を一周期毎に交互に発光する。
発光制御部222は、例えば、図3に示すように、IC(Integrated Circuit)チップ222aと、発光制御回路222bと、などを備えて構成されており、例えば、赤外LED221に、遠距離用の光信号Mと、近距離用の光信号Mと、を一周期毎に交互に発光させる。
具体的には、発光制御部222は、例えば、赤外LED221に、遠距離用のデータコードを含む遠距離用の光信号Mを発光させるとともに、近距離用のデータコードを含み且つ遠距離用の光信号Mよりも発光強度が小さい近距離用の光信号Mを発光させる。
具体的には、発光制御部222は、例えば、赤外LED221に、遠距離用のデータコードを含む遠距離用の光信号Mを発光させるとともに、近距離用のデータコードを含み且つ遠距離用の光信号Mよりも発光強度が小さい近距離用の光信号Mを発光させる。
なお、発光部22により発光される光信号Mは、例えば、図4に示すように、被受光距離が短いほど、被受光角度(θ)が小さい。
具体的には、近距離用の光信号Mの被受光範囲C1(図4において破線で囲んだ範囲)における被受光角度(θ1)は、遠距離用の光信号Mの被受光範囲C2(図4において二点鎖線で囲んだ範囲)における被受光角度(θ2)よりも小さい。
すなわち、近距離用の光信号Mは、遠距離用の光信号Mよりも発光強度が小さいため、近距離用の光信号Mの被受光距離は、遠距離用の光信号Mの被受光距離よりも短く、近距離用の光信号Mの被受光範囲C1は、遠距離用の光信号Mの被受光範囲C2よりも左右方向に収束している。
具体的には、近距離用の光信号Mの被受光範囲C1(図4において破線で囲んだ範囲)における被受光角度(θ1)は、遠距離用の光信号Mの被受光範囲C2(図4において二点鎖線で囲んだ範囲)における被受光角度(θ2)よりも小さい。
すなわち、近距離用の光信号Mは、遠距離用の光信号Mよりも発光強度が小さいため、近距離用の光信号Mの被受光距離は、遠距離用の光信号Mの被受光距離よりも短く、近距離用の光信号Mの被受光範囲C1は、遠距離用の光信号Mの被受光範囲C2よりも左右方向に収束している。
ここで、被受光範囲Cとは、例えば、セキュリティロボット4の受光センサ452(後述)により光信号Mを受光可能な範囲である。
また、被受光距離とは、例えば、受光センサ452により光信号Mを受光可能な充電装置2からの距離である。
また、被受光角度(θ)とは、赤外LED22により発光される光信号Mの発光角度のうちの、受光センサ452により光信号Mを受光可能な角度である。
また、被受光距離とは、例えば、受光センサ452により光信号Mを受光可能な充電装置2からの距離である。
また、被受光角度(θ)とは、赤外LED22により発光される光信号Mの発光角度のうちの、受光センサ452により光信号Mを受光可能な角度である。
<セキュリティロボットの構成>
セキュリティロボット4は、例えば、図1、図5及び図6に示すように、平面視略矩形状に形成された本体部40と、セキュリティロボット4が所定の室内Rの床面F上を自律走行するための走行部41と、セキュリティロボット4が所定の室内Rに侵入する不審者等を監視するための監視部42と、セキュリティロボット4が充電するための充電部43と、所定の指示をユーザが入力するための入力部44と、セキュリティロボット4が充電装置2を検出するための受光部45と、セキュリティロボット4が時間を計時するための計時部46と、これら各部を制御するための制御部47と、などを備えて構成される。
ここで、セキュリティロボット4の進行方向に沿った方向を前後方向として、進行方向側を前側(正面)とし、進行方向の反対側を後側とする。また、前後方向に直交し且つ床面Fに略平行する方向を左右方向とし、前後方向及び左右方向の双方に直交する方向を上下方向とする。
セキュリティロボット4は、例えば、図1、図5及び図6に示すように、平面視略矩形状に形成された本体部40と、セキュリティロボット4が所定の室内Rの床面F上を自律走行するための走行部41と、セキュリティロボット4が所定の室内Rに侵入する不審者等を監視するための監視部42と、セキュリティロボット4が充電するための充電部43と、所定の指示をユーザが入力するための入力部44と、セキュリティロボット4が充電装置2を検出するための受光部45と、セキュリティロボット4が時間を計時するための計時部46と、これら各部を制御するための制御部47と、などを備えて構成される。
ここで、セキュリティロボット4の進行方向に沿った方向を前後方向として、進行方向側を前側(正面)とし、進行方向の反対側を後側とする。また、前後方向に直交し且つ床面Fに略平行する方向を左右方向とし、前後方向及び左右方向の双方に直交する方向を上下方向とする。
(本体部)
本体部40は、例えば、走行部41や制御部47などを衝撃や塵埃から保護するためのものであり、走行部41や制御部47などを覆うようにして設けられている。
具体的には、本体部40は、例えば、図1や図5に示すように、筐体401と、セキュリティロボット4の前面左側から左側面前側に亘って配設された左カバー部材402Lと、セキュリティロボット4の前面右側から右側面前側に亘って配設された右カバー部材402Rと、などを備えて構成される。
本体部40は、例えば、走行部41や制御部47などを衝撃や塵埃から保護するためのものであり、走行部41や制御部47などを覆うようにして設けられている。
具体的には、本体部40は、例えば、図1や図5に示すように、筐体401と、セキュリティロボット4の前面左側から左側面前側に亘って配設された左カバー部材402Lと、セキュリティロボット4の前面右側から右側面前側に亘って配設された右カバー部材402Rと、などを備えて構成される。
(走行部)
走行部41は、例えば、左キャタピラ411L及び右キャタピラ411Rと、左走行モータ412L及び右走行モータ412Rと、障害物検知センサ413と、などを備えて構成される。
走行部41は、例えば、左キャタピラ411L及び右キャタピラ411Rと、左走行モータ412L及び右走行モータ412Rと、障害物検知センサ413と、などを備えて構成される。
左キャタピラ411L及び右キャタピラ411Rは、例えば、それぞれセキュリティロボット4の左側及び右側に配設されている。
左走行モータ412L及び右走行モータ412Rは、例えば、セキュリティロボット4を走行させる駆動源として機能するとともに、セキュリティロボット4を回転(左転回や右転回)させる駆動源として機能する。
具体的には、左走行モータ412L及び右走行モータ412Rは、制御部47から入力される制御信号に従って、所定の駆動伝達部材を介して、それぞれ左キャタピラ411L及び右キャタピラ411Rを回転させる。
具体的には、左走行モータ412L及び右走行モータ412Rは、制御部47から入力される制御信号に従って、所定の駆動伝達部材を介して、それぞれ左キャタピラ411L及び右キャタピラ411Rを回転させる。
障害物検知センサ413は、例えば、セキュリティロボット4の前方や側方に位置する障害物を検知して、当該障害物検知信号を制御部47に出力する。
具体的には、障害物検知センサ413は、例えば、左カバー部材402L又は右カバー部材402Rと、障害物と、の接触に基づいて障害物を検知する接触式センサである。
具体的には、障害物検知センサ413は、例えば、左カバー部材402L又は右カバー部材402Rと、障害物と、の接触に基づいて障害物を検知する接触式センサである。
(監視部)
監視部42は、例えば、撮像レンズ421と、撮像素子422と、信号処理部423と、などを備えて構成される。
監視部42は、例えば、撮像レンズ421と、撮像素子422と、信号処理部423と、などを備えて構成される。
撮像レンズ421は、例えば、セキュリティロボット4の本体部40の正面に配置されている。
撮像素子422は、例えば、CMOS(Complementary Metal-Oxide Semiconductor)型イメージセンサやCCD(Charge Coupled Device)型イメージセンサなどの撮像素子であり、制御部47から入力される制御信号に従って、例えば、撮像レンズ421を介して入力された被写体像を画像データに光電変換して、信号処理部423に出力する。
信号処理部423は、制御部47から入力される制御信号に従って、例えば、撮像素子422から入力された画像データに所定の画像処理を施して、制御部47に出力する。
(充電部)
充電部43は、例えば、端子431と、電力量センサ432と、などを備えて構成される。
充電部43は、例えば、端子431と、電力量センサ432と、などを備えて構成される。
端子431は、例えば、セキュリティロボット4の本体部40の正面に配置され、充電装置2の接触端子21と接触して、接触端子21からセキュリティロボット4の蓄電池(図示省略)の充電のための電力の供給を受ける。
電力量センサ432は、例えば、セキュリティロボット4の蓄電池(図示省略)に蓄えられた電力量を検出して、当該電力量検出信号を制御部47に出力する。
(入力部)
入力部44は、例えば、各種機能キー等から構成され、ユーザのキー操作に伴う押下信号を制御部47に出力する。
入力部44は、例えば、各種機能キー等から構成され、ユーザのキー操作に伴う押下信号を制御部47に出力する。
(受光部)
受光部45は、例えば、セキュリティロボット4の本体部40の上面に配設されており、例えば、突出部451と、突出部451の側面全周に沿って配置された複数の受光センサ452と、などを備えて構成される。
受光部45は、例えば、セキュリティロボット4の本体部40の上面に配設されており、例えば、突出部451と、突出部451の側面全周に沿って配置された複数の受光センサ452と、などを備えて構成される。
突出部451は、例えば、円柱形状に形成されており、例えば、セキュリティロボット4の本体部40の上面から突出するように設けられている。
なお、突出部451の形状は、円柱形の限りでなく、平面視において略円形(例えば、円柱形や円筒形など)であってもよいし、平面視において多角形(例えば、多角柱形や多角筒形など)であってもよい。
なお、突出部451の形状は、円柱形の限りでなく、平面視において略円形(例えば、円柱形や円筒形など)であってもよいし、平面視において多角形(例えば、多角柱形や多角筒形など)であってもよい。
受光センサ452は、例えば、充電装置2の発光部22により発光された光信号Mを受光して、当該受光信号を制御部47に出力する。
具体的には、受光センサ452は、例えば、突出部451の側面全周に沿って所定間隔で複数(例えば、6個)配設された第1受光センサ452aと、セキュリティロボット4の進行方向を向き且つ複数の第1受光センサ452aのうちの隣り合う2つの第1受光センサ452a,452aから等間隔の位置に配置された第2受光センサ452bと、などから構成される。
なお、第1受光センサ452aの個数は、6個の限りでなく、複数であれば任意である。
なお、第1受光センサ452aの個数は、6個の限りでなく、複数であれば任意である。
(計時部)
計時部46は、制御部47から入力される制御信号に従って、例えば、所与の計時処理を行って、時間情報を制御部47に出力する。
計時部46は、制御部47から入力される制御信号に従って、例えば、所与の計時処理を行って、時間情報を制御部47に出力する。
(制御部)
制御部47は、例えば、図6に示すように、CPU(Central Processing Unit)471と、RAM(Random Access Memory)472と、記憶部473と、などを備えて構成される。
制御部47は、例えば、図6に示すように、CPU(Central Processing Unit)471と、RAM(Random Access Memory)472と、記憶部473と、などを備えて構成される。
CPU471は、例えば、記憶部473に記憶されたセキュリティロボット4用の各種処理プログラムに従って各種の制御動作を行う。
RAM472は、例えば、CPU471によって実行される処理プログラム等を展開するためのプログラム格納領域や、入力データや上記処理プログラムが実行される際に生じる処理結果等を格納するデータ格納領域などを備える。
記憶部473は、例えば、セキュリティロボット4で実行可能なシステムプログラム、当該システムプログラムで実行可能な各種処理プログラム、これら各種処理プログラムを実行する際に使用されるデータ、CPU471によって演算処理された処理結果のデータなどを記憶する。なお、プログラムは、コンピュータが読み取り可能なプログラムコードの形で記憶部473に記憶されている。
具体的には、記憶部473は、例えば、判断プログラム473aと、ランダム走行制御プログラム473bと、検出プログラム473cと、判別プログラム473dと、回転制御プログラム473eと、直進走行制御プログラム473fと、などを記憶している。
判断プログラム473aは、例えば、予め設定されたセキュリティロボット4の充電タイミングになったか否かを判断する機能を、CPU471に実現させる。
具体的には、CPU471は、例えば、電力量センサ432から入力される電力量検出信号に基づいて、セキュリティロボット4の蓄電池(図示省略)に蓄えられた電力量が一定量以下になったか否かを判断し、そして、セキュリティロボット4の蓄電池に蓄えられた電力量が一定量以下になったと判断した場合に、セキュリティロボット4の充電タイミングになったと判断する。
ここで、CPU471は、予め設定されたセキュリティロボット4の充電タイミングになったと判断すると、例えば、充電モードをONする。
具体的には、CPU471は、例えば、電力量センサ432から入力される電力量検出信号に基づいて、セキュリティロボット4の蓄電池(図示省略)に蓄えられた電力量が一定量以下になったか否かを判断し、そして、セキュリティロボット4の蓄電池に蓄えられた電力量が一定量以下になったと判断した場合に、セキュリティロボット4の充電タイミングになったと判断する。
ここで、CPU471は、予め設定されたセキュリティロボット4の充電タイミングになったと判断すると、例えば、充電モードをONする。
ランダム走行制御プログラム473bは、例えば、セキュリティロボット4をランダム走行させるために、走行部41等のセキュリティロボット4の各部を制御する機能を、CPU471に実現させる。
具体的には、CPU471は、例えば、判断プログラム473aを実行したCPU471により予め設定されたセキュリティロボット4の充電タイミングになったと判断された場合に、走行部41等を制御してセキュリティロボット4をランダム走行させる。
具体的には、CPU471は、例えば、判断プログラム473aを実行したCPU471により予め設定されたセキュリティロボット4の充電タイミングになったと判断された場合に、走行部41等を制御してセキュリティロボット4をランダム走行させる。
検出プログラム473cは、例えば、判断プログラム473aを実行したCPU471により予め設定されたセキュリティロボット4の充電タイミングになったと判断されると、充電装置2の発光部22により発光された光信号Mを受光した受光センサ452から入力される受光信号に基づいて、光信号Mが到来する方向を検出する機能を、CPU471に実現させる。
具体的には、CPU471は、例えば、1つの受光センサ452が光信号Mを受光した場合には、当該1つの受光センサ452が向く方向を、光信号Mが到来する方向であると検出する。
また、CPU471は、例えば、複数の受光センサ452が光信号Mを受光した場合には、当該複数の受光センサ452のうちの両端に位置する2つの受光センサ452が向く方向から等間隔の方向を、光信号Mが到来する方向であると検出する。
ここで、充電装置2の発光部22により発光された光信号Mを受光して光信号Mが到来する方向を検出する検出手段は、例えば、受光センサ452と、検出プログラム473cを実行したCPU471と、などにより構成される。
また、CPU471は、例えば、複数の受光センサ452が光信号Mを受光した場合には、当該複数の受光センサ452のうちの両端に位置する2つの受光センサ452が向く方向から等間隔の方向を、光信号Mが到来する方向であると検出する。
ここで、充電装置2の発光部22により発光された光信号Mを受光して光信号Mが到来する方向を検出する検出手段は、例えば、受光センサ452と、検出プログラム473cを実行したCPU471と、などにより構成される。
判別プログラム473dは、例えば、充電装置2の発光部22により発光された光信号Mを受光した受光センサ452から入力される受光信号に基づいて、受光センサ452により受光された光信号Mの種類を判別する機能を、CPU471に実現させる。
具体的には、CPU471は、例えば、受光センサ452により受光された光信号Mに含まれるデータコード等のコードを解析して、その光信号Mの種類を判別する。
すなわち、CPU471は、例えば、受光センサ452により受光された光信号Mに含まれるデータコードが遠距離用のデータコードである場合には、その光信号Mを遠距離用の光信号Mであると判別し、受光センサ452により受光された光信号Mに含まれるデータコードが近距離用のデータコードである場合には、その光信号Mを近距離用の光信号Mであると判別する。
CPU471は、かかる判別プログラム473dを実行することによって、判別手段として機能する。
すなわち、CPU471は、例えば、受光センサ452により受光された光信号Mに含まれるデータコードが遠距離用のデータコードである場合には、その光信号Mを遠距離用の光信号Mであると判別し、受光センサ452により受光された光信号Mに含まれるデータコードが近距離用のデータコードである場合には、その光信号Mを近距離用の光信号Mであると判別する。
CPU471は、かかる判別プログラム473dを実行することによって、判別手段として機能する。
回転制御プログラム473eは、例えば、判別プログラム473dを実行したCPU471により判別された光信号Mの種類に応じた回転速度で、検出プログラム473cを実行したCPU471により検出された光信号Mが到来する方向にセキュリティロボット4の進行方向が向くよう、セキュリティロボット4を回転させるために、走行部41等のセキュリティロボット4の各部を制御する機能を、CPU471に実現させる。
具体的には、CPU471は、例えば、判別プログラム473dを実行したCPU471により判別された光信号Mの種類が多くなるにつれて、セキュリティロボット4を回転させる際の回転速度を低下させることによって、判別プログラム473dを実行したCPU471により判別された光信号Mの種類に応じた回転速度でセキュリティロボット4を回転させる。
すなわち、CPU471は、例えば、受光センサ472により遠距離用の光信号Mのみが受光された場合には、セキュリティロボット4を“高速”で回転させ、受光センサ472により遠距離用の光信号Mと近距離用の光信号Mとが交互に受光された場合には、セキュリティロボット4を“低速”で回転させる。
すなわち、CPU471は、例えば、受光センサ472により遠距離用の光信号Mのみが受光された場合には、セキュリティロボット4を“高速”で回転させ、受光センサ472により遠距離用の光信号Mと近距離用の光信号Mとが交互に受光された場合には、セキュリティロボット4を“低速”で回転させる。
そして、CPU471は、例えば、図7に示すように、第2受光センサ452bと、第2受光センサ452bの左右に配置された2つの第1受光センサ452a,452aのうちの少なくとも1つの受光センサ452aと、の2つ又は3つの受光センサ452により光信号Mが検出されるように走行部41等を制御してセキュリティロボット4を回転させることによって、検出プログラム473cを実行したCPU471により検出された光信号Mが到来する方向にセキュリティロボット4の進行方向が向くよう、セキュリティロボット4を回転させる。
CPU471は、かかる回転制御プログラム473eを実行することによって、回転制御手段として機能する。
CPU471は、かかる回転制御プログラム473eを実行することによって、回転制御手段として機能する。
直進走行制御プログラム473fは、例えば、判別プログラム473dを実行したCPU471により判別された光信号Mの種類に応じた走行速度で、検出プログラム473cを実行したCPU471により検出された光信号Mが到来する方向にセキュリティロボット4を直進走行させるために、走行部41等のセキュリティロボット4の各部を制御する機能を、CPU471に実現させる。
具体的には、CPU471は、例えば、判別プログラム473dを実行したCPU471により判別された光信号Mの種類が多くなるにつれて、セキュリティロボット4を直進走行させる際の走行速度を低下させることによって、判別プログラム473dを実行したCPU471により判別された光信号Mの種類に応じた走行速度でセキュリティロボット4を直進走行させる。
すなわち、CPU471は、例えば、受光センサ472により遠距離用の光信号Mのみが受光された場合には、セキュリティロボット4を“高速”で走行させ、受光センサ472により遠距離用の光信号Mと近距離用の光信号Mとが交互に受光された場合には、セキュリティロボット4を“低速”で走行させる。
すなわち、CPU471は、例えば、受光センサ472により遠距離用の光信号Mのみが受光された場合には、セキュリティロボット4を“高速”で走行させ、受光センサ472により遠距離用の光信号Mと近距離用の光信号Mとが交互に受光された場合には、セキュリティロボット4を“低速”で走行させる。
そして、CPU471は、例えば、回転制御プログラム473eを実行したCPU471により、第2受光センサ452bと、第2受光センサ452bの左右に配置された2つの第1受光センサ452a,452aのうちの少なくとも1つの受光センサ452aと、の2つ又は3つの受光センサ452により光信号Mが検出されるようにセキュリティロボット4が回転された後、走行部41等を制御してセキュリティロボット4を直進走行させることによって、検出プログラム473cを実行したCPU471により検出された光信号Mが到来する方向にセキュリティロボット4を直進走行させる。
CPU471は、かかる直進走行制御プログラム473fを実行することによって、直進走行制御手段として機能する。
CPU471は、かかる直進走行制御プログラム473fを実行することによって、直進走行制御手段として機能する。
<充電処理>
次に、自走式装置誘導システム1が備えるセキュリティロボット4の充電に関する処理について、図8のフローチャートを参照して説明する。
次に、自走式装置誘導システム1が備えるセキュリティロボット4の充電に関する処理について、図8のフローチャートを参照して説明する。
まず、セキュリティロボット4のCPU471は、判断プログラム473aを実行して、予め設定されたセキュリティロボット4の充電タイミングになったか否かを判断する(ステップS11)。
ステップS11で、予め設定されたセキュリティロボット4の充電タイミングになっていないと判断すると(ステップS11;No)、CPU471は、ステップS11の処理を繰り返して行う。
一方、予め設定されたセキュリティロボット4の充電タイミングになったと判断すると(ステップS11;Yes)、CPU471は、充電モードをONして(ステップS12)、計時部46から入力される時間情報に基づいて、充電モード時間のカウントを開始する(ステップS13)。
次いで、CPU471は、ランダム走行制御プログラム473bを実行して、セキュリティロボット4をランダム走行させ(ステップS14)、受光センサ452により光信号Mが受光されたか否かを判断する(ステップS15)。
ステップS15で、受光センサ452により光信号Mが受光されていないと判断すると(ステップS15;No)、CPU471は、ステップS14以降の処理を繰り返して行う。
一方、ステップS15で、受光センサ452により光信号Mが受光されたと判断すると(ステップS15;Yes)、CPU471は、計時部46から入力される時間情報に基づいて、待機時間のカウントを開始し(ステップS16)、判別プログラム473dを実行して、受光センサ452により受光された光信号Mの種類を判別させて、ステップS15で受光された光信号Mの次の周期に発光される光信号Mが、受光センサ452により受光されたか否かを判断する(ステップS17)。
すなわち、CPU471は、ステップS17において、ステップS15で受光された光信号Mと異なる種類の光信号Mが受光センサ452により受光されたか否かを判断する。
すなわち、CPU471は、ステップS17において、ステップS15で受光された光信号Mと異なる種類の光信号Mが受光センサ452により受光されたか否かを判断する。
ステップS17で、ステップS15で受光された光信号Mの次の周期に発光される光信号Mが、受光センサ452により受光されていないと判断すると(ステップS17;No)、CPU471は、ステップS16でカウントを開始した待機時間が、一周期分の光信号Mの発光開始から発光終了までの発光時間(例えば、108ミリ秒)を上回ったか否かを判断する(ステップS18)。
ステップS18で、ステップS16でカウントを開始した待機時間が、一周期分の光信号Mの発光時間を上回っていないと判断すると(ステップS18;No)、CPU471は、ステップS17以降の処理を繰り返して行う。
一方、ステップS18で、ステップS16でカウントを開始した待機時間が、一周期分の光信号Mの発光時間を上回ったと判断すると(ステップS18;Yes)、CPU471は、RAM472の「回転・走行速度」記憶領域に“高速”を設定して(ステップS19)、ステップS21の処理に移行する。
また、ステップS17で、ステップS15で受光された光信号Mの次の周期に発光される光信号Mが、受光センサ452により受光されたと判断すると(ステップS17;Yes)、CPU471は、RAM472の「回転・走行速度」記憶領域に“低速”を設定して(ステップS20)、検出プログラム473cを実行して、光信号Mが到来する方向を検出する(ステップS21)。
次いで、CPU471は、回転制御プログラム473eを実行して、RAM472の「回転・走行速度」記憶領域に設定された回転速度で、ステップS21で検出された光信号Mが到来する方向にセキュリティロボット4の進行方向が向くよう、セキュリティロボット4を回転させるとともに(ステップS22)、直進走行制御プログラム473fを実行して、RAM472の「回転・走行速度」記憶領域に設定された走行速度で、ステップS21で検出された光信号Mが到来する方向にセキュリティロボット4を直進走行させる(ステップS23)。
次いで、CPU471は、電気的に又はスイッチによって、端子431が、充電装置2の接触端子21と接触したか否かを判断する(ステップS24)。
ステップS24で、端子431が、充電装置2の接触端子21と接触したと判断すると(ステップS24;Yes)、本処理を終了する。
一方、ステップS24で、端子431が、充電装置2の接触端子21と接触していないと判断すると(ステップS24;No)、CPU471は、ステップS13でカウントを開始した充電モード時間が、所定の閾値(例えば、10分)を上回ったか否かを判断する(ステップS25)。
ステップS25で、ステップS13でカウントを開始した充電モード時間が、所定の閾値を上回っていないと判断すると(ステップS25;No)、CPU471は、ステップS15以降の処理を繰り返して行う。
一方、ステップS25で、ステップS13でカウントを開始した充電モード時間が、所定の閾値を上回ったと判断すると(ステップS25;Yes)、CPU471は、走行部41等のセキュリティロボット4の各部を制御して、セキュリティロボット4の回転及び走行を停止させ(ステップS26)、本処理を終了する。
以上説明した本発明の自走式装置誘導システム1によれば、所定の床面F上を自律走行するセキュリティロボット4と、セキュリティロボット4を誘導するための光信号Mを発光し、セキュリティロボット4に充電のための電力を供給する充電装置2と、を備えている。
そして、充電装置2は、セキュリティロボット4が着脱自在であり、セキュリティロボット4が装着されるとセキュリティロボット4に充電のための電力を供給する接触端子21を備え、発光部22によって、被受光距離が異なる複数種類の光信号Mを交互に発光することができ、セキュリティロボット4は、接触端子21と接触して、接触端子21から充電のための電力の供給を受ける端子431を備え、受光センサ452及び検出プログラム473cを実行したCPU471によって、発光部22により発光された光信号Mを受光して光信号Mが到来する方向を検出することができ、判別プログラム473dを実行したCPU471によって、検出プログラム473cを実行したCPU471により受光された光信号Mの種類を判別することができ、回転制御プログラム473eを実行したCPU471によって、判別プログラム473dを実行したCPU471により判別された光信号Mの種類に応じた回転速度で、検出プログラム473cを実行したCPU471により検出された光信号Mが到来する方向にセキュリティロボット4の進行方向が向くよう、セキュリティロボット4を回転させることができ、直進走行制御プログラム473fを実行したCPU471によって、判別プログラム473dを実行したCPU471により判別された光信号Mの種類に応じた走行速度で、検出プログラム473cを実行したCPU471により検出された光信号Mが到来する方向にセキュリティロボット4を直進走行させることができる。
すなわち、充電装置2は、1つの発光部22によって、被受光距離がそれぞれ異なる複数種類の光信号Mを発光できるため、セキュリティロボット4は、受光した光信号Mの種類を判別するだけで、光信号Mを受光した位置(現在位置)から充電装置2までの距離を特定することができる。さらに、セキュリティロボット4は、当該特定した距離に応じた速度で回転及び走行して、充電装置2まで自律走行できるため、より簡易且つより低コストな構成で、効率よく確実にセキュリティロボット4を充電装置2まで誘導することができる。
そして、充電装置2は、セキュリティロボット4が着脱自在であり、セキュリティロボット4が装着されるとセキュリティロボット4に充電のための電力を供給する接触端子21を備え、発光部22によって、被受光距離が異なる複数種類の光信号Mを交互に発光することができ、セキュリティロボット4は、接触端子21と接触して、接触端子21から充電のための電力の供給を受ける端子431を備え、受光センサ452及び検出プログラム473cを実行したCPU471によって、発光部22により発光された光信号Mを受光して光信号Mが到来する方向を検出することができ、判別プログラム473dを実行したCPU471によって、検出プログラム473cを実行したCPU471により受光された光信号Mの種類を判別することができ、回転制御プログラム473eを実行したCPU471によって、判別プログラム473dを実行したCPU471により判別された光信号Mの種類に応じた回転速度で、検出プログラム473cを実行したCPU471により検出された光信号Mが到来する方向にセキュリティロボット4の進行方向が向くよう、セキュリティロボット4を回転させることができ、直進走行制御プログラム473fを実行したCPU471によって、判別プログラム473dを実行したCPU471により判別された光信号Mの種類に応じた走行速度で、検出プログラム473cを実行したCPU471により検出された光信号Mが到来する方向にセキュリティロボット4を直進走行させることができる。
すなわち、充電装置2は、1つの発光部22によって、被受光距離がそれぞれ異なる複数種類の光信号Mを発光できるため、セキュリティロボット4は、受光した光信号Mの種類を判別するだけで、光信号Mを受光した位置(現在位置)から充電装置2までの距離を特定することができる。さらに、セキュリティロボット4は、当該特定した距離に応じた速度で回転及び走行して、充電装置2まで自律走行できるため、より簡易且つより低コストな構成で、効率よく確実にセキュリティロボット4を充電装置2まで誘導することができる。
また、回転制御プログラム473eを実行したCPU471は、判別プログラム473dを実行したCPU471により判別された光信号Mの種類が多くなるにつれて、セキュリティロボット4を回転させる際の回転速度を低下させることができ、直進走行制御プログラム473fを実行したCPU471は、判別プログラム473dを実行したCPU471により判別された光信号Mの種類が多くなるにつれて、セキュリティロボット4を直進走行させる際の走行速度を低下させることができる。
ここで、セキュリティロボット4は、回転する速度や走行する速度が速いと充電装置2を見失ってしまう場合や端子431と充電装置2の接触端子21との接触位置がずれる場合があり、また、回転する速度や走行する速度が遅いとスムーズに充電装置2まで移動できない場合があるが、セキュリティロボット4は、受光した光信号Mの種類が少ない場合(すなわち、受光した光信号Mが1種類の場合)には、現在位置から充電装置2までの距離が遠いと判断して、より高速度で回転及び走行することでスムーズに充電装置2の近傍まで移動でき、受光した光信号Mの種類が多い場合(すなわち、受光した光信号Mが2種類の場合)には、現在位置から充電装置2までの距離が近いと判断して、より低速度で回転及び走行することで充電装置2を見失うこと、或いは端子431と充電装置2の接触端子21との接触位置がずれることを好適に防止できるため、より一層、効率よく確実にセキュリティロボット4を充電装置2まで誘導することができる。
ここで、セキュリティロボット4は、回転する速度や走行する速度が速いと充電装置2を見失ってしまう場合や端子431と充電装置2の接触端子21との接触位置がずれる場合があり、また、回転する速度や走行する速度が遅いとスムーズに充電装置2まで移動できない場合があるが、セキュリティロボット4は、受光した光信号Mの種類が少ない場合(すなわち、受光した光信号Mが1種類の場合)には、現在位置から充電装置2までの距離が遠いと判断して、より高速度で回転及び走行することでスムーズに充電装置2の近傍まで移動でき、受光した光信号Mの種類が多い場合(すなわち、受光した光信号Mが2種類の場合)には、現在位置から充電装置2までの距離が近いと判断して、より低速度で回転及び走行することで充電装置2を見失うこと、或いは端子431と充電装置2の接触端子21との接触位置がずれることを好適に防止できるため、より一層、効率よく確実にセキュリティロボット4を充電装置2まで誘導することができる。
また、発光部22により発光される光信号Mの被受光角度(θ)は、被受光距離が短い光信号Mほど小さい。
すなわち、発光部22により発光される光信号Mは、被受光距離が長い光信号Mほど、被受光範囲Cが左右方向に拡散し、被受光距離が短い光信号Mほど、被受光範囲Cが左右方向に収束しているため、セキュリティロボット4は、現在位置から充電装置2までの距離が遠い場合には、効率よく充電装置2を見つけ出すことができ、現在位置から充電装置2までの距離が近い場合には、確実に充電装置2まで接近して、確実に端子431を充電装置2の接触端子21に接触させることができる。
すなわち、発光部22により発光される光信号Mは、被受光距離が長い光信号Mほど、被受光範囲Cが左右方向に拡散し、被受光距離が短い光信号Mほど、被受光範囲Cが左右方向に収束しているため、セキュリティロボット4は、現在位置から充電装置2までの距離が遠い場合には、効率よく充電装置2を見つけ出すことができ、現在位置から充電装置2までの距離が近い場合には、確実に充電装置2まで接近して、確実に端子431を充電装置2の接触端子21に接触させることができる。
なお、本発明は、上記した実施の形態のものに限るものではなく、その要旨を逸脱しない範囲で適宜変更可能である。
自走式装置は、セキュリティロボット4の限りでなく、自律走行が可能な装置であれば任意である。
また、発光装置は、充電装置2の限りでなく、自走式装置を誘導するための装置であれば任意である。
また、発光装置は、充電装置2の限りでなく、自走式装置を誘導するための装置であれば任意である。
充電装置2の発光部22により発光される光信号Mは、遠距離用の光信号Mと、近距離用の光信号Mと、の2種類の限りでなく、複数種類であれば任意である。
また、光信号Mに含まれるデータコードによって、光信号Mの種類を識別するようにしたが、この限りでなく、例えば、光信号Mの周波数等によって、光信号Mの種類を識別するようにしてもよい。
また、光信号Mに含まれるデータコードによって、光信号Mの種類を識別するようにしたが、この限りでなく、例えば、光信号Mの周波数等によって、光信号Mの種類を識別するようにしてもよい。
セキュリティロボット4にさらに発光部を備え、充電装置2にさらに当該発光部により発光された光信号を受光する受光センサを備え、セキュリティロボット4が充電装置2に近づくに従って、充電装置2から発光される光信号Mの被受光範囲Cを左右方向に収束させるようにしてもよい。
すなわち、例えば、まず、充電装置2は、遠距離用の光信号Mを発光部22から発光し、そして、その遠距離用の光信号Mを受光センサ452が受光すると、セキュリティロボット4は、遠距離用の光信号Mを受光した旨に関する情報を含む光信号を発光部から発光し、次に、遠距離用の光信号Mを受光した旨に関する情報を含む光信号を充電装置2の受光センサが受光すると、充電装置2は、遠距離用の光信号Mと近距離用の光信号Mとを交互に発光し、そして、その遠距離用の光信号Mと近距離用の光信号Mとを交互に受光センサ452が受光すると、セキュリティロボット4は、遠距離用の光信号Mと近距離用の光信号Mとを交互に受光した旨に関する情報を含む光信号を発光部から発光し、次に、遠距離用の光信号Mと近距離用の光信号Mとを交互に受光した旨に関する情報を含む光信号を充電装置2の受光センサが受光すると、充電装置2は、近距離用の光信号Mを発光するようにしてもよい。
この場合、効率よく確実にセキュリティロボット4を充電装置2まで誘導することができ、正確にセキュリティロボット4の端子431を充電装置2の接触端子21に接触させることができる。
すなわち、例えば、まず、充電装置2は、遠距離用の光信号Mを発光部22から発光し、そして、その遠距離用の光信号Mを受光センサ452が受光すると、セキュリティロボット4は、遠距離用の光信号Mを受光した旨に関する情報を含む光信号を発光部から発光し、次に、遠距離用の光信号Mを受光した旨に関する情報を含む光信号を充電装置2の受光センサが受光すると、充電装置2は、遠距離用の光信号Mと近距離用の光信号Mとを交互に発光し、そして、その遠距離用の光信号Mと近距離用の光信号Mとを交互に受光センサ452が受光すると、セキュリティロボット4は、遠距離用の光信号Mと近距離用の光信号Mとを交互に受光した旨に関する情報を含む光信号を発光部から発光し、次に、遠距離用の光信号Mと近距離用の光信号Mとを交互に受光した旨に関する情報を含む光信号を充電装置2の受光センサが受光すると、充電装置2は、近距離用の光信号Mを発光するようにしてもよい。
この場合、効率よく確実にセキュリティロボット4を充電装置2まで誘導することができ、正確にセキュリティロボット4の端子431を充電装置2の接触端子21に接触させることができる。
充電装置2の発光部22は、データコードは同一で、被受光距離のみが異なる光信号Mを交互に発光するようにしてもよい。
例えば、発光部22が、光信号Mの被受光距離(遠距離と近距離)を一周期毎に交互に変えて発光する場合、CPU471は、受光センサ452が断続的に光信号Mを受光すれば、受光センサ452により受光された光信号Mの被受光距離は“遠距離”であると判別するとともに、受光センサ452が連続的に光信号Mを受光すれば、受光センサ452により受光された光信号Mの被受光距離は“近距離”であると判別することによって、受光センサ452により受光された光信号Mの被受光距離を判別することになる。
そして、CPU471は、例えば、受光センサ452により受光された光信号Mの被受光距離が“遠距離”であると判別された場合には、セキュリティロボット4を“高速”で回転及び走行させ、受光センサ452により受光された光信号Mの被受光距離が“近距離”であると判別された場合には、セキュリティロボット4を“低速”で回転及び走行させる。
例えば、発光部22が、光信号Mの被受光距離(遠距離と近距離)を一周期毎に交互に変えて発光する場合、CPU471は、受光センサ452が断続的に光信号Mを受光すれば、受光センサ452により受光された光信号Mの被受光距離は“遠距離”であると判別するとともに、受光センサ452が連続的に光信号Mを受光すれば、受光センサ452により受光された光信号Mの被受光距離は“近距離”であると判別することによって、受光センサ452により受光された光信号Mの被受光距離を判別することになる。
そして、CPU471は、例えば、受光センサ452により受光された光信号Mの被受光距離が“遠距離”であると判別された場合には、セキュリティロボット4を“高速”で回転及び走行させ、受光センサ452により受光された光信号Mの被受光距離が“近距離”であると判別された場合には、セキュリティロボット4を“低速”で回転及び走行させる。
1 自走式装置誘導システム
2 充電装置(発光装置)
4 セキュリティロボット(自走式装置)
21 接触端子
22 発光部(発光手段)
431 端子
452 受光センサ(検出手段)
471 CPU(検出手段、判別手段、回転制御手段、直進走行制御手段)
473c 検出プログラム(検出手段)
473d 判別プログラム(判別手段)
473e 回転制御プログラム(回転制御手段)
473f 直進走行制御プログラム(直進走行制御手段)
C 被受光範囲
F 床面
M 光信号
2 充電装置(発光装置)
4 セキュリティロボット(自走式装置)
21 接触端子
22 発光部(発光手段)
431 端子
452 受光センサ(検出手段)
471 CPU(検出手段、判別手段、回転制御手段、直進走行制御手段)
473c 検出プログラム(検出手段)
473d 判別プログラム(判別手段)
473e 回転制御プログラム(回転制御手段)
473f 直進走行制御プログラム(直進走行制御手段)
C 被受光範囲
F 床面
M 光信号
Claims (4)
- 所定の床面上を自律走行する自走式装置と、当該自走式装置を誘導するための光信号を発光し、当該自走式装置に充電のための電力を供給する充電装置と、を備える自走式装置誘導システムにおいて、
前記充電装置は、
前記自走式装置が着脱自在であり、当該自走式装置が装着されると当該自走式装置に前記充電のための電力を供給する接触端子と、
被受光距離が異なる複数種類の前記光信号を交互に発光する発光手段と、を備え、
前記自走式装置は、
前記接触端子と接触して、当該接触端子から前記充電のための電力の供給を受ける端子と、
前記発光手段により発光された光信号を受光して当該光信号が到来する方向を検出する検出手段と、
前記検出手段により受光された前記光信号の種類を判別する判別手段と、
前記判別手段により判別された前記光信号の種類に応じた回転速度で、前記検出手段により検出された当該光信号が到来する方向に当該自走式装置の進行方向が向くよう、当該自走式装置を回転させる回転制御手段と、
前記判別手段により判別された前記光信号の種類に応じた走行速度で、前記検出手段により検出された当該光信号が到来する方向に当該自走式装置を直進走行させる直進走行制御手段と、を備え、
前記回転制御手段は、前記判別手段により判別された前記光信号の種類が多くなるにつれて前記回転速度を低下させ、
前記直進走行制御手段は、前記判別手段により判別された前記光信号の種類が多くなるにつれて前記走行速度を低下させ、
前記発光手段により発光される光信号の被受光角度は、前記被受光距離が短い光信号ほど小さいことを特徴とする自走式装置誘導システム。 - 所定の床面上を自律走行する自走式装置と、当該自走式装置を誘導するための光信号を発光する発光装置と、を備える自走式装置誘導システムにおいて、
前記発光装置は、
被受光距離が異なる複数の前記光信号を交互に発光する発光手段を備え、
前記自走式装置は、
前記発光手段により発光された光信号を受光して当該光信号が到来する方向を検出する検出手段と、
前記検出手段により受光された前記光信号の被受光距離を判別する判別手段と、
前記判別手段により判別された前記光信号の被受光距離に応じた回転速度で、前記検出手段により検出された当該光信号が到来する方向に当該自走式装置の進行方向が向くよう、当該自走式装置を回転させる回転制御手段と、
前記判別手段により判別された前記光信号の被受光距離に応じた走行速度で、前記検出手段により検出された当該光信号が到来する方向に当該自走式装置を直進走行させる直進走行制御手段と、
を備えることを特徴とする自走式装置誘導システム。 - 請求項2に記載の自走式装置誘導システムにおいて、
前記回転制御手段は、前記判別手段により判別された前記光信号の被受光距離が短くなるにつれて前記回転速度を低下させ、
前記直進走行制御手段は、前記判別手段により判別された前記光信号の被受光距離が短くなるにつれて前記走行速度を低下させることを特徴とする自走式装置誘導システム。 - 請求項2又は3に記載の自走式装置誘導システムにおいて、
前記発光手段により発光される光信号の被受光角度は、前記被受光距離が短い光信号ほど小さいことを特徴とする自走式装置誘導システム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007034524A JP2008198057A (ja) | 2007-02-15 | 2007-02-15 | 自走式装置誘導システム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007034524A JP2008198057A (ja) | 2007-02-15 | 2007-02-15 | 自走式装置誘導システム |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2008198057A true JP2008198057A (ja) | 2008-08-28 |
Family
ID=39756922
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2007034524A Pending JP2008198057A (ja) | 2007-02-15 | 2007-02-15 | 自走式装置誘導システム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2008198057A (ja) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103365291A (zh) * | 2012-03-29 | 2013-10-23 | 凌海科技企业股份有限公司 | 控制单元及使自动行走装置导向充电座的方法 |
TWI486140B (zh) * | 2012-02-16 | 2015-06-01 | Micro Star Int Co Ltd | 掃地機器人的控制方法 |
JP2016091336A (ja) * | 2014-11-06 | 2016-05-23 | 日立アプライアンス株式会社 | 自律走行型掃除機システム |
CN108390441A (zh) * | 2018-05-03 | 2018-08-10 | 深圳市银星智能科技股份有限公司 | 充电座、移动机器人以及自动充电系统 |
JP2020508182A (ja) * | 2017-03-06 | 2020-03-19 | エルジー エレクトロニクス インコーポレイティド | 掃除機及びその制御方法 |
-
2007
- 2007-02-15 JP JP2007034524A patent/JP2008198057A/ja active Pending
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI486140B (zh) * | 2012-02-16 | 2015-06-01 | Micro Star Int Co Ltd | 掃地機器人的控制方法 |
CN103365291A (zh) * | 2012-03-29 | 2013-10-23 | 凌海科技企业股份有限公司 | 控制单元及使自动行走装置导向充电座的方法 |
CN103365291B (zh) * | 2012-03-29 | 2016-02-17 | 凌海科技企业股份有限公司 | 控制单元及使自动行走装置导向充电座的方法 |
JP2016091336A (ja) * | 2014-11-06 | 2016-05-23 | 日立アプライアンス株式会社 | 自律走行型掃除機システム |
JP2020508182A (ja) * | 2017-03-06 | 2020-03-19 | エルジー エレクトロニクス インコーポレイティド | 掃除機及びその制御方法 |
CN108390441A (zh) * | 2018-05-03 | 2018-08-10 | 深圳市银星智能科技股份有限公司 | 充电座、移动机器人以及自动充电系统 |
CN108390441B (zh) * | 2018-05-03 | 2024-03-22 | 深圳银星智能集团股份有限公司 | 充电座、移动机器人以及自动充电系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5053676B2 (ja) | 移動ロボットの充電台復帰システム及びその方法 | |
KR100692897B1 (ko) | 이동로봇 | |
JP2008040725A (ja) | 自走式装置充電システム | |
JP6717697B2 (ja) | 自律走行装置 | |
EP1760564B1 (en) | System and method for returning robot cleaner to charger | |
JP2008198057A (ja) | 自走式装置誘導システム | |
US20060196003A1 (en) | Mobile robot having body sensor | |
US20140055569A1 (en) | Apparatus and method for sensing drowsy driving | |
CN110352028B (zh) | 移动机器人以及移动机器人的控制方法 | |
JP2006318444A (ja) | 障害物回避機能を有する移動ロボットとその制御方法 | |
KR20190030349A (ko) | 로봇청소기 및 그 제어방법 | |
KR20200105916A (ko) | 로봇 청소기 및 그의 제어방법 | |
KR102179238B1 (ko) | 장치의 사람 추종 주행 및 자율 주행 방법 | |
KR102033676B1 (ko) | 이동 로봇 충전 시스템 및 방법 | |
WO2020019951A1 (zh) | 充电桩及其识别方法、智能移动装置、系统 | |
KR20080093768A (ko) | 주행로봇의 위치감지장치 및 이를 이용한 로봇 청소기 | |
JP2008084007A (ja) | 自走式装置充電システム | |
CN114343487B (zh) | 自动清洁设备、自动清洁的系统及其充电的方法 | |
JP2008139992A (ja) | 自走式装置及び自走式装置誘導システム | |
JP2016220823A (ja) | 自走式掃除機 | |
JP2006039760A (ja) | 移動ロボット | |
JP2008102698A (ja) | 自走式装置充電システム | |
JP2016134081A (ja) | 自走式電子機器 | |
KR20120113585A (ko) | 지능형 라인트레이싱 로봇 및 이의 구동 방법 | |
CN114745999A (zh) | 自主行走型吸尘器 |