JP4311355B2 - Self-propelled device and its program - Google Patents

Self-propelled device and its program Download PDF

Info

Publication number
JP4311355B2
JP4311355B2 JP2005009855A JP2005009855A JP4311355B2 JP 4311355 B2 JP4311355 B2 JP 4311355B2 JP 2005009855 A JP2005009855 A JP 2005009855A JP 2005009855 A JP2005009855 A JP 2005009855A JP 4311355 B2 JP4311355 B2 JP 4311355B2
Authority
JP
Japan
Prior art keywords
obstacle
travel
time
self
detected
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.)
Expired - Fee Related
Application number
JP2005009855A
Other languages
Japanese (ja)
Other versions
JP2006201829A (en
Inventor
桂子 野田
直紀 山▲崎▼
裕章 加▲来▼
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Panasonic Corp
Panasonic Holdings Corp
Original Assignee
Panasonic Corp
Matsushita Electric Industrial Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Panasonic Corp, Matsushita Electric Industrial Co Ltd filed Critical Panasonic Corp
Priority to JP2005009855A priority Critical patent/JP4311355B2/en
Publication of JP2006201829A publication Critical patent/JP2006201829A/en
Application granted granted Critical
Publication of JP4311355B2 publication Critical patent/JP4311355B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Electric Suction Cleaners (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Description

本発明は、自立して走行を行う自走式機器およびそのプログラムに関するものである。   The present invention relates to a self-propelled device that runs independently and a program thereof.

従来、自走式機器として、自走式掃除機が知られている。これは、使用者が掃除場所の位置を入力する指示手段から指示される複数の位置を検知して、前記指示された複数の位置に移動して掃除を行い、前記指示手段での操作で自走式掃除機が追従動作を行うか、掃除位置を教示される教示動作を行うか、自走して掃除を行う実行動作を行うかを切り換えて指示するものである(例えば、特許文献1参照)。   Conventionally, a self-propelled cleaner is known as a self-propelled device. This is because the user detects a plurality of positions instructed by the instruction means for inputting the position of the cleaning place, moves to the instructed plurality of positions, performs cleaning, and automatically operates by the operation of the instruction means. It is switched and instructed whether the running type vacuum cleaner performs a follow-up operation, performs a teaching operation for teaching a cleaning position, or performs an execution operation for self-running to perform cleaning (see, for example, Patent Document 1). ).

そして、自走式掃除機を追尾動作で動かしたい場合には、操作者が指示手段のスイッチを追尾動作にセットすると、検出手段で進行方向に存在する障害物を検出して障害物を避けながら、計測手段に内蔵した自走式掃除機の正面に位置する受信手段から指示手段までの距離が最も短くなるようにして自走式掃除機を指示手段と一定の距離を保って追尾するように移動する。   And if you want to move the self-propelled vacuum cleaner in the tracking operation, if the operator sets the switch of the instruction means to the tracking operation, while detecting the obstacle present in the traveling direction with the detection means, avoiding the obstacle In order to track the self-propelled cleaner with a certain distance from the indicating means so that the distance from the receiving means located in front of the self-propelled cleaner built in the measuring means to the indicating means is the shortest. Moving.

また、教示動作で動かしたい場合には、操作者は指示手段のスイッチを教示動作にセットする。教示動作には、パターン設定モードと位置指定モードがあり、いずれも指示手段のボタンで指定して指示を行う。指示手段は、パターン設定モードであれば、予め記憶されていた設定パターンを示し、使用者がこれらのうちから選択したパターンを読み込んで制御手段に発信し、自走式掃除機の制御手段では、この信号を受け、選択したパターンを、今後掃除しつつ移動する動作パターンとして設定する。位置指定モードであれば、計測手段は操作者が教示する位置で、指示手段のスイッチを押下する度に出力される指示手段の発光手段または発信手段の発光信号または発信信号の位置または方向、或いは指示手段が指示、教示する位置または方向を計測して制御信号生成手段に出力し、制御信号生成手段は毎回の位置または方向の情報を一時記憶手段に記憶し、すべての教示位置の入力が終了すると、すべての教示位置から成る領域を判断して設定する。   When the operator wants to move the teaching operation, the operator sets the switch of the instruction means to the teaching operation. The teaching operation includes a pattern setting mode and a position designation mode, both of which are designated using a button of the instruction means. If the instruction means is the pattern setting mode, it indicates the setting pattern stored in advance, and the user reads a pattern selected from these and transmits it to the control means. In the control means of the self-propelled cleaner, In response to this signal, the selected pattern is set as an operation pattern that moves while cleaning. In the position designation mode, the measuring means is the position taught by the operator, and the position or direction of the light emitting signal or the transmitting signal of the indicating means or the transmitting means that is output every time the switch of the indicating means is pressed, or The instruction means measures the position or direction to be instructed and taught and outputs it to the control signal generation means. The control signal generation means stores the information on the position or direction every time in the temporary storage means, and the input of all teaching positions is completed. Then, an area including all teaching positions is determined and set.

操作者が指示手段のスイッチで実行動作をセットすると、一時記憶手段に記憶したすべての教示位置から成る領域内を予め設定されたパターンで移動するとともに、掃除手段を制御して掃除を行うものである。
特開2002−282179号公報
When the operator sets an execution operation with the switch of the instruction means, the operator moves in an area composed of all teaching positions stored in the temporary storage means in a preset pattern, and performs cleaning by controlling the cleaning means. is there.
JP 2002-282179 A

しかしながら、前記従来の構成では、自走式掃除機の追尾動作、教示動作および実行動作などの動作モードを選択指定するには、また教示動作の中でパターン設定モードと位置指定モードの指定を行うにも、使用者が指示手段を自走式掃除機に向けて発光または発信してスイッチでいちいち指定しなければならないという課題を有していた。また、掃除すべき場所への誘導については、追尾動作でできにくいところでは、教示動作を用いて、自走式掃除機が移動すべき軌跡ではなく移動の始点や終点位置を指定したり、移動する位置および自走式掃除機が移動しての教示は行わない位置情報も移動すべき位置として入力したりして指示することができるとはいえ、自走式掃除機と離れた位置を、手に持った指示手段で自走式掃除機が正しく認識できるまで、指示し誘導し続けなければならず、追尾動作も教示動作も、現在位置との相対位置指定を制御信号生成手段で制御信号を生成し制御手段に出力して掃除を行うので、掃除をさせる度に位置を指定する必要があるという課題を有していた。   However, in the conventional configuration, in order to select and specify the operation mode such as the tracking operation, the teaching operation, and the execution operation of the self-propelled cleaner, the pattern setting mode and the position specifying mode are specified in the teaching operation. In addition, there is a problem in that the user has to designate each time with the switch by emitting or transmitting the instruction means toward the self-propelled cleaner. As for guidance to the place to be cleaned, if the tracking operation is difficult to perform, use the teaching operation to specify the start point and end point of the movement instead of the locus that the self-propelled cleaner should move or move Although the position information and the position information that the self-propelled cleaner does not move and the position information that is not performed can be input and instructed as the position to be moved, the position away from the self-propelled cleaner, Until the self-propelled vacuum cleaner can be correctly recognized by the pointing means held in the hand, it must continue to be directed and guided, and the tracking signal and the teaching action must be specified relative to the current position by the control signal generating means. Is generated and output to the control means to perform cleaning, so that there is a problem that it is necessary to designate a position every time cleaning is performed.

本発明は、前記従来の課題を解決するもので、使用者が簡易に、自走式機器に追従動作または教示動作を行わせるか、実行動作を行わせるかが選択指定できるとともに、自走式機器が自発的に追従する自走式機器およびそのプログラムを提供することを目的とする。   The present invention solves the above-described conventional problems, and allows a user to select and specify whether the self-propelled device performs a follow-up operation or a teaching operation or an execution operation, and is self-propelled. An object of the present invention is to provide a self-propelled device that the device voluntarily follows and its program.

前記従来の課題を解決するために、本発明の自走式機器およびそのプログラムは、走行手段と、周囲の障害物を検知するための障害物検知手段と、前記走行手段を制御するための制御手段と、前記制御手段に対して起動をかけるための起動手段と、前記起動手段が起動をかけてからの時間を計時するための計時手段と、障害物追従手段とを備え、前記制御手段は前記起動手段で起動がかけられた時点では走行の開始を保留し、前記計時手段が起動から所定時間を計時するまでに前記障害物検知手段で走行すべき方向に障害物を検知しない状態から障害物を検知した時には少なくとも走行を開始して前記障害物追従手段により走行開始時に抽出した障害物の特徴をもとに障害物に追従し、それ以外の時には前記計時手段が所定時間を計時した時点で走行を開始するものである。   In order to solve the conventional problems, a self-propelled device and a program therefor according to the present invention include a traveling means, an obstacle detecting means for detecting surrounding obstacles, and a control for controlling the traveling means. Means, an activation means for activating the control means, a timing means for measuring the time since the activation means has been activated, and an obstacle tracking means, the control means comprising: When the activation is started by the activation means, the start of traveling is suspended, and the obstacle is detected from the state in which no obstacle is detected in the direction in which the obstacle detection means should travel until the time counting means measures a predetermined time from the activation. When an object is detected, at least the vehicle starts traveling and follows the obstacle based on the characteristics of the obstacle extracted at the start of traveling by the obstacle tracking unit. In other cases, the time measuring unit times the predetermined time. In is to start traveling.

これによって、使用者が、自走式機器に起動をかけて、その走行すべき方向の前に立つか否かで、追従動作または教示動作を行わせるか、実行動作を行わせるかが選択指定でき、また使用者がホースを引っ張ったり指示手段を振り続けたりして自走式機器を誘導し続けなくとも、自発的に追従することができる。   In this way, the user can start the self-propelled device and select whether to perform the follow-up operation or teaching operation or execute operation depending on whether it stands in front of the direction to travel. In addition, it is possible to follow up spontaneously without the user continuing to guide the self-propelled device by pulling the hose or continuously swinging the instruction means.

本発明の自走式機器およびそのプログラムは、簡易に、自走式機器に追従動作または教示動作を行わせるか、実行動作を行わせるかが選択指定できるとともに、自走式機器が自発的に追従することができる。   The self-propelled device and the program thereof according to the present invention can easily select and specify whether the self-propelled device performs the follow-up operation or the teaching operation or the execution operation, and the self-propelled device spontaneously Can follow.

第1の発明は、走行手段と、周囲の障害物を検知するための障害物検知手段と、前記走行手段を制御するための制御手段と、前記制御手段に対して起動をかけるための起動手段と、前記起動手段が起動をかけてからの時間を計時するための計時手段と、障害物追従手段とを備え、前記制御手段は前記起動手段で起動がかけられた時点では走行の開始を保留し、前記計時手段が起動から所定時間を計時するまでに前記障害物検知手段で走行すべき方向に障害物を検知しない状態から障害物を検知した時には少なくとも走行を開始して前記障害物追従手段により走行開始時に抽出した障害物の特徴をもとに障害物に追従し、それ以外の時には前記計時手段が所定時間を計時した時点で走行を開始する自走式機器とするとのである。これにより、使用者が、自走式機器に起動をかけて、その走行すべき方向の前に立つか否かで、追従動作または教示動作を行わせるか、実行動作を行わせるかが選択指定でき、また使用者がホースを引っ張ったり指示手段を振り続けたりして自走式機器を誘導し続けなくとも、自発的に追従することができる。   The first invention is a travel means, an obstacle detection means for detecting surrounding obstacles, a control means for controlling the travel means, and an activation means for activating the control means. And a time-counting means for measuring the time since the start-up means started, and an obstacle follow-up means, and the control means suspends the start of traveling when the start-up means is started. When the obstacle is detected from a state in which no obstacle is detected in the direction in which the obstacle detection means should run until the time measuring means counts a predetermined time from activation, the obstacle tracking means starts at least when the obstacle is detected. The self-propelled device follows the obstacle based on the characteristics of the obstacle extracted at the start of traveling, and at other times the timekeeping means starts traveling when the predetermined time is counted. As a result, the user can start the self-propelled device and select whether to perform the follow-up operation or teaching operation or execute operation depending on whether it stands in front of the direction to travel. In addition, it is possible to follow up spontaneously without the user continuing to guide the self-propelled device by pulling the hose or continuously swinging the instruction means.

第2の発明は、特に、第1の発明において、保留時間設定手段を備え、起動手段で起動がかけられてから計時手段が計時すべき走行の開始を保留する時間の上限設定を行うことにより、自走式機器に起動をかけて、その走行すべき方向の前に立つまでの時間の余裕度を持たせて、高齢者など動作の遅い使用者に対応することができる。   According to a second aspect of the present invention, in particular, in the first aspect of the present invention, the apparatus includes a holding time setting unit, and sets an upper limit of a time during which the time counting unit holds the start of running to be timed after being started by the starting unit. It is possible to deal with a slow-operating user such as an elderly person by starting up the self-propelled device and giving a margin of time to stand in front of the direction to travel.

第3の発明は、特に、第1または第2の発明において、障害物検知手段が連続して障害物を検知した時間を計時するための第2の計時手段を備え、制御手段は、計時手段が所定の時間を計時するまでに、前記障害物検知手段で走行すべき方向に障害物を検知しない状態から前記第2の計時手段で所定時間以上連続して障害物を検知した時には少なくとも走行を開始し、それ以外の時には走行を開始することにより、使用者が追従動作の開始を取り消したい場合にも対応することができる。   The third invention, in particular, in the first or second invention, comprises a second time measuring means for measuring the time when the obstacle detecting means continuously detects the obstacle, and the control means is a time measuring means. At least when the obstacle is detected by the second time measuring means from the state where no obstacle is detected in the direction to be traveled by the obstacle detecting means until the predetermined time is counted. By starting and running at other times, it is possible to cope with the case where the user wants to cancel the start of the follow-up operation.

第4の発明は、特に、第3の発明において、連続検知時間設定手段を備え、第2の計時手段が計時すべき時間の設定を行うことにより、使用者が追従動作の開始を取り消したい場合の余裕度を調整することができる。   The fourth invention is the case where the user wants to cancel the start of the follow-up operation by providing the continuous detection time setting means in the third invention and setting the time to be timed by the second time measuring means. Can be adjusted.

第5の発明は、特に、第1〜第4のいずれか1つの発明において、追従対象の障害物がその場に停止していることを検知する追従対象停止検知手段と、追従対象の障害物がその場に停止した時間を計時するための第3の計時手段と、停止した時間に応じた動作を定義する動作定義手段とを備え、障害物を検知して走行を開始した時は、追従対象の障害物がその場に停止した時間に応じて前記動作定義手段で定義された動作を行うことにより、使用者が自走式機器を追従させている途中で停止するだけでその停止時間でその場で行う動作を指定することができる。   According to a fifth aspect of the invention, in particular, in any one of the first to fourth aspects of the invention, follow-up target stop detection means for detecting that the follow-up target obstacle is stopped on the spot, and the follow-up target obstacle Has a third time measuring means for measuring the time when the vehicle stops on the spot, and an action defining means for defining an action according to the time when the vehicle stops. By performing the action defined by the action definition means according to the time when the target obstacle is stopped on the spot, the user can simply stop while the self-propelled device is being tracked. You can specify what happens on the spot.

第6の発明は、特に、第5の発明において、撮影手段を備え、障害物を検知して走行を開始した時は、動作定義手段により撮影動作と定義された場所で撮影を行うことにより、走行経路の中で撮影を行いたい場所を簡単に指定することができる。   In particular, the sixth invention is characterized in that, in the fifth invention, the photographing means is provided, and when the obstacle is detected and the traveling is started, photographing is performed at a place defined as the photographing operation by the action defining means, You can easily specify where you want to shoot in the route.

第7の発明は、特に、第5または第6の発明において、報知手段を備え、障害物を検知して走行を開始した時は、前記報知手段は第3の計時手段が計時する時間が動作定義手段で動作定義される時間と一致するタイミングで報知を行うことにより、指定したい動作の停止時間が使用者にわかるので容易に動作指定を行うことができる。   According to a seventh aspect of the invention, in particular, in the fifth or sixth aspect of the invention, the information means is provided, and when the obstacle is detected and the vehicle starts to travel, the information means operates in a time measured by the third time measuring means. By performing notification at a timing that coincides with the time defined by the defining means, the user can easily designate the operation because the user knows the stop time of the operation to be designated.

第8の発明は、特に、第1〜第7のいずれか1つの発明において、走行距離測定手段と、走行方向検知手段と、前記走行距離測定手段で検知した走行距離と前記走行方向検知手段で検知した走行方向から走行位置を算出する走行位置算出手段と、走行位置の基準位置を検知するための走行基準位置検知手段と、前記走行基準位置検知手段で検知した走行基準位置と前記走行位置算出手段から走行すべき範囲の走行マップを作成する走行マップ作成手段と、走行情報記憶手段とを備え、障害物を検知して走行を開始した時は、少なくとも前記走行マップ作成手段により障害物追従軌跡から作成した走行マップを前記走行情報記憶手段に記憶し、障害物を検知せずに走行を開始した時は、前記走行情報記憶手段に記憶された走行情報に従い走行を行うことにより、予め掃除する範囲の地図を入力することなく、使用者への追従動作を教示動作として、作業する範囲の地図を自動的に作成記憶し、その記憶された地図に基づいて何度でも作業を行うことができる。また、作業範囲の外周だけ自走式機器を追従させれば内部は予め決められたパターンで自走作業を行うので、使用者の追従動作が少なくて済むものである。   In an eighth aspect of the present invention, in particular, in any one of the first to seventh aspects of the present invention, the travel distance measurement means, the travel direction detection means, the travel distance detected by the travel distance measurement means, and the travel direction detection means. Travel position calculation means for calculating a travel position from the detected travel direction, travel reference position detection means for detecting a reference position of the travel position, travel reference position detected by the travel reference position detection means, and travel position calculation A travel map creating means for creating a travel map of a range to be traveled from the means, and a travel information storage means, and when the obstacle is detected and the travel is started, at least the obstacle tracking locus by the travel map creating means Is stored in the travel information storage means, and when the travel is started without detecting an obstacle, the travel information is stored according to the travel information stored in the travel information storage means. Thus, without inputting a map of the area to be cleaned in advance, the user can automatically create and store a map of the area to be worked on using the following operation to the user as a teaching operation, and repeatedly based on the stored map. But you can do the work. Further, if the self-propelled device is made to follow only the outer periphery of the work range, the inside performs the self-running work in a predetermined pattern, so that the user's follow-up operation can be reduced.

第9の発明は、特に、第8の発明において、走行情報修正手段を備え、走行情報記憶手段に記憶した走行情報を確認して修正を行うことにより、追従させて概略の地図や動作を記憶させておき、使用者が後で微修正することで、使用者が教示したい地図や動作を手間をかけずに教示することができる。   In particular, the ninth aspect of the invention includes the travel information correction means in the eighth aspect of the invention, and confirms and corrects the travel information stored in the travel information storage means so as to follow and store a rough map and operation. In addition, by making a fine correction later by the user, it is possible to teach a map or an operation that the user wants to teach without trouble.

第10の発明は、第1〜第9のいずれか1つの発明における自走式機器の機能の少なくとも一部をコンピュータに実行させるためのプログラムとすることにより、プログラムであるので、電気・情報機器、コンピュータ、サーバーなどのハードリソースを協働させて本発明の情報報知機器の少なくとも一部を容易に実現することができる。また、記録媒体に記録したり通信回線を用いてプログラムを配信したりすることで、プログラムの配布・更新やそのインストール作業が簡単にできる。   Since the tenth invention is a program by causing a computer to execute at least part of the functions of the self-propelled device according to any one of the first to ninth inventions, the electrical / information device It is possible to easily realize at least a part of the information notification device of the present invention by cooperating hardware resources such as a computer and a server. Also, by recording the program on a recording medium or distributing the program using a communication line, the program can be easily distributed / updated and installed.

以下、本発明の実施の形態について、図面を参照しながら説明する。なお、この実施の形態によって本発明が限定されるものではない。   Hereinafter, embodiments of the present invention will be described with reference to the drawings. In addition, this invention is not limited by this embodiment.

(実施の形態1)
図1〜図3は、本発明の実施の形態1における自走式機器およびそのプログラムを示すものである。
(Embodiment 1)
1 to 3 show a self-propelled device and a program thereof according to Embodiment 1 of the present invention.

図1には、自走式機器の一例として自走式掃除機を示している。自走式機器の本体101は、モータ103とこれにより駆動される駆動輪104を有する走行手段102と、吸引部である掃除手段105と、周囲の障害物を検知するための障害物検知手段106と、走行手段102および掃除手段105を制御するための制御手段107と、制御手段107に対して起動をかけるための起動手段(起動スイッチ)108と、起動手段108が起動(ON)をかけてからの時間を計時するための計時手段109と、障害物を検知した後に追従走行するための障害物追従手段110と、計時手段109が計時すべき時間を設定するための保留時間設定手段113と、障害物検知手段106が連続して障害物を検知した時間を計時する第2の計時手段114と、第2の計時手段114が計時すべき時間を設定するための連続検知時間設定手段115と、報知手段116とを備えている。   FIG. 1 shows a self-propelled cleaner as an example of a self-propelled device. The main body 101 of the self-propelled device includes a traveling unit 102 having a motor 103 and a driving wheel 104 driven by the motor 103, a cleaning unit 105 serving as a suction unit, and an obstacle detection unit 106 for detecting surrounding obstacles. A control means 107 for controlling the traveling means 102 and the cleaning means 105, an activation means (activation switch) 108 for activating the control means 107, and the activation means 108 is activated (ON). A time counting means 109 for measuring the time from the vehicle, an obstacle tracking means 110 for following the vehicle after detecting an obstacle, a holding time setting means 113 for setting the time to be timed by the time measuring means 109, The second time measuring means 114 that measures the time when the obstacle detecting means 106 continuously detects the obstacle, and the time that the second time measuring means 114 should time are set. Continuous detection time setting means 115 because, and a notification unit 116.

前記障害物検知手段106は、測距センサであり(本実施の形態では、赤外線測距センサを本体101の前方正面に1箇所、前方左に1箇所、前方右に1箇所、右横に1箇所、左横に1箇所備えている)、追従するための障害物と判断する閾値は30cm以下とし、前方の3箇所に備えた測距センサのうちいずれの測距センサが閾値以下となったかどうかにより、制御手段107が障害物の概略方向を判断する。なお、障害物検知手段106である測距センサは、自走して掃除する場合の前方障害物と判断する閾値は10cm以下とし、側方障害物と判断する閾値は3cm以下としている。   The obstacle detecting means 106 is a distance measuring sensor (in the present embodiment, the infrared distance measuring sensor is provided at one position in front of the main body 101, one position on the front left, one position on the front right, and one position on the right side. The threshold value for determining an obstacle to follow is 30 cm or less, and which of the distance measurement sensors provided at the three front locations is below the threshold value. Depending on what, the control means 107 determines the approximate direction of the obstacle. In the distance measuring sensor which is the obstacle detecting means 106, the threshold value for determining a front obstacle when self-running and cleaning is 10 cm or less, and the threshold value for determining a side obstacle is 3 cm or less.

また、制御手段107は、計時手段109が所定の時間を計時するまでに、障害物検知手段106で走行すべき方向に障害物を検知しない状態から第2の計時手段114で所定時間以上連続して障害物を検知した時には少なくとも走行を開始し、それ以外の時には走行とともに掃除を開始するものである。   Further, the control means 107 continues from the state in which no obstacle is detected in the direction in which the obstacle detection means 106 should travel until the time measurement means 109 measures a predetermined time from the state in which the second time measurement means 114 continues for a predetermined time or more. When the obstacle is detected, at least the traveling is started, and at other times, the cleaning is started together with the traveling.

また、障害物追従手段110は、障害物特徴抽出部111と障害物方向指示部112を備えている。障害物特徴抽出部111は、カメラからなる撮影手段117と画像処理部118を備えている。   The obstacle tracking unit 110 includes an obstacle feature extraction unit 111 and an obstacle direction instruction unit 112. The obstacle feature extraction unit 111 includes a photographing unit 117 including a camera and an image processing unit 118.

また、保留時間設定手段113は、起動手段108で起動がかけられてから計時手段109が計時すべき走行および掃除の開始を保留する時間の上限設定を行うものである。   The holding time setting means 113 sets an upper limit for the time for which the timing means 109 holds the start of running and cleaning that should be timed after the activation means 108 is activated.

そして、制御手段107は、起動手段108で起動がかけられた時点では走行および掃除の開始を保留し、計時手段109が起動から所定時間を計時するまでに障害物検知手段106で走行すべき方向に障害物を検知しない状態から障害物を検知した時には少なくとも走行を開始して障害物追従手段110により走行開始時に抽出した障害物の特徴をもとに障害物に追従し、それ以外の時には計時手段109が所定時間を計時した時点で走行とともに掃除を開始するものである。   The control means 107 suspends the start of running and cleaning at the time when the activation means 108 is activated, and the direction in which the obstacle detection means 106 should travel until the time measuring means 109 times a predetermined time from the activation. When an obstacle is detected from a state in which no obstacle is detected, at least the vehicle starts to travel and follows the obstacle based on the characteristics of the obstacle extracted at the start of traveling by the obstacle tracking means 110. When the means 109 measures a predetermined time, cleaning is started as the vehicle travels.

図3は、撮影手段117の撮影画像最大領域119と、障害物に追従する際に画像処理部118で特徴抽出するための特徴抽出領域120を示している。本実施の形態では、前方正面に設置している障害物検知手段106の障害物との距離を狙う中心と撮影画像最大領域119の中心が一致するように撮影手段117を本体101に設置している。   FIG. 3 shows a captured image maximum region 119 of the imaging means 117 and a feature extraction region 120 for extracting features by the image processing unit 118 when following an obstacle. In the present embodiment, the photographing unit 117 is installed in the main body 101 so that the center of the obstacle detection unit 106 installed in front of the obstacle and the center of the captured image maximum region 119 coincide with the center. Yes.

以上のように構成された自走式機器について、以下その動作、作用を図2のフローチャートにもとづいて説明する。   The operation and action of the self-propelled device configured as described above will be described below with reference to the flowchart of FIG.

まず、使用者が起動手段(起動スイッチ)108をONすると、計時手段109は計時を開始すると同時に、制御手段107は、障害物検知手段106で障害物有無の初期状態を確認(本実施の形態では、1回あたりの確認の際には過去5回の移動平均値を用いて状態を判定している)し、その状態を今回の確定状態とする(ステップ1〜3)。初期状態が確定すれば、再び障害物検知手段106で障害物の有無を確認する(ステップ4)。   First, when the user turns on the activation means (activation switch) 108, the timing means 109 starts timing, and at the same time, the control means 107 confirms the initial state of the presence or absence of the obstacle with the obstacle detection means 106 (this embodiment) Then, at the time of confirmation for each time, the state is determined using the moving average value of the past five times), and the state is set as the final confirmed state (steps 1 to 3). If the initial state is confirmed, the obstacle detection means 106 confirms the presence or absence of an obstacle again (step 4).

チェックした結果、障害物ありの時には、前回状態(前回ステップ4でチェックした時の状態)が障害物なしであれば、第2の計時手段114の計時を開始し(ステップ5、ステップ6)、前回状態も障害物ありであれば、ステップ4での障害物ありと連続して検知した時間、即ち第2の計時手段114で計時した時間が、連続検知時間設定手段115で設定された時間(本実施の形態では5秒)以上かどうかを確認して、設定された時間未満であれば、ステップ7へ進む。第2の計時手段114で計時した時間が、設定した時間以上であれば、今回確定状態を障害物ありとして、第2の計時手段114で計時した時間をリセットして再度計時を開始する(ステップ9、ステップ10)。この時、前回確定状態が障害物なしであれば、追従走行開始の条件成立として、障害物特徴抽出部111で障害物の特徴を抽出して、その抽出した特徴をもとに追従走行し掃除を行う(ステップ12、ステップ13)。即ち、追従走行開始の条件成立した時点で、前方3箇所に配した障害物検知手段106の検知している距離の状況から、障害物方向指示部112は、制御手段107に対し障害物の概略方向を指示し、制御手段107は、走行手段102を制御して本体101をその方向に向ける。撮影手段117で常時または定期的に撮影を行い、図3に示したように画像処理部118は、撮影した画像について予め決められた特徴抽出領域120における障害物の色の分布(本実施例では彩度)を障害物の特徴として抽出し、以降撮影される画像についても色分布を算出する。障害物方向指示部112は、撮影画像最大領域119内での色分布の移動方向により制御手段107に対し障害物の方向を指示し、制御手段107は、走行手段102を制御して本体101をその方向に向け、障害物検知手段106の距離情報で補完を行いながら障害物との距離を一定に保ちながら追従を行う。前回確定状態も障害物ありであれば、ステップ7へ進む。   As a result of checking, when there is an obstacle, if the previous state (the state when checked in the previous step 4) is no obstacle, the second time measuring means 114 starts counting (steps 5 and 6), If there is also an obstacle in the previous state, the time continuously detected as having an obstacle in step 4, that is, the time measured by the second time measuring means 114 is the time set by the continuous detection time setting means 115 ( In this embodiment, it is confirmed whether it is 5 seconds or more, and if it is less than the set time, the process proceeds to step 7. If the time measured by the second time measuring unit 114 is equal to or longer than the set time, the time determined by the second time measuring unit 114 is reset by setting the current confirmed state as an obstacle, and starts counting again (step) 9, step 10). At this time, if there is no obstacle in the previous confirmed state, the obstacle feature extraction unit 111 extracts the feature of the obstacle as the establishment of the condition for starting the follow-up running, and follows up and cleans based on the extracted feature. (Step 12, Step 13). That is, at the time when the condition for starting the follow-up running is satisfied, the obstacle direction instruction unit 112 gives the control means 107 an outline of the obstacle based on the distances detected by the obstacle detection means 106 arranged at three locations ahead. Instructing the direction, the control means 107 controls the traveling means 102 to point the main body 101 in that direction. The photographing unit 117 performs photographing constantly or periodically, and as shown in FIG. 3, the image processing unit 118 distributes the color of the obstacle in the feature extraction region 120 determined in advance for the photographed image (in this embodiment, Saturation) is extracted as a feature of the obstacle, and a color distribution is calculated for an image that is subsequently captured. The obstacle direction instructing unit 112 instructs the control unit 107 on the direction of the obstacle by the moving direction of the color distribution in the captured image maximum area 119. The control unit 107 controls the traveling unit 102 to control the main body 101. In that direction, the distance information from the obstacle detection means 106 is complemented while the distance from the obstacle is kept constant. If there is an obstacle in the previous confirmed state, the process proceeds to step 7.

ステップ4でチェックした結果、障害物なしの時には、今回確定状態を障害物なしとして、第2の計時手段114の計時をリセットして計時を停止して(ステップ14、ステップ15)、ステップ7に進む。   As a result of checking in step 4, when there is no obstacle, the final state is determined to be no obstacle, the time measurement of the second time measuring means 114 is reset and the time measurement is stopped (steps 14 and 15). move on.

ステップ7では、起動手段108がONされてからの時間、即ち計時手段109での計時時間が、保留時間設定手段113で設定された時間(本実施の形態では15秒)以上かどうか確認し、設定されている時間以上であれば、予め決められた走行パターン(本実施の形態では壁沿い走行および往復走行)で自走しての掃除を開始する(ステップ8)。設定されている時間未満であれば、ステップ4に戻り、障害物検知手段106で障害物の有無を確認する。   In step 7, it is confirmed whether the time since the activation means 108 is turned on, that is, the time measured by the time measuring means 109 is not less than the time set by the hold time setting means 113 (15 seconds in this embodiment). If it is longer than the set time, the self-running cleaning is started in a predetermined running pattern (running along the wall and reciprocating running in this embodiment) (step 8). If it is less than the set time, the process returns to step 4 and the obstacle detection means 106 confirms whether there is an obstacle.

使用者に動作がわかりやすいように、本実施の形態では制御手段107は、走行が開始された時点(ステップ8またはステップ13)で、報知手段116により、自走掃除開始時は音声で「自走して掃除します」、追従走行開始時は音声で「追従します」と報知を行うようにしたが、ブザー音の回数などで区別して報知するようにしてもかまわない。   In order to make it easy for the user to understand the operation, in the present embodiment, the control means 107, at the point of time when the running is started (step 8 or step 13), is notified by the notifying means 116 when the self-running cleaning starts. “When the follow-up is started,” “I will follow up” is notified by voice, but it is also possible to make a distinction based on the number of buzzer sounds.

本実施の形態では、障害物検知手段106として測距センサの検知距離を用いたが、撮影手段117で撮影した画像を使用して画像処理部118で複数枚の撮影画像について撮影画像最大領域119の特定領域についての輝度変化で動体検知を行ったりして障害物の検知を行うようにしてもかまわない。   In the present embodiment, the detection distance of the distance measuring sensor is used as the obstacle detection unit 106, but the captured image maximum region 119 is used for a plurality of captured images by the image processing unit 118 using the images captured by the imaging unit 117. An obstacle may be detected by detecting a moving object based on a change in luminance of the specific area.

また、追従走行する際に掃除も行うようにしたが、掃除をするかどうかを設定するようにしてもかまわない。また、本実施の形態では、追従走行開始の条件成立した時点で、前方3箇所に配した障害物検知手段106の検知している距離の状況から、障害物方向指示部112は、制御手段107に対し障害物の概略方向を指示し、制御手段107は、走行手段102を制御して本体101をその方向に向けるようにしたが、撮影手段117を撮影方向可変のカメラとし、カメラを制御してその方向に向けるようにしてもかまわない。   Further, although cleaning is also performed when following the vehicle, it may be set whether or not cleaning is performed. Further, in the present embodiment, when the condition for starting the follow-up running is satisfied, the obstacle direction indicating unit 112 is controlled by the control means 107 based on the distances detected by the obstacle detecting means 106 arranged at three locations ahead. The control means 107 controls the traveling means 102 to point the main body 101 in the direction, but the imaging means 117 is a camera with a variable imaging direction and controls the camera. You can make it point in that direction.

さらに、本実施の形態では、障害物特徴抽出部111で障害物の特徴の抽出を画像処理部118での色分布としたが、画像処理部118での輪郭などを使用してもかまわないし、画像処理ではなく温度センサによる温度分布などを用いてもかまわないし、障害物検知手段106も測距センサを使用したが、画像処理で障害物検知を行ってもかまわない。   Further, in the present embodiment, the obstacle feature extraction unit 111 extracts the obstacle feature as the color distribution in the image processing unit 118, but the contour in the image processing unit 118 may be used. A temperature distribution by a temperature sensor or the like may be used instead of image processing, and the obstacle detection unit 106 also uses a distance measuring sensor, but obstacle detection may be performed by image processing.

以上のように、走行手段102と、掃除手段105と、障害物検知手段106と、制御手段107と、制御手段107に対して起動をかけるための起動手段108と、起動手段108がONしてからの時間を計時するための計時手段109と、障害物追従手段110を備え、制御手段107は起動手段108がONした時点では走行および掃除の開始を保留し、計時手段109が所定時間(本実施の形態では15秒)を計時するまでに障害物検知手段106で走行すべき方向である前方に障害物を検知しない状態から障害物を検知した時には少なくとも走行を開始して障害物追従手段110により走行開始時に抽出した障害物の特徴をもとに障害物に追従し、それ以外の時には計時手段109が所定時間を計時した時点で走行とともに掃除を開始するようにしたことで、自走式機器に起動をかけて、その走行すべき方向の前に立つか否かで、追従動作を行わせるか、実行動作を行わせるか選択指定ができる。これにより、使用者がホースを引っ張ったり指示手段(送信器)を振り続けたりして掃除機を誘導し続けなくとも、自発的に追従する自走式機器を提供することができる。   As described above, the travel means 102, the cleaning means 105, the obstacle detection means 106, the control means 107, the activation means 108 for activating the control means 107, and the activation means 108 are turned on. Time measuring means 109 for measuring the time from the vehicle and obstacle follower means 110, and the control means 107 suspends the start of running and cleaning when the starting means 108 is turned on. In the embodiment, when the obstacle is detected from the state where the obstacle is not detected in front of the obstacle detection means 106 until the time is counted 15 seconds), the obstacle tracking means 110 is started at least when the obstacle is detected. To follow the obstacle based on the characteristics of the obstacle extracted at the start of traveling, and otherwise, the timekeeping means 109 keeps cleaning with the traveling at the time when the predetermined time is counted. By was to start, over activated self-propelled equipment, depending on whether standing in front of the running to be the direction, whether to perform the following operation, it is either selected and designated to perform the execution operation. Thus, it is possible to provide a self-propelled device that follows spontaneously without the user pulling the hose or continuously instructing the transmitter (transmitter) to continuously guide the cleaner.

また、保留時間設定手段113を備え、起動手段108で起動がかけられてから計時手段109が計時すべき走行および掃除の開始を保留する時間の上限(本実施の形態では15秒)を設定することで、自走式機器に起動をかけて、その走行すべき方向の前に立つまでの時間の余裕度を持たせて、高齢者など動作の遅い使用者に対応することができる。   In addition, a holding time setting unit 113 is provided, and an upper limit (15 seconds in the present embodiment) of the time for which the timing unit 109 holds the start of running and cleaning after the activation by the activation unit 108 is set. Thus, the self-propelled device can be activated and given a margin of time to stand in front of the direction in which it should travel, so that it is possible to cope with a slow user such as an elderly person.

さらに、障害物検知手段106が連続して障害物を検知した時間を計時するための第2の計時手段114を備え、制御手段107は、計時手段109が所定の時間を計時するまでに、障害物検知手段106で走行すべき方向に障害物を検知しない状態から第2の計時手段114で所定時間(本実施の形態では5秒)以上連続して障害物を検知した時には少なくとも走行を開始し、それ以外の時には走行とともに掃除を開始することで、使用者が追従動作の開始を取り消ししたい場合にも対応できる自走式機器を提供することができる。   Furthermore, a second time measuring unit 114 for measuring the time when the obstacle detecting unit 106 continuously detects the obstacle is provided, and the control unit 107 detects the time until the time measuring unit 109 measures a predetermined time. When the obstacle detection means 106 detects an obstacle continuously for a predetermined time (5 seconds in the present embodiment) from the state in which no obstacle is detected in the direction in which the object should travel, the vehicle starts at least traveling. In other cases, it is possible to provide a self-propelled device that can cope with the case where the user wants to cancel the start of the follow-up operation by starting the cleaning with traveling.

また、連続検知時間設定手段115を備え、第2の計時手段114が計時すべき障害物検知手段106が連続して障害物を検知した時間(本実施の形態では5秒)の設定を行うことで、使用者が追従動作の開始を取り消ししたい場合の余裕度を調整できる自由度の高い自走式機器を提供することができる。   In addition, continuous detection time setting means 115 is provided, and the time (5 seconds in this embodiment) when the obstacle detection means 106 to be timed by the second time measurement means 114 continuously detects the obstacle is set. Thus, it is possible to provide a self-propelled device with a high degree of freedom that can adjust the margin when the user wants to cancel the start of the tracking operation.

(実施の形態2)
図4、図5は、本発明の実施の形態2における自走式機器およびそのプログラムを示すものである。実施の形態1と同一要素については同一符号を付してその説明を省略する。
(Embodiment 2)
4 and 5 show a self-propelled device and a program thereof according to Embodiment 2 of the present invention. The same elements as those in the first embodiment are denoted by the same reference numerals, and the description thereof is omitted.

図4に示すように、本実施の形態における自走式機器の本体124は、実施の形態1の構成に加えて、追従対象の障害物がその場に停止していることを検知するための追従対象停止検知手段121と、追従対象の障害物がその場に停止している時間を計時するための第3の計時手段122と、追従対象が停止している時間に応じてその場で行う動作を定義するための動作定義手段123とを備えている。また、動作定義手段123は、図5に一例を示すように、停止時間に応じて定義される動作定義内容を有するものである。   As shown in FIG. 4, the main body 124 of the self-propelled device in the present embodiment is for detecting that the obstruction to be followed is stopped on the spot in addition to the configuration of the first embodiment. The tracking target stop detection unit 121, the third timing unit 122 for measuring the time during which the tracking target obstacle is stopped on the spot, and the tracking target stop detection unit 121 are performed on the spot according to the time when the tracking target is stopped. And an action definition means 123 for defining an action. Further, as shown in FIG. 5, the action definition unit 123 has action definition contents defined according to the stop time.

以上のように構成された自走式機器について、以下その動作、作用を説明する。   About the self-propelled apparatus comprised as mentioned above, the operation | movement and an effect | action are demonstrated below.

追従掃除を開始するか自走掃除を開始するかの動作、および追従走行する動作は実施の形態1と同様である。追従掃除中に、使用者が停止すると、障害物追従手段110の画像処理部118からの処理結果と障害物検知手段106の検知距離が次第に近くなり、障害物方向指示部112から出される指示により、制御手段107が走行手段102の走行速度を停止するまで次第に落としていく。追従対象停止検知手段121は、障害物方向指示部112から出される指示と、走行が停止したことを制御手段107より受けて、追従対象が停止したことを検知する。第3の計時手段122は、追従対象停止検知手段121が障害物の停止を検知した時点で計時を開始する。動作定義手段123は、計時時間が図5で示した各時間を経過した時点で、定義された動作をそこで行う仮動作として制御手段107に通知し、報知手段116は、例えば3秒経過時点で「念入り掃除動作するようにしますか?」と音声報知する。使用者が行いたい動作が撮影ならば、使用者は、3秒経過時に報知手段116が「念入り掃除動作するようにしますか?」と報知してもさらに停止して、5秒経過時に報知手段116が「撮影するようにしますか?」と報知した時点で、即ち自走式機器の本体124の前で5秒以上10秒未満停止して再び追従させたい場所へ向けて歩き始めれば良い。追従掃除を終了させたい時には、使用者は自走式機器の本体124の前で10秒以上停止して、報知手段116が「一時停止するようにしますか?」と報知した時点で、起動手段108をOFFすれば良い。   The operation of starting follow-up cleaning or starting self-running cleaning and the operation of following-running are the same as in the first embodiment. When the user stops during the tracking cleaning, the processing result from the image processing unit 118 of the obstacle tracking unit 110 and the detection distance of the obstacle detection unit 106 gradually become closer, and according to an instruction issued from the obstacle direction instruction unit 112 The control means 107 gradually decreases until the traveling speed of the traveling means 102 is stopped. The tracking target stop detection unit 121 receives an instruction issued from the obstacle direction instruction unit 112 and that the traveling has stopped from the control unit 107, and detects that the tracking target has stopped. The third timing unit 122 starts timing when the follow-up target stop detection unit 121 detects the stop of the obstacle. The operation defining unit 123 notifies the control unit 107 of the defined operation as a temporary operation performed at the time when each time shown in FIG. 5 has elapsed, and the notifying unit 116, for example, when 3 seconds have elapsed. A voice notification is made asking “Do you want to perform careful cleaning?” If the action that the user wants to perform is shooting, the user further stops even if the notification means 116 notifies "Would you like to perform careful cleaning operation" when 3 seconds have passed, and the notification means when 5 seconds have passed? What is necessary is just to start walking to the place where you want to follow after stopping for 5 seconds or more and less than 10 seconds in front of the main body 124 of the self-propelled device when 116 notifies "Do you want to shoot?" When the user wants to finish the follow-up cleaning, the user stops for 10 seconds or more in front of the main body 124 of the self-propelled device, and when the notification means 116 notifies "Do you want to pause?" 108 may be turned off.

以上のように、本実施の形態においては、追従対象の障害物がその場に停止していることを検知する追従対象停止検知手段121と、追従対象の障害物がその場に停止した時間を計時するための第3の計時手段122と、停止した時間に応じた動作を定義する動作定義手段123を備え、障害物を検知して走行を開始した時は、追従対象の障害物がその場に停止した時間に応じて動作定義手段123で定義された動作を行うことにより、使用者が自走式機器を追従させている途中で停止するだけでその停止時間でその場で行う動作を指定することができる。   As described above, in the present embodiment, the tracking target stop detection unit 121 that detects that the tracking target obstacle is stopped on the spot, and the time when the tracking target obstacle is stopped on the spot. A third time measuring means 122 for measuring time and an action defining means 123 for defining an action according to the stop time are provided. When an obstacle is detected and the vehicle starts running, the obstacle to be followed By performing the action defined by the action definition means 123 according to the time stopped, the user can specify the action to be performed on the spot at the stop time just by stopping while the self-propelled device is being followed. can do.

また、撮影手段117を備え、障害物を検知して走行を開始した時は、動作定義手段123により撮影動作と定義された場所で撮影を行うことで、走行経路の中で監視したい場所などの撮影を行いたい場所を簡単に指定することができる。   In addition, when the vehicle is equipped with the photographing means 117 and detects the obstacle and starts traveling, the photographing is performed at the place defined as the photographing operation by the operation defining means 123, so that the place to be monitored in the traveling route, etc. You can easily specify where you want to shoot.

さらに、報知手段116を備え、障害物を検知して走行を開始した時は、報知手段116は第3の計時手段122が計時する時間が動作定義手段123で動作定義される時間と一致するタイミングで報知を行うことで、指定したい動作の停止時間が使用者にわかるので容易に動作指定を行うことができる。   Furthermore, when the vehicle is provided with the notification unit 116 and the vehicle starts to travel after detecting an obstacle, the notification unit 116 has a timing at which the time measured by the third time measurement unit 122 coincides with the time defined by the operation definition unit 123. By performing the notification, the user can easily specify the operation since the user knows the stop time of the operation to be specified.

(実施の形態3)
図6、図7は、本発明の実施の形態3における自走式機器およびそのプログラムを示すものである。実施の形態1、2と同一要素については同一符号を付してその説明を省略する。
(Embodiment 3)
6 and 7 show a self-propelled device and a program thereof according to Embodiment 3 of the present invention. The same elements as those in the first and second embodiments are denoted by the same reference numerals, and the description thereof is omitted.

図6に示すように、本実施の形態における自走式機器の本体132は、実施の形態2の構成に加えて、走行距離測定手段125と、自走式機器の本体132の走行方向を検知するためのジャイロセンサよりなる走行方向検知手段126と、走行距離測定手段125で検知した走行距離と走行方向検知手段126で検知した走行方向から走行位置(本実施の形態では、本体132の縦幅×横幅を1セルとしたXYセル座標)を算出する走行位置算出手段127と、走行位置の基準位置(本実施の形態では充電ステーション)を検知するための走行基準位置検知手段(本実施の形態では、充電ステーションに取り付けられた磁気テープを検知するための磁気検知手段)128と、走行位置算出手段127で算出される走行位置の軌跡から走行すべき範囲の走行マップを作成する走行マップ作成手段129と、走行情報記憶手段130と、走行情報記憶手段130に記憶した走行情報を確認して修正を行うための走行情報修正手段131を備えている。   As shown in FIG. 6, in addition to the configuration of the second embodiment, the main body 132 of the self-propelled device in the present embodiment detects the traveling direction of the travel distance measuring means 125 and the main body 132 of the self-propelled device. Travel direction detection means 126 composed of a gyro sensor, a travel distance detected by the travel distance measurement means 125 and a travel position detected by the travel direction detection means 126 (in this embodiment, the vertical width of the main body 132) X Traveling position calculation means 127 for calculating the XY cell coordinates with a horizontal width of 1 cell) and travel reference position detection means for detecting the reference position of the traveling position (charging station in the present embodiment) (this embodiment) Then, it is necessary to travel from the trajectory of the travel position calculated by the travel position calculation means 127 and the magnetic detection means 128 for detecting the magnetic tape attached to the charging station. A traveling map creating means 129 for creating a range traveling map, a travel information storage unit 130, and a travel information correcting means 131 for performing check and correct the travel information stored in the travel information storage unit 130.

また、図7に自走式機器の走行軌跡と走行および動作のマップの一例を示している。図中、走行範囲近辺の障害物133、走行位置の基準位置である原点を認識するための充電ステーション134、充電ステーション134を走行位置算出手段127が点線で示したセル単位で算出している、現在の本体132の位置するセル座標、即ち基準位置セル座標(原点セル座標)135、本体132が使用者を追従した結果の走行軌跡136、使用者追従中の使用者の停止時間によって指示された念入り掃除セル座標137a、137b、同じく使用者追従中の使用者の停止時間によって指示された撮影セル座標138a、138bをそれぞれ示している。   FIG. 7 shows an example of a travel locus and travel / operation map of the self-propelled device. In the figure, the obstacle 133 near the running range, the charging station 134 for recognizing the origin that is the reference position of the running position, and the charging station 134 are calculated by the running position calculating means 127 in units of cells indicated by dotted lines. It is instructed by the cell coordinates where the main body 132 is located, that is, the reference position cell coordinates (origin cell coordinates) 135, the travel locus 136 as a result of the main body 132 following the user, and the stop time of the user during the user following. Careful cleaning cell coordinates 137a and 137b and photographing cell coordinates 138a and 138b designated by the stop time of the user who is following the user are shown.

以上のように構成された自走式機器について、以下その動作、作用を図6および図7を用いて説明する。   About the self-propelled apparatus comprised as mentioned above, the operation | movement and an effect | action are demonstrated below using FIG. 6 and FIG.

まず、追従掃除を開始するか自走掃除を開始するかの動作、および追従走行する動作、および追従走行中に使用者の停止時間によって定義された、行うべき動作の指示は実施の形態2と同様である。   First, the operation of starting follow-up cleaning or self-running cleaning, the operation of following-running, and the instruction of the operation to be performed, defined by the stop time of the user during the follow-up running, are the same as those in the second embodiment. It is the same.

追従掃除中、走行距離測定手段125は駆動輪104の回転数から走行した距離の検知を行い、走行位置算出手段127は、この走行距離測定手段125で検知した走行距離と走行方向検知手段126で検知した走行方向から基準位置セル座標(原点セル座標)135を基準に現在走行中のXYセル座標を算出し、走行マップ作成手段129は、走行位置算出手段127が算出する走行軌跡136のセル座標を連続して作成していき、そのセル座標を走行情報記憶手段130に記憶していく。走行中に使用者の停止時間によって指示された動作があったセル座標については、制御手段107がその動作を走行情報記憶手段130に記憶された該当のセル座標の追加情報として走行情報記憶手段130に追加して記憶させる。追従掃除終了後には、この走行情報記憶手段130に走行情報修正手段131を用いて図7のように表示して確認し、掃除範囲や指示動作の修正を行うことができる。   During follow-up cleaning, the travel distance measuring means 125 detects the distance traveled from the number of rotations of the drive wheel 104, and the travel position calculating means 127 is detected by the travel distance and travel direction detecting means 126 detected by the travel distance measuring means 125. The XY cell coordinates currently being traveled are calculated from the detected travel direction with reference to the reference position cell coordinates (origin cell coordinates) 135, and the travel map creating means 129 calculates the cell coordinates of the travel locus 136 calculated by the travel position calculating means 127. Are continuously created, and the cell coordinates are stored in the travel information storage means 130. For the cell coordinates that have been instructed by the user's stop time while traveling, the control means 107 uses the operation information as additional information of the corresponding cell coordinates stored in the travel information storage means 130. Add to and remember. After the follow-up cleaning is completed, the travel information storage means 130 can be displayed and checked as shown in FIG. 7 using the travel information correction means 131, and the cleaning range and the instruction operation can be corrected.

次に、その後、本体132が、自走式掃除を行った時には、制御手段107は、走行情報記憶手段130に記憶された走行情報をもとに掃除範囲を認識し、まず、走行位置算出手段127で自身の走行中のセル座標を認識しながら、図7の走行軌跡136で示したセル座標を走行するように外周走行を行い、動作を指示のあるセル座標137a、137b、138a、138bでは該当の動作を行う。外周走行が終了すると、外周内部は予め決められた走行パターン(本実施の形態では往復走行)で外周を出ないように走行しながら掃除を行う。   Next, after that, when the main body 132 performs self-propelled cleaning, the control means 107 recognizes the cleaning range based on the travel information stored in the travel information storage means 130, and first the travel position calculation means In 127, while recognizing the cell coordinates in which the vehicle is traveling, the vehicle travels on the outer periphery so as to travel along the cell coordinates indicated by the travel locus 136 in FIG. Perform the corresponding operation. When the outer periphery traveling is finished, the inside of the outer periphery is cleaned while traveling so as not to leave the outer periphery with a predetermined traveling pattern (reciprocating traveling in the present embodiment).

本実施の形態では、走行情報記憶手段130に記憶する走行マップや指示動作を1パターンとしたが、複数パターン記憶できるようにして部屋毎に使い分けるようにしてもかまわない。また、本実施の形態では、走行方向検知手段126としてジャイロセンサを用いたが、駆動輪104の左右の回転数から本体132の角速度を算出して方向を検知するようにしてもかまわない。さらに、本実施の形態では、走行情報記憶手段130には動作定義手段123で定義後の停止時間に応じた動作を記憶するようにしたが、停止時間そのものを記憶するようにして、自走掃除を行う際に動作定義手段123で定義して動作を行うようにしてもかまわない。   In the present embodiment, the travel map and instruction operation stored in the travel information storage means 130 are one pattern, but a plurality of patterns may be stored and used separately for each room. In the present embodiment, a gyro sensor is used as the traveling direction detection means 126. However, the direction may be detected by calculating the angular velocity of the main body 132 from the left and right rotational speeds of the drive wheels 104. Furthermore, in the present embodiment, the travel information storage means 130 stores the operation corresponding to the stop time defined by the operation definition means 123. However, the self-running cleaning is performed by storing the stop time itself. When performing the above, the operation may be defined by the operation defining means 123.

以上のように、走行距離測定手段125と、走行方向検知手段126と、走行距離測定手段125で検知した走行距離と走行方向検知手段126で検知した走行方向から走行位置を算出する走行位置算出手段127と、走行位置の基準位置を検知するための走行基準位置検知手段128と、走行基準位置検知手段128で検知した走行基準位置と走行位置算出手段127から走行すべき範囲の走行マップを作成する走行マップ作成手段129と、走行情報記憶手段130とを備え、障害物を検知して走行を開始した時は、走行マップ作成手段129により障害物追従軌跡から作成した走行マップと使用者の停止時間に応じて定義された指示動作を走行情報記憶手段130に記憶し、障害物を検知せずに走行および掃除を開始した時は、走行情報記憶手段130に記憶された走行情報に従い走行して掃除を行うことで、予め掃除する範囲の地図を入力することなく、使用者への追従動作を教示動作として、掃除する範囲の地図や行うべき動作を自動的に作成記憶し、その記憶された地図や動作に基づいて何度でも掃除を行うことができる自走式機器を提供することができる。また、掃除範囲の外周だけ自走式機器を追従させれば内部は予め決められたパターンで自走掃除を行うので、使用者の追従動作が少なくて済むものである。   As described above, the travel position calculating means 125, the travel direction detecting means 126, and the travel position calculating means for calculating the travel position from the travel distance detected by the travel distance measuring means 125 and the travel direction detected by the travel direction detecting means 126. 127, travel reference position detection means 128 for detecting the reference position of the travel position, and a travel map of the range to travel from the travel reference position detected by the travel reference position detection means 128 and the travel position calculation means 127. A travel map creation unit 129 and a travel information storage unit 130 are provided. When an obstacle is detected and travel is started, the travel map created by the travel map creation unit 129 from the obstacle tracking locus and the stop time of the user When the driving operation and the cleaning are started without detecting an obstacle, the instruction operation defined in accordance with the driving information is stored in the driving information storage means 130. By running and cleaning according to the running information stored in the storage means 130, a map of the area to be cleaned and the following operation to be taught as a teaching operation should be performed without inputting a map of the area to be cleaned in advance. It is possible to provide a self-propelled device that automatically creates and stores an action and can perform cleaning as many times as necessary based on the stored map and action. Further, if the self-propelled device is made to follow only the outer periphery of the cleaning range, the inside performs self-running cleaning with a predetermined pattern, so that the user's follow-up operation can be reduced.

また、走行情報修正手段131を備え、走行情報記憶手段130に記憶した走行情報を確認して修正を行うことで、追従させて概略の地図や動作を記憶させておき、使用者が後で微修正することで、使用者が教示したい地図や動作を、手間をかけずに教示することができる。   In addition, a travel information correcting unit 131 is provided, and by confirming and correcting the travel information stored in the travel information storage unit 130, a rough map and an operation are memorized so that the user can easily By correcting, it is possible to teach a map or an operation that the user wants to teach without taking time and effort.

(実施の形態4)
次に、本発明の実施の形態4における自走式機器のプログラムついて説明する。
(Embodiment 4)
Next, a program for the self-propelled device according to the fourth embodiment of the present invention will be described.

本実施の形態では、実施の形態1〜3のいずれか1つに記載の自走式機器における機能の少なくとも一部をコンピュータに実行させるためのプログラムとしたものである。   In the present embodiment, a program for causing a computer to execute at least a part of the functions of the self-propelled device described in any one of the first to third embodiments is provided.

なお、実施の形態1〜3で説明した各手段は、CPU(またはマイコン)、RAM、ROM、記憶・記録装置、I/Oなどを備えた電気・情報機器、コンピュータ、サーバーなどのハードリソースを協働させる形態で実施してもよい。プログラムの形態であれば、磁気メディアや光メディアなどの記録媒体に記録したりインターネットなどの通信回路を用いて配信したりすることで新しい機能の配布・更新やそのインストール作業が簡単にできる。   Note that each means described in the first to third embodiments uses hardware resources such as a CPU (or microcomputer), a RAM, a ROM, a storage / recording device, an electric / information device including an I / O, a computer, a server, and the like. You may implement with the form made to cooperate. In the form of a program, it is possible to easily distribute and update new functions and install them by recording them on a recording medium such as magnetic media or optical media, or distributing them using a communication circuit such as the Internet.

上記した各実施の形態1〜4においては、自走式機器として自走式掃除機を例にとって説明したが、掃除機能に特化されない他の作業ロボットや監視ロボットなどであっても良いものである。   In each of the above-described first to fourth embodiments, a self-propelled cleaner has been described as an example of a self-propelled device. However, other working robots or monitoring robots that are not specialized for a cleaning function may be used. is there.

以上のように、本発明にかかる自走式機器およびそのプログラムは、簡易に、自走式機器に追従動作または教示動作を行わせるか、実行動作を行わせるかが選択指定できるとともに、機器が自発的に追従することができるので、自走式掃除機はもとより、作業ロボットや監視ロボットなどに適用することができる。   As described above, the self-propelled device and the program thereof according to the present invention can easily select and specify whether the self-propelled device performs a follow-up operation or a teaching operation or an execution operation. Since it can follow voluntarily, it can be applied not only to self-propelled cleaners but also to working robots and surveillance robots.

本発明の実施の形態1における自走式機器の構成を示すブロック図The block diagram which shows the structure of the self-propelled apparatus in Embodiment 1 of this invention. 同自走式機器の動作の流れを示すフローチャートFlow chart showing the flow of operation of the self-propelled device 同自走式機器の画像処理部で処理する画像領域を示す図The figure which shows the image area processed by the image processing part of the self-propelled device 本発明の実施の形態2における自走式機器の構成を示すブロック図The block diagram which shows the structure of the self-propelled apparatus in Embodiment 2 of this invention. 同自走式機器の動作定義手段で定義される動作定義内容の一例を示す図The figure which shows an example of the action definition contents defined by the action definition means of the self-propelled device 本発明の実施の形態3における自走式機器の構成を示すブロック図The block diagram which shows the structure of the self-propelled apparatus in Embodiment 3 of this invention. 同自走式機器の走行軌跡と走行および動作の一例を示すマップ図Map diagram showing an example of the travel locus, travel, and operation of the self-propelled device

符号の説明Explanation of symbols

101 本体
102 走行手段
106 障害物検知手段
107 制御手段
108 起動手段
109 計時手段
110 障害物追従手段
111 障害物特徴抽出部
112 障害物方向指示部
113 保留時間設定手段
114 第2の計時手段
115 連続検知時間設定手段
116 報知手段
117 撮影手段
121 追従対象停止検知手段
122 第3の計時手段
123 動作定義手段
125 走行距離測定手段
126 走行方向検知手段
127 走行位置算出手段
128 走行基準位置検知手段
129 走行マップ作成手段
130 走行情報記憶手段
131 走行情報修正手段
DESCRIPTION OF SYMBOLS 101 Main body 102 Traveling means 106 Obstacle detection means 107 Control means 108 Start-up means 109 Timing means 110 Obstacle tracking means 111 Obstacle feature extraction part 112 Obstacle direction instruction part 113 Holding time setting means 114 Second time measurement means 115 Continuous detection Time setting means 116 Notification means 117 Imaging means 121 Tracking target stop detection means 122 Third timing means 123 Operation definition means 125 Travel distance measurement means 126 Travel direction detection means 127 Travel position calculation means 128 Travel reference position detection means 129 Travel map creation Means 130 Travel information storage means 131 Travel information correction means

Claims (10)

走行手段と、周囲の障害物を検知するための障害物検知手段と、前記走行手段を制御するための制御手段と、前記制御手段に対して起動をかけるための起動手段と、前記起動手段が起動をかけてからの時間を計時するための計時手段と、障害物追従手段とを備え、前記制御手段は前記起動手段で起動がかけられた時点では走行の開始を保留し、前記計時手段が起動から所定時間を計時するまでに前記障害物検知手段で走行すべき方向に障害物を検知しない状態から障害物を検知した時には少なくとも走行を開始して前記障害物追従手段により走行開始時に抽出した障害物の特徴をもとに障害物に追従し、それ以外の時には前記計時手段が所定時間を計時した時点で走行を開始する自走式機器。 Traveling means, obstacle detecting means for detecting surrounding obstacles, control means for controlling the traveling means, starting means for activating the control means, and the starting means A timing means for timing the time since the start, and an obstacle tracking means, the control means suspends the start of traveling at the time when the activation means is activated, the time measuring means When an obstacle is detected from a state in which no obstacle is detected in the direction to be traveled by the obstacle detection means until the predetermined time is counted from the start, the vehicle starts at least when the obstacle is detected and is extracted at the start of the travel by the obstacle tracking means. A self-propelled device that follows an obstacle based on the characteristics of the obstacle, and starts running when the time measuring means times a predetermined time otherwise. 保留時間設定手段を備え、起動手段で起動がかけられてから計時手段が計時すべき走行の開始を保留する時間の上限設定を行う請求項1に記載の自走式機器。 2. The self-propelled device according to claim 1, further comprising a holding time setting means, wherein an upper limit is set for a time during which the time counting means holds the start of running to be timed after being activated by the activation means. 障害物検知手段が連続して障害物を検知した時間を計時するための第2の計時手段を備え、制御手段は、計時手段が所定の時間を計時するまでに、前記障害物検知手段で走行すべき方向に障害物を検知しない状態から前記第2の計時手段で所定時間以上連続して障害物を検知した時には少なくとも走行を開始し、それ以外の時には走行を開始する請求項1または2に記載の自走式機器。 The obstacle detection means includes second timing means for timing the time when the obstacle detection means continuously detects the obstacle, and the control means travels by the obstacle detection means until the timing means times a predetermined time. 3. The vehicle according to claim 1 or 2, wherein the vehicle starts at least when an obstacle is detected continuously for a predetermined time or more by the second timing means from a state in which an obstacle is not detected in a direction to be performed, and starts traveling at other times. The described self-propelled device. 連続検知時間設定手段を備え、第2の計時手段が計時すべき時間の設定を行う請求項3に記載の自走式機器。 The self-propelled device according to claim 3, further comprising continuous detection time setting means, wherein the second time measuring means sets a time to be timed. 追従対象の障害物がその場に停止していることを検知する追従対象停止検知手段と、追従対象の障害物がその場に停止した時間を計時するための第3の計時手段と、停止した時間に応じた動作を定義する動作定義手段とを備え、障害物を検知して走行を開始した時は、追従対象の障害物がその場に停止した時間に応じて前記動作定義手段で定義された動作を行う請求項1〜4のいずれか1項に記載の自走式機器。 The tracking target stop detection means for detecting that the tracking target obstacle is stopped on the spot, the third timing means for measuring the time when the tracking target obstacle is stopped on the spot, and stopped. An action defining means for defining an action according to time, and when the obstacle is detected and the vehicle starts to travel, the action defining means defines the action according to the time when the obstacle to be followed stops on the spot. The self-propelled device according to any one of claims 1 to 4, wherein the self-propelled device performs the operation. 撮影手段を備え、障害物を検知して走行を開始した時は、動作定義手段により撮影動作と定義された場所で撮影を行う請求項5に記載の自走式機器。 6. The self-propelled device according to claim 5, wherein the self-propelled device is provided with a photographing unit, and performs photographing at a place defined as a photographing operation by the operation defining unit when an obstacle is detected and traveling is started. 報知手段を備え、障害物を検知して走行を開始した時は、前記報知手段は第3の計時手段が計時する時間が動作定義手段で動作定義される時間と一致するタイミングで報知を行う請求項5または6に記載の自走式機器。 And a notification means that detects when an obstacle is detected and starts traveling, wherein the notification means notifies at a timing at which the time counted by the third timing means coincides with the time defined by the action definition means. Item 7. The self-propelled device according to item 5 or 6. 走行距離測定手段と、走行方向検知手段と、前記走行距離測定手段で検知した走行距離と前記走行方向検知手段で検知した走行方向から走行位置を算出する走行位置算出手段と、走行位置の基準位置を検知するための走行基準位置検知手段と、前記走行基準位置検知手段で検知した走行基準位置と前記走行位置算出手段から走行すべき範囲の走行マップを作成する走行マップ作成手段と、走行情報記憶手段とを備え、障害物を検知して走行を開始した時は、少なくとも前記走行マップ作成手段により障害物追従軌跡から作成した走行マップを前記走行情報記憶手段に記憶し、障害物を検知せずに走行を開始した時は、前記走行情報記憶手段に記憶された走行情報に従い走行を行う請求項1〜7のいずれか1項に記載の自走式機器。 Travel distance measurement means, travel direction detection means, travel position calculation means for calculating a travel position from the travel distance detected by the travel distance measurement means and the travel direction detected by the travel direction detection means, and a reference position of the travel position A travel reference position detection means for detecting the travel reference position, a travel reference position detected by the travel reference position detection means, a travel map creation means for creating a travel map of a range to be traveled from the travel position calculation means, and travel information storage A travel map created from the obstacle tracking locus by the travel map creation means is stored in the travel information storage means without detecting the obstacle. The self-propelled device according to any one of claims 1 to 7, wherein when the vehicle starts to travel, the vehicle travels according to the travel information stored in the travel information storage unit. 走行情報修正手段を備え、走行情報記憶手段に記憶した走行情報を確認して修正を行う請求項8に記載の自走式機器。 The self-propelled device according to claim 8, further comprising travel information correcting means for checking and correcting travel information stored in the travel information storage means. 請求項1〜9のいずれか1項に記載の自走式機器における機能の少なくとも一部をコンピュータに実行させるためのプログラム。 The program for making a computer perform at least one part of the function in the self-propelled apparatus of any one of Claims 1-9.
JP2005009855A 2005-01-18 2005-01-18 Self-propelled device and its program Expired - Fee Related JP4311355B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2005009855A JP4311355B2 (en) 2005-01-18 2005-01-18 Self-propelled device and its program

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2005009855A JP4311355B2 (en) 2005-01-18 2005-01-18 Self-propelled device and its program

Publications (2)

Publication Number Publication Date
JP2006201829A JP2006201829A (en) 2006-08-03
JP4311355B2 true JP4311355B2 (en) 2009-08-12

Family

ID=36959795

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2005009855A Expired - Fee Related JP4311355B2 (en) 2005-01-18 2005-01-18 Self-propelled device and its program

Country Status (1)

Country Link
JP (1) JP4311355B2 (en)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6711565B2 (en) * 2015-07-07 2020-06-17 キヤノン株式会社 Communication device, control method thereof, and program
JP6717697B2 (en) * 2016-07-27 2020-07-01 シャープ株式会社 Autonomous traveling device
US10878294B2 (en) 2018-01-05 2020-12-29 Irobot Corporation Mobile cleaning robot artificial intelligence for situational awareness
US20220346315A1 (en) * 2019-04-25 2022-11-03 Kubota Corporation Harvesting Machine, Obstacle Determination Program, Recording Medium on Which Obstacle Determination Program is Recorded, Obstacle Determination Method, Agricultural Work Machine, Control Program, Recording Medium on Which Control Program is Recorded, and Control Method
JP7174487B2 (en) * 2019-04-25 2022-11-17 株式会社クボタ agricultural machine

Also Published As

Publication number Publication date
JP2006201829A (en) 2006-08-03

Similar Documents

Publication Publication Date Title
US11142121B2 (en) Interaction method and apparatus of mobile robot, mobile robot, and storage medium
EP4057099B1 (en) Universal recharge control method for robot, chip and robot
EP3460614B1 (en) Combined robot and cruising path generation method therefor
JP2004299025A (en) Mobile robot control device, mobile robot control method and mobile robot control program
JP5550671B2 (en) Autonomous traveling robot and traveling control method for autonomous traveling robot
JP5768273B2 (en) A robot that predicts a pedestrian's trajectory and determines its avoidance behavior
US9081384B2 (en) Autonomous electronic apparatus and navigation method thereof
WO2018087952A1 (en) Electric vacuum cleaner
JP2008084135A (en) Movement control method, mobile robot and movement control program
US20100222925A1 (en) Robot control apparatus
JP2002182742A (en) Mobile robot and its route correcting method
JP2006185438A (en) Robot control device
JP4311355B2 (en) Self-propelled device and its program
JP2003340764A (en) Guide robot
JP2011016401A (en) Parking assisting device
JP5828088B2 (en) Remote control system
CN109471442B (en) Processing method for meeting obstacle when robot linearly returns to seat, chip and robot
JP2008174000A (en) Parking assisting device, parking assisting device part, parking assisting method and parking assisting program
JP6569342B2 (en) Mobile robot
JP2010160735A (en) Mobile robot, running plan map generation method and management system
JP2018185767A (en) Environment maintenance robot, and control program of the same
US20230117848A1 (en) Method, system and device for analyzing pedestrian motion patterns
JP2020187483A (en) Autonomously moving body, control program for autonomously moving body, control method of autonomously moving body, and system server for remote control of autonomously moving body
JP6796458B2 (en) Vacuum cleaner
JP2016136916A (en) Injurious insect expelling device, and injurious insect expelling method

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20080117

RD01 Notification of change of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7421

Effective date: 20080213

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20090416

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: 20090421

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20090504

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120522

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120522

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130522

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130522

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20140522

Year of fee payment: 5

LAPS Cancellation because of no payment of annual fees