JP7023719B2 - Autonomous vehicle - Google Patents

Autonomous vehicle Download PDF

Info

Publication number
JP7023719B2
JP7023719B2 JP2018000716A JP2018000716A JP7023719B2 JP 7023719 B2 JP7023719 B2 JP 7023719B2 JP 2018000716 A JP2018000716 A JP 2018000716A JP 2018000716 A JP2018000716 A JP 2018000716A JP 7023719 B2 JP7023719 B2 JP 7023719B2
Authority
JP
Japan
Prior art keywords
traveling
main body
map data
travel
obstacle
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.)
Active
Application number
JP2018000716A
Other languages
Japanese (ja)
Other versions
JP2019121189A (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.)
Toshiba Lifestyle Products and Services Corp
Original Assignee
Toshiba Lifestyle Products and Services Corp
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 Toshiba Lifestyle Products and Services Corp filed Critical Toshiba Lifestyle Products and Services Corp
Priority to JP2018000716A priority Critical patent/JP7023719B2/en
Publication of JP2019121189A publication Critical patent/JP2019121189A/en
Application granted granted Critical
Publication of JP7023719B2 publication Critical patent/JP7023719B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

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

Description

本発明の実施形態は、本体が走行する領域を示す地図データに基づき走行する自律走行体に関する。 An embodiment of the present invention relates to an autonomous traveling body that travels based on map data indicating an area in which the main body travels.

従来、被掃除面としての床面上を自律走行しながら床面を掃除する、いわゆる自律走行型の電気掃除機(掃除ロボット)が知られている。 Conventionally, a so-called autonomous traveling type electric vacuum cleaner (cleaning robot) that cleans the floor surface while autonomously traveling on the floor surface as a surface to be cleaned is known.

このような電気掃除機において、例えば掃除したい部屋の大きさや形状、および障害物などを地図データに反映して作成(マッピング)し、この作成した地図データに基づいて設定した走行経路に沿って自律走行するものがある。 In such an electric vacuum cleaner, for example, the size and shape of the room to be cleaned, obstacles, etc. are reflected in the map data and created (mapped), and autonomously along the travel route set based on the created map data. There is something to run.

このような走行の際の走行制御としては、例えば所定方向に沿って走行し、その所定方向に対して交差(直交)する方向に走行し、さらに所定方向に沿って逆方向に走行し、その所定方向に対して交差(直交)する方向に走行し…という動作を順次繰り返す、いわゆるジグザグ走行が知られている。 As the traveling control at the time of such traveling, for example, traveling along a predetermined direction, traveling in a direction intersecting (orthogonal) with respect to the predetermined direction, and further traveling in the opposite direction along the predetermined direction, the traveling thereof is performed. So-called zigzag traveling is known in which the operation of traveling in a direction intersecting (orthogonal) with respect to a predetermined direction is sequentially repeated.

このようなジグザグ走行は、走行開始地点から実施されるため、走行方向が部屋の略四角形状の外形に対して平行な方向か垂直な方向かを判断しておらず、部屋の外形形状や障害物の配置によっては、部屋内を精度よく走行できない場合がある。 Since such zigzag running is carried out from the starting point of running, it is not determined whether the running direction is parallel to or perpendicular to the substantially square outer shape of the room, and the outer shape and obstacles of the room are not determined. Depending on the arrangement of objects, it may not be possible to drive accurately in the room.

例えば、走行方向前方に障害物を検出した場合、この障害物を含み走行方向に対して直交する方向に沿う壁面を基準として走行方向を補正するものがある。しかしながら、この構成の場合には、走行方向に対して壁面が垂直となっていることが前提となっており、走行方向が壁面に対して傾斜している場合、部屋の形状に即した好ましい走行方向を設定することが容易でない。 For example, when an obstacle is detected in front of the traveling direction, the traveling direction may be corrected with reference to a wall surface including the obstacle and along a direction orthogonal to the traveling direction. However, in the case of this configuration, it is premised that the wall surface is perpendicular to the traveling direction, and when the traveling direction is inclined with respect to the wall surface, preferable traveling according to the shape of the room. It is not easy to set the direction.

特に、自律走行型の電気掃除機の走行開始地点としては、電源部となる電池を充電する充電装置などが用いられ、この充電装置の向きを基準として走行方向が設定されることが多い。そのため、充電装置の向きや位置が、人やペットなどとの接触などの何らかの原因によって僅かに変化すると、走行方向が部屋の外形に対して傾き、走行精度が容易に低下するおそれがある。 In particular, as a traveling start point of an autonomous traveling type vacuum cleaner, a charging device for charging a battery serving as a power supply unit is used, and the traveling direction is often set with reference to the orientation of the charging device. Therefore, if the orientation or position of the charging device changes slightly due to some cause such as contact with a person or a pet, the traveling direction may be tilted with respect to the outer shape of the room, and the traveling accuracy may be easily deteriorated.

特開2007-286730号公報Japanese Unexamined Patent Publication No. 2007-286730

本発明が解決しようとする課題は、走行可能な領域を効率よく走行できるとともに、走行動作の見栄えを向上できる自律走行体を提供することである。 An object to be solved by the present invention is to provide an autonomous traveling body capable of efficiently traveling in a travelable area and improving the appearance of traveling operation.

実施形態の自律走行体は、本体と、走行駆動部と、自己位置推定手段と、記憶手段と、走行制御手段とを有する。走行駆動部は、本体を走行させる。自己位置推定手段は、自己位置を推定する。記憶手段は、互いに交差する基準方向に基づいて作成され本体が走行可能な領域を示す地図データを記憶する。走行制御手段は、走行駆動部の動作を制御することにより走行可能な領域で本体を走行させる。そして、自律走行体は、本体の走行開始位置となる基地装置を基準として、走行制御手段が走行駆動部の動作を制御して本体を地図データ中の基地装置からの距離が小さい障害物に向かって直進させ、本体が走行可能な領域の外枠を区画する障害物に到達した位置に基づき、地図データ中の位置および基準方向を補正する機能を備える。 The autonomous traveling body of the embodiment includes a main body, a traveling driving unit, a self-position estimation means, a storage means, and a traveling control means. The traveling drive unit drives the main body. The self-position estimation means estimates the self-position. The storage means stores map data that is created based on reference directions that intersect each other and indicates an area in which the main body can travel. The travel control means travels the main body in a travelable area by controlling the operation of the travel drive unit. Then, in the autonomous traveling body , the traveling control means controls the operation of the traveling drive unit based on the base device which is the traveling start position of the main body, and the main body is directed toward an obstacle whose distance from the base device in the map data is small. It has a function to correct the position in the map data and the reference direction based on the position reached by the obstacle that divides the outer frame of the area where the main body can travel .

一実施形態の自律走行体を示すブロック図である。It is a block diagram which shows the autonomous traveling body of one Embodiment. 同上自律走行体を示す斜視図である。Same as above. It is a perspective view which shows the autonomous traveling body. 同上自律走行体を下方から示す平面図である。Same as above It is a plan view which shows the autonomous traveling body from below. 同上自律走行体による物体の距離の計算方法を模式的に示す説明図である。Same as above It is explanatory drawing which shows typically the calculation method of the distance of an object by an autonomous traveling body. (a)は一方の撮像手段により撮像した画像の一例を模式的に示す説明図、(b)は他方の撮像手段により撮像した画像の一例を模式的に示す説明図、(c)は(a)および(b)の画像に基づく視差画像の一例を示す説明図である。(a) is an explanatory diagram schematically showing an example of an image captured by one imaging means, (b) is an explanatory diagram schematically showing an example of an image captured by the other imaging means, and (c) is (a). It is explanatory drawing which shows an example of the parallax image based on the image of) and (b). (a)は同上自律走行体の走行可能な領域と地図データとがずれている状態を模式的に示す説明図、(b)は同上自律走行体の走行開始位置となる基地装置が走行可能な領域に対して傾斜状に配置されている状態を模式的に示す説明図である。(a) is an explanatory diagram schematically showing a state in which the travelable area of the autonomous vehicle and the map data are deviated from each other, and (b) is a base device capable of traveling at the travel start position of the autonomous vehicle. It is explanatory drawing which shows typically the state which is arranged in an inclined shape with respect to a region. (a)は同上自律走行体が走行開始位置から走行可能な領域の外枠を区画する障害物に向かって旋回した状態を模式的に示す説明図、(b)は同上自律走行体が障害物に向かって走行した状態を模式的に示す説明図、(c)は同上自律走行体が障害物に沿って旋回した状態を模式的に示す説明図である。(a) is an explanatory diagram schematically showing a state in which the autonomous vehicle turns toward an obstacle that divides the outer frame of the area where the vehicle can travel from the travel start position, and (b) is an explanatory diagram showing the state in which the autonomous vehicle turns toward an obstacle. An explanatory diagram schematically showing a state of traveling toward the vehicle, and (c) is an explanatory diagram schematically showing a state of the autonomous traveling body turning along an obstacle. 同上自律走行体の補正後のジグザグ走行を模式的に示す説明図である。Same as above It is explanatory drawing which shows typically the zigzag running after correction of an autonomous traveling body. 同上自律走行体が走行可能な領域の外枠を区画する障害物に向かって走行する方向を模式的に示す説明図である。It is explanatory drawing which shows typically the direction which the autonomous traveling body travels toward the obstacle which divides the outer frame of the travelable area. (a)は同上自律走行体が走行開始位置の背後に位置する障害物に向かって走行する状態を模式的に示す説明図、(b)は(a)の走行中に障害物に近接した状態を示す説明図である。(A) is an explanatory diagram schematically showing a state in which the autonomous vehicle is traveling toward an obstacle located behind the travel start position, and (b) is a state in which the autonomous vehicle is close to the obstacle while traveling in (a). It is explanatory drawing which shows.

以下、一実施形態の構成を、図面を参照して説明する。 Hereinafter, the configuration of one embodiment will be described with reference to the drawings.

図1ないし図5において、11は自律走行体としての電気掃除機である。この電気掃除機11は、基地装置としての充電装置(充電台)12とともに自律走行体装置としての電気掃除装置(電気掃除システム)を構成するものである。そして、電気掃除機11は、本実施形態において、被掃除部である走行面としての床面上を自律走行(自走)しつつ床面を掃除する、いわゆる自走式のロボットクリーナ(掃除ロボット)である。 In FIGS. 1 to 5, 11 is a vacuum cleaner as an autonomous traveling body. The vacuum cleaner 11 constitutes an electric cleaning device (electric cleaning system) as an autonomous traveling body device together with a charging device (charging stand) 12 as a base device. Then, in the present embodiment, the electric vacuum cleaner 11 is a so-called self-propelled robot cleaner (cleaning robot) that cleans the floor surface while autonomously traveling (self-propelled) on the floor surface as the traveling surface which is the to be cleaned. ).

この電気掃除機11は、本体である本体ケース20を備えている。また、この電気掃除機11は、走行駆動部である駆動輪21を備えている。さらに、この電気掃除機11は、床面の塵埃を掃除する掃除部22を備えている。また、この電気掃除機11は、センサ部23を備えている。さらに、この電気掃除機11は、撮像部24を備えている。また、この電気掃除機11は、コントローラである制御手段としての制御部26を備えている。さらに、この電気掃除機11は、画像を表示する表示部を備えていてもよい。そして、この電気掃除機11は、電源部となる給電用の電池を備えていてもよい。さらに、この電気掃除機11は、外部装置や使用者との間で信号が入出力される入出力部を備えていてもよい。なお、以下、電気掃除機11(本体ケース20)の走行方向に沿った方向を前後方向(図2に示す矢印FR,RR方向)とし、この前後方向に対して交差(直交)する左右方向(両側方向)を幅方向として説明する。 The vacuum cleaner 11 includes a main body case 20 which is a main body. Further, the vacuum cleaner 11 includes a drive wheel 21 which is a traveling drive unit. Further, the vacuum cleaner 11 is provided with a cleaning unit 22 for cleaning dust on the floor surface. Further, the vacuum cleaner 11 includes a sensor unit 23. Further, the vacuum cleaner 11 includes an image pickup unit 24. Further, the vacuum cleaner 11 includes a control unit 26 as a control means which is a controller. Further, the vacuum cleaner 11 may include a display unit for displaying an image. The vacuum cleaner 11 may include a battery for power supply that serves as a power supply unit. Further, the vacuum cleaner 11 may include an input / output unit for inputting / outputting signals to / from an external device or a user. Hereinafter, the direction along the traveling direction of the electric vacuum cleaner 11 (main body case 20) is defined as the front-rear direction (arrows FR and RR directions shown in FIG. Both sides) will be described as the width direction.

本体ケース20は、例えば合成樹脂などにより形成されている。この本体ケース20は、各種装置や部品を収納可能な形状に形成されている。この本体ケース20は、例えば扁平な円柱状(円盤状)などに形成されていてもよい。また、この本体ケース20には、集塵口である吸込口31などが床面に対向する下部などに設けられていてもよい。 The main body case 20 is made of, for example, a synthetic resin. The main body case 20 is formed in a shape that can store various devices and parts. The main body case 20 may be formed in, for example, a flat columnar shape (disk shape). Further, the main body case 20 may be provided with a suction port 31 or the like, which is a dust collecting port, at a lower portion facing the floor surface.

駆動輪21は、電気掃除機11(本体ケース20)を床面上で前進方向および後退方向に走行(自律走行)させる、すなわち走行用のものである。本実施形態では、この駆動輪21は、例えば本体ケース20の左右に一対設けられている。この駆動輪21は、駆動手段としてのモータ33により駆動される。なお、この駆動輪21に代えて、走行駆動部としての無限軌道などを用いることもできる。 The drive wheel 21 causes the vacuum cleaner 11 (main body case 20) to travel (autonomously travel) in the forward direction and the backward direction (autonomous travel) on the floor surface, that is, for traveling. In this embodiment, a pair of drive wheels 21 are provided on the left and right sides of the main body case 20, for example. The drive wheel 21 is driven by a motor 33 as a drive means. In addition, instead of the drive wheel 21, an endless track or the like as a traveling drive unit can be used.

モータ33は、駆動輪21に対応して配置されている。したがって、本実施形態では、このモータ33は、例えば左右一対設けられている。そして、このモータ33は、各駆動輪21を独立して駆動させることが可能となっている。 The motor 33 is arranged corresponding to the drive wheels 21. Therefore, in this embodiment, for example, a pair of left and right motors 33 are provided. The motor 33 can independently drive each drive wheel 21.

掃除部22は、例えば床面の塵埃を除去するものである。この掃除部22は、例えば床面上の塵埃を吸込口31から集めて捕集したり、床面などを拭き掃除したりする機能を有している。この掃除部22は、吸込口31から空気とともに塵埃を吸い込む電動送風機35と、吸込口31に回転可能に取り付けられて塵埃を掻き上げる回転清掃体としての回転ブラシ36およびこの回転ブラシ36を回転駆動させるブラシモータ37と、本体ケース20の周縁部に回転可能に取り付けられて塵埃を掻き集める旋回清掃部としての補助掃除手段(補助掃除部)であるサイドブラシ38およびこのサイドブラシ38を駆動させるサイドブラシモータ39との少なくともいずれかを備えていてもよい。また、この掃除部22は、吸込口31と連通して塵埃を溜める集塵部40を備えていてもよい。 The cleaning unit 22 removes, for example, dust on the floor surface. The cleaning unit 22 has a function of collecting and collecting dust on the floor surface from the suction port 31, or wiping and cleaning the floor surface and the like. The cleaning unit 22 rotates and drives an electric blower 35 that sucks dust together with air from the suction port 31, a rotary brush 36 as a rotary cleaning body that is rotatably attached to the suction port 31 and scoops up dust, and the rotary brush 36. The brush motor 37 to be driven, the side brush 38 which is an auxiliary cleaning means (auxiliary cleaning part) as a swivel cleaning part which is rotatably attached to the peripheral edge of the main body case 20 and collects dust, and the side which drives this side brush 38. It may be equipped with at least one of the brush motor 39. Further, the cleaning unit 22 may include a dust collecting unit 40 that communicates with the suction port 31 to collect dust.

センサ部23は、電気掃除機11(本体ケース20)の走行をサポートする各種の情報をセンシングするものである。より具体的に、このセンサ部23は、例えば床面の凹凸状態(段差)や、電気掃除機11の走行の障害となる壁あるいは障害物、床面の塵埃量などをセンシングするものである。このセンサ部23は、例えば障害物検出手段としての赤外線センサあるいは超音波センサや、吸込口31から集塵部40に吸い込む塵埃量を検出する塵埃量センサ(ごみセンサ)などを備えていてもよい。赤外線センサや超音波センサは、例えば電気掃除機11(本体ケース20)の側部などと障害物となる物体との距離などを測定する距離測定手段(距離測定部)の機能を備えていてもよい。 The sensor unit 23 senses various information that supports the running of the vacuum cleaner 11 (main body case 20). More specifically, the sensor unit 23 senses, for example, an uneven state (step) on the floor surface, a wall or obstacle that hinders the running of the vacuum cleaner 11, the amount of dust on the floor surface, and the like. The sensor unit 23 may include, for example, an infrared sensor or an ultrasonic sensor as an obstacle detecting means, a dust amount sensor (dust sensor) for detecting the amount of dust sucked from the suction port 31 into the dust collecting unit 40, and the like. .. Even if the infrared sensor or ultrasonic sensor has the function of a distance measuring means (distance measuring unit) that measures the distance between the side of the vacuum cleaner 11 (main body case 20) and an object that becomes an obstacle, for example. good.

撮像部24は、撮像手段(撮像部本体)としてのカメラ51を備えている。また、この撮像部24は、検出補助手段(検出補助部)としてのランプ53を備えていてもよい。したがって、電気掃除機11は、撮像手段(撮像部本体)としてのカメラ51を備えている。また、電気掃除機11は、検出補助手段(検出補助部)としてのランプ53を備えていてもよい。 The image pickup unit 24 includes a camera 51 as an image pickup unit (imaging unit main body). Further, the image pickup unit 24 may include a lamp 53 as a detection assisting means (detection assisting unit). Therefore, the vacuum cleaner 11 includes a camera 51 as an image pickup means (imaging unit main body). Further, the vacuum cleaner 11 may include a lamp 53 as a detection assisting means (detection assisting unit).

カメラ51は、本体ケース20の走行方向である前方に向けられており、本体ケース20が載置される床面と平行な方向に対して、所定の水平画角(例えば105°など)でデジタルの画像(動画)を撮像するデジタルカメラである。このカメラ51は、単数でも複数でもよい。本実施形態では、カメラ51は、左右一対設けられている。また、これらカメラ51,51は、互いの撮像範囲(視野)が重なっている。そのため、これらカメラ51,51により撮像される画像は、その撮像領域が左右方向にラップしている。なお、カメラ51により撮像する画像は、例えば可視光領域のカラー画像や白黒画像でもよいし、赤外線画像でもよい。 The camera 51 is directed forward, which is the traveling direction of the main body case 20, and is digitally oriented at a predetermined horizontal angle of view (for example, 105 °) with respect to a direction parallel to the floor on which the main body case 20 is placed. It is a digital camera that captures the image (moving image) of. The camera 51 may be singular or plural. In this embodiment, a pair of left and right cameras 51 are provided. Further, these cameras 51 and 51 have overlapping imaging ranges (fields of view) of each other. Therefore, in the images captured by these cameras 51 and 51, the imaging region wraps in the left-right direction. The image captured by the camera 51 may be, for example, a color image or a black-and-white image in a visible light region, or an infrared image.

ランプ53は、カメラ51の撮像方向を照明することで撮像に必要となる明るさを得るものである。このランプ53は、各カメラ51に対応して設けられている。すなわち、ランプ53は、例えば一対設けられている。これらランプ53は、例えばLEDなどが用いられる。これらランプ53は、必須の構成ではない。 The lamp 53 obtains the brightness required for image pickup by illuminating the image pickup direction of the camera 51. The lamp 53 is provided corresponding to each camera 51. That is, for example, a pair of lamps 53 is provided. For these lamps 53, for example, an LED or the like is used. These lamps 53 are not mandatory configurations.

制御部26は、例えば制御手段本体(制御部本体)であるCPUやROMおよびRAMなどを備えるマイコンが用いられる。この制御部26は、駆動輪21(モータ33)を駆動させる走行制御手段である走行制御部61を備えている。また、この制御部26は、掃除部22と電気的に接続される掃除制御手段である掃除制御部62を備えている。さらに、この制御部26は、センサ部23と電気的に接続されるセンサ制御手段であるセンサ接続部63を備えている。また、この制御部26は、撮像部24と電気的に接続される検出部64を備えている。さらに、この制御部26は、自己位置推定手段である推定部65を備えている。また、この制御部26は、マッピング手段(マッピング部)である地図作成部66を備えている。さらに、この制御部26は、補正手段である補正部67を備えている。また、この制御部26は、記憶手段(記憶部)としてのメモリ68を備えている。さらに、この制御部26は、電池と電気的に接続されている。また、この制御部26は、電池の充電を制御する充電制御部を備えていてもよい。したがって、電気掃除機11は、走行制御手段である走行制御部61を備えている。また、電気掃除機11は、掃除制御手段である掃除制御部62を備えている。さらに、電気掃除機11は、センサ制御手段であるセンサ接続部63を備えている。また、電気掃除機11は、障害物検出部である検出部64を備えている。さらに、電気掃除機11は、自己位置推定手段である推定部65を備えている。また、電気掃除機11は、マッピング手段(マッピング部)である地図作成部66を備えている。さらに、電気掃除機11は、補正手段である補正部67を備えている。また、電気掃除機11は、記憶手段としてのメモリ68を備えている。さらに、電気掃除機11は、電池の充電を制御する充電制御部を備えていてもよい。 As the control unit 26, for example, a microcomputer including a CPU, a ROM, a RAM, etc., which is a control means main body (control unit main body), is used. The control unit 26 includes a travel control unit 61 which is a travel control means for driving the drive wheels 21 (motor 33). Further, the control unit 26 includes a cleaning control unit 62 which is a cleaning control means electrically connected to the cleaning unit 22. Further, the control unit 26 includes a sensor connection unit 63 which is a sensor control means electrically connected to the sensor unit 23. Further, the control unit 26 includes a detection unit 64 that is electrically connected to the image pickup unit 24. Further, the control unit 26 includes an estimation unit 65 which is a self-position estimation means. Further, the control unit 26 includes a map creation unit 66 which is a mapping means (mapping unit). Further, the control unit 26 includes a correction unit 67 which is a correction means. Further, the control unit 26 includes a memory 68 as a storage means (storage unit). Further, the control unit 26 is electrically connected to the battery. Further, the control unit 26 may include a charge control unit that controls charging of the battery. Therefore, the vacuum cleaner 11 includes a travel control unit 61 which is a travel control means. Further, the vacuum cleaner 11 includes a cleaning control unit 62 which is a cleaning control means. Further, the vacuum cleaner 11 includes a sensor connection unit 63 which is a sensor control means. Further, the vacuum cleaner 11 includes a detection unit 64 which is an obstacle detection unit. Further, the vacuum cleaner 11 includes an estimation unit 65 which is a self-position estimation means. Further, the vacuum cleaner 11 includes a map creating unit 66 which is a mapping means (mapping unit). Further, the vacuum cleaner 11 includes a correction unit 67 which is a correction means. Further, the vacuum cleaner 11 includes a memory 68 as a storage means. Further, the vacuum cleaner 11 may include a charge control unit that controls the charge of the battery.

走行制御部61は、モータ33の駆動を制御する、すなわち、モータ33に流れる電流の大きさおよび向きを制御することにより、モータ33を正転、あるいは逆転させることで、モータ33の駆動を制御し、モータ33の駆動を制御することで駆動輪21の駆動を制御するものである。この走行制御部61は、電気掃除機11が配置されて走行可能な領域である走行領域を示す(走行領域に対応する)地図データに基づいて走行経路を設定し、駆動輪21(モータ33)の駆動を制御することで、この走行経路に沿って本体ケース20(電気掃除機11)を走行領域で自律走行させる走行モードを備えている。この走行制御部61により設定する走行経路としては、地図データ中の走行可能(掃除可能)な領域(障害物や段差などの走行不能な領域を除く領域)を最短の走行距離で走行できる経路、例えば電気掃除機11(本体ケース20)が可能な限り直進する(方向転換が最も少ない)経路、障害物となる物体への接触が少ない経路、あるいは、同じ箇所を重複して走行する回数が最小となる経路など、効率的に走行(掃除)を行うことができるように設定される。すなわち、走行制御部61は、走行済み(掃除済み)領域を避けて走行経路を設定することができる。なお、本実施形態において、電気掃除機11が走行可能な領域は実質的に掃除部22による掃除対象となる領域であるから、走行領域は掃除対象領域と同一となっている。 The travel control unit 61 controls the drive of the motor 33, that is, controls the drive of the motor 33 by rotating the motor 33 forward or reverse by controlling the magnitude and direction of the current flowing through the motor 33. However, the drive of the drive wheel 21 is controlled by controlling the drive of the motor 33. The travel control unit 61 sets a travel route based on map data (corresponding to the travel area) indicating a travel area in which the vacuum cleaner 11 is arranged and can travel, and the drive wheel 21 (motor 33). By controlling the drive of the vehicle, the main body case 20 (vacuum cleaner 11) is autonomously driven in the traveling area along this traveling path. The travel route set by the travel control unit 61 is a route that can travel in the shortest travel distance in the travelable (cleanable) area (the area excluding the non-travelable area such as an obstacle or a step) in the map data. For example, the vacuum cleaner 11 (main body case 20) goes straight as much as possible (the least turn), the route with less contact with obstacles, or the minimum number of times the same place is duplicated. It is set so that it can run (clean) efficiently, such as the route that becomes. That is, the travel control unit 61 can set the travel route while avoiding the traveled (cleaned) region. In the present embodiment, since the area where the vacuum cleaner 11 can travel is substantially the area to be cleaned by the cleaning unit 22, the traveling area is the same as the area to be cleaned.

例えば、上記の走行モードとしては、走行領域をジグザグ状の走行パターンを繰り返す走行経路に沿って自律走行するジグザグ走行モードとしてもよい。ここで、ジグザグ状の自律走行(ジグザグ走行)とは、走行領域において所定の一方向に平行な方向に沿って往復走行を繰り返しながら一方向と交差(直交)する他方向に順次進んで走行領域(掃除対象領域)を塗り潰すように自律走行することをいう。すなわち、ジグザグ状の自律走行とは、走行領域において所定の方向に往復を繰り返しながら、この所定の方向と交差(直交)する方向に向かって進んでいく走行動作をいう。より詳細に、ジグザグ状の自律走行とは、所定の一方向に沿って走行し、その方向に対して交差(直交)する他方向に走行し、所定の一方向に沿って反対方向に走行し、その方向に対して交差(直交)する他方向に走行し、…という走行を順次繰り返す、いわば矩形波状の走行経路に沿って走行する走行動作をいう。なお、走行制御部61は、ジグザグ走行モードの他に、その他の走行経路を設定する走行モードを別途備えていてもよい。 For example, the above-mentioned traveling mode may be a zigzag traveling mode in which the traveling area is autonomously traveled along a traveling path that repeats a zigzag-shaped traveling pattern. Here, the zigzag-shaped autonomous traveling (zigzag traveling) is a traveling region in which the traveling region sequentially advances in another direction intersecting (orthogonal) with one direction while repeating reciprocating traveling along a direction parallel to a predetermined direction. It means to drive autonomously so as to fill the (cleaning target area). That is, the zigzag-shaped autonomous traveling means a traveling operation in which the vehicle travels in a direction intersecting (orthogonal) with the predetermined direction while repeating reciprocating in a predetermined direction in the traveling region. More specifically, zigzag autonomous driving means traveling along a predetermined direction, traveling in another direction intersecting (orthogonal) with respect to that direction, and traveling in the opposite direction along a predetermined direction. , Traveling in another direction that intersects (orthogonally) with respect to that direction, and repeats the traveling in sequence, so to speak, a traveling operation that travels along a rectangular wavy traveling path. In addition to the zigzag traveling mode, the traveling control unit 61 may separately provide a traveling mode for setting other traveling routes.

掃除制御部62は、掃除部22の動作を制御するものである。本実施形態において、この掃除制御部62は、電動送風機35、ブラシモータ37およびサイドブラシモータ39の駆動を制御する、すなわち、電動送風機35、ブラシモータ37、および、サイドブラシモータ39の通電量をそれぞれ別個に制御することで、これら電動送風機35、ブラシモータ37(回転ブラシ36)、および、サイドブラシモータ39(サイドブラシ38)の駆動を制御する。 The cleaning control unit 62 controls the operation of the cleaning unit 22. In the present embodiment, the cleaning control unit 62 controls the drive of the electric blower 35, the brush motor 37, and the side brush motor 39, that is, the energization amount of the electric blower 35, the brush motor 37, and the side brush motor 39. By controlling each separately, the drive of these electric blowers 35, the brush motor 37 (rotary brush 36), and the side brush motor 39 (side brush 38) is controlled.

センサ接続部63は、センサ部23による検出結果を取得するものである。 The sensor connection unit 63 acquires the detection result by the sensor unit 23.

検出部64は、カメラ51により撮像された画像中から特徴点などを抽出することにより、本体ケース20の周囲に位置する物体(電気掃除機11の走行の障害となる障害物など)の形状(物体の距離、高さおよび幅など)を検出するように構成されている。換言すれば、この検出部64は、カメラ51により撮像された画像に基づいて本体ケース20からの距離を算出した物体が障害物であるかどうかを判定するように構成されている。 The detection unit 64 extracts feature points and the like from the image captured by the camera 51 to form an object (such as an obstacle that hinders the running of the vacuum cleaner 11) located around the main body case 20 (such as an obstacle). It is configured to detect the distance, height and width of an object). In other words, the detection unit 64 is configured to determine whether or not the object whose distance from the main body case 20 is calculated based on the image captured by the camera 51 is an obstacle.

図4を参照して、カメラ51,51から周囲の物体までの距離を検出する技術の概要を説明する。まず、左右一対で設けられた2つのカメラ51,51のうち一方の撮像画像G1において、距離検出の対象となる物体Oで位置が一意に定まる特徴点SP(角部など)を複数抽出する。この撮像画像G1を撮影したカメラ51から焦点距離fだけ離れた位置に撮像座標平面を設定すると、三次元の座標空間では、カメラ51の中心と撮像座標平面上の各特徴点とを結んだ延長線上に物体Oの特徴点SPが存在するはずである。同様のことを2つのカメラ51,51のうち他方の撮像画像G2を用いて行えば、こちらの撮像座標平面上の各特徴点を結んだ延長線上にも物体Oの特徴点SPが存在するはずである。したがって、物体Oの特徴点SPの三次元座標空間における座標は、2つの撮像座標平面それぞれを通過する延長線上の交わる位置として一意に定めることができる。さらに、2つのカメラ51,51間の距離lに基づくことで、カメラ51,51から物体Oの各特徴点SPまでの実際の空間における距離を取得することができる。このような処理を撮像範囲全体で行うことで、カメラから周囲の物体までの距離情報を撮像画像に付加した距離画像(いわゆる視差画像)を得ることができる。 With reference to FIG. 4, the outline of the technique for detecting the distance from the cameras 51 and 51 to the surrounding objects will be described. First, in the captured image G1 of one of the two cameras 51 and 51 provided in a pair of left and right, a plurality of feature point SPs (corners and the like) whose positions are uniquely determined by the object O to be detected for distance are extracted. When the imaging coordinate plane is set at a position separated by the focal length f from the camera 51 that captured the captured image G1, in the three-dimensional coordinate space, the extension connecting the center of the camera 51 and each feature point on the imaging coordinate plane. There should be a feature point SP of the object O on the line. If the same thing is done using the captured image G2 of the other of the two cameras 51 and 51, the feature point SP of the object O should exist on the extension line connecting the feature points on this imaging coordinate plane. Is. Therefore, the coordinates of the feature point SP of the object O in the three-dimensional coordinate space can be uniquely determined as the intersecting position on the extension line passing through each of the two imaging coordinate planes. Further, based on the distance l between the two cameras 51 and 51, the distance in the actual space from the cameras 51 and 51 to each feature point SP of the object O can be obtained. By performing such processing over the entire imaging range, it is possible to obtain a distance image (so-called parallax image) in which distance information from the camera to surrounding objects is added to the captured image.

図5は、一方のカメラ51による撮像画像G1(図5(a))と、他方のカメラ51による撮像画像G2(図5(b))とに基づいて、距離画像GL(図5(c))を生成した例を示している。図5(c)に例示する距離画像GLでは、明度が高いほど(紙面では白いほど)カメラ51からの距離が近いことを示している。例えばこの距離画像GLの下部は全幅に亘って白くなっており、また下部ほど白さが増して、カメラ51からの距離が近くなっていることから、電気掃除機11が置かれた床面であることが分かる。また、距離画像GL中、全体が同じくらいの白さで所定形状のものは1つの物体として検出することができ、図示する例では物体Oである。上述したように、カメラ51,51から物体Oまでの距離は取得されているので、距離画像GL中の幅W、高さHに基づき、物体Oの実際の幅、高さを知ることもできる。このような情報に加えてカメラ51,51の撮像方向や電気掃除機11の進行方向を考慮すれば、物体Oが電気掃除機11の走行の障害となる障害物か否かを判断することも可能となる。 FIG. 5 shows a distance image GL (FIG. 5 (c)) based on the image G1 captured by one camera 51 (FIG. 5 (a)) and the image captured by the other camera 51 (FIG. 5 (b)). ) Is generated. In the distance image GL illustrated in FIG. 5 (c), the higher the brightness (the whiter the paper), the closer the distance from the camera 51 is. For example, the lower part of this distance image GL is white over the entire width, and the lower part is whiter and the distance from the camera 51 is closer, so on the floor where the vacuum cleaner 11 is placed. It turns out that there is. Further, in the distance image GL, an object having the same whiteness as a whole and having a predetermined shape can be detected as one object, and in the illustrated example, it is an object O. As described above, since the distances from the cameras 51 and 51 to the object O have been acquired, it is possible to know the actual width and height of the object O based on the width W and the height H in the distance image GL. .. In addition to such information, if the imaging directions of the cameras 51 and 51 and the traveling direction of the vacuum cleaner 11 are taken into consideration, it is possible to determine whether the object O is an obstacle that hinders the running of the vacuum cleaner 11. It will be possible.

このように、この検出部64は、例えばカメラ51により所定の画像範囲(例えば本体ケース20の幅および高さに対応して設定された画像範囲)中に撮像されている物体の距離を、予め設定された、あるいは可変設定された閾値である設定距離と比較し、この設定距離以下の距離(電気掃除機11(本体ケース20)からの距離)に位置する物体を障害物であると判定するように構成されている。したがって、この検出部64は、カメラ51により撮像された画像に基づいて本体ケース20からの距離を算出した物体が障害物であるかどうかを判定する障害物判定部の機能を備えている。 As described above, the detection unit 64 previously determines the distance of an object imaged in a predetermined image range (for example, an image range set corresponding to the width and height of the main body case 20) by the camera 51. Compared with the set distance, which is a set or variable threshold, an object located at a distance less than or equal to this set distance (distance from the vacuum cleaner 11 (main body case 20)) is determined to be an obstacle. It is configured as follows. Therefore, the detection unit 64 has a function of an obstacle determination unit that determines whether or not the object whose distance from the main body case 20 is calculated based on the image captured by the camera 51 is an obstacle.

なお、この検出部64は、例えばカメラ51により撮像された生画像のレンズの歪み補正やノイズの除去、コントラスト調整、および画像中心の一致化などの一次画像処理をする画像補正機能を備えていてもよい。また、この検出部64は、カメラ51やランプ53の駆動を制御する撮像制御部の機能を備えていてもよい。 The detection unit 64 has an image correction function for performing primary image processing such as lens distortion correction, noise removal, contrast adjustment, and image center matching of a raw image captured by the camera 51, for example. May be good. Further, the detection unit 64 may have a function of an image pickup control unit that controls the drive of the camera 51 and the lamp 53.

推定部65は、検出部64により検出された本体ケース20の周囲の形状(障害物となる物体の距離および高さ)に基づき走行領域における電気掃除機11の自己位置を推定するものである。具体的に、この推定部65は、カメラ51により撮像した画像中の物体の特徴点の三次元座標に基づき、走行領域における電気掃除機11の自己位置を推定する。 The estimation unit 65 estimates the self-position of the vacuum cleaner 11 in the traveling region based on the shape (distance and height of the object that becomes an obstacle) around the main body case 20 detected by the detection unit 64. Specifically, the estimation unit 65 estimates the self-position of the vacuum cleaner 11 in the traveling region based on the three-dimensional coordinates of the feature points of the object in the image captured by the camera 51.

地図作成部66は、カメラ51により撮像された画像に基づいて検出部64により検出された本体ケース20の周囲の形状(障害物となる物体の距離および高さ)に基づき、走行可能な走行領域を示す地図(マップ)データを作成(マッピング)するものである。具体的に、この地図作成部66は、カメラ51により撮像された画像中の物体の特徴点の三次元座標に基づき、検出部64により検出された走行領域内に位置する物体(障害物)などの位置関係および高さを記す地図を作成する。換言すれば、この地図作成部66は、検出部64により判定された物体(障害物)の形状、位置関係および高さを反映した地図データを作成する。この地図データは、例えば所定の座標系(例えば直交座標系)上に作成される。より詳細に、この地図データは、例えばこの座標系に基づき設定されるメッシュを基本単位として作成される。したがって、この地図データには、この座標系を構成する、互いに交差(直交)する基準方向が設定され、この基準方向に基づいて地図データが作成される。この地図作成部66により作成した地図データは、メモリ68に記憶することができる。なお、この地図作成部66は、すでに作成した地図データ中の障害物などの形状や配置と検出部64により検出された周囲の形状や配置とが一致しない場合には、地図データを適宜補正することができる。 The map creating unit 66 is a travelable area based on the shape around the main body case 20 (distance and height of an obstacle object) detected by the detection unit 64 based on the image captured by the camera 51. It creates (maps) map data that indicates the above. Specifically, the map creation unit 66 is an object (obstacle) located in the traveling region detected by the detection unit 64 based on the three-dimensional coordinates of the feature points of the object in the image captured by the camera 51. Create a map showing the positional relationship and height of the camera. In other words, the map creation unit 66 creates map data that reflects the shape, positional relationship, and height of the object (obstacle) determined by the detection unit 64. This map data is created, for example, on a predetermined coordinate system (for example, an orthogonal coordinate system). More specifically, this map data is created, for example, using a mesh set based on this coordinate system as a basic unit. Therefore, in this map data, reference directions that intersect (orthogonally) with each other that constitute this coordinate system are set, and map data is created based on this reference direction. The map data created by the map creation unit 66 can be stored in the memory 68. If the shape and arrangement of obstacles and the like in the already created map data do not match the surrounding shape and arrangement detected by the detection unit 64, the map creation unit 66 appropriately corrects the map data. be able to.

そして、これら推定部65および地図作成部66は、一体に構成されていてもよい。また、これらの処理は、例えばそれぞれカメラ51により撮像した同一の画像データに基づいて実行されてもよい。これらの処理は、電気掃除機11が走行している間、継続的に実行されてもよい。 The estimation unit 65 and the mapping unit 66 may be integrally configured. Further, these processes may be executed based on the same image data captured by the camera 51, for example. These processes may be performed continuously while the vacuum cleaner 11 is running.

補正部67は、メモリ68に記憶された地図データと実際の走行領域との方向や位置がずれている場合に、地図データの向きや位置を補正するものである。この補正部67による具体的な補正は後述する。 The correction unit 67 corrects the direction and position of the map data when the direction and position of the map data stored in the memory 68 and the actual traveling area deviate from each other. The specific correction by the correction unit 67 will be described later.

メモリ68は、例えばフラッシュメモリなどの不揮発性のものが用いられる。このメモリ68には、地図作成部66により作成された地図データとともに、この地図データにおける走行済み(掃除済み)領域が記憶される。 As the memory 68, a non-volatile memory such as a flash memory is used. In this memory 68, along with the map data created by the map creation unit 66, the traveled (cleaned) area in this map data is stored.

入出力部は、図示しないリモコンなどの外部装置から送信される制御コマンドや、本体ケース20に設けられたスイッチ、あるいはタッチパネルなどの入力手段から入力される制御コマンドを取得するとともに、例えば充電装置12などに対して信号を送信するものである。 The input / output unit acquires control commands transmitted from an external device such as a remote controller (not shown), a switch provided on the main body case 20, or a control command input from an input means such as a touch panel, and also obtains, for example, a charging device 12. It sends a signal to such as.

電池は、掃除部22、センサ部23、撮像部24、および、制御部26などに給電するものである。この電池としては、本実施形態において、例えば充電可能な二次電池が用いられる。このため、本実施形態では、例えば本体ケース20の底部に、電池を充電するための充電端子71が露出して配置されている。 The battery supplies power to the cleaning unit 22, the sensor unit 23, the image pickup unit 24, the control unit 26, and the like. As this battery, for example, a rechargeable secondary battery is used in the present embodiment. Therefore, in the present embodiment, for example, the charging terminal 71 for charging the battery is exposed and arranged on the bottom of the main body case 20.

充電装置12は、電気掃除機11が走行(掃除)を終了したときに帰還する基地部となっている。したがって、この充電装置12は、例えばこの電気掃除機11の走行(掃除)開始位置となっている。この充電装置12は、例えば定電流回路などの充電回路を内蔵していてもよい。また、この充電装置12には、電池の充電用の充電用端子73が設けられている。この充電用端子73は、充電回路と電気的に接続されている。そして、この充電用端子73は、充電装置12に帰還した電気掃除機11の充電端子71と機械的および電気的に接続されるようになっている。 The charging device 12 is a base unit that returns when the vacuum cleaner 11 finishes running (cleaning). Therefore, the charging device 12 is, for example, a running (cleaning) start position of the vacuum cleaner 11. The charging device 12 may include a charging circuit such as a constant current circuit. Further, the charging device 12 is provided with a charging terminal 73 for charging the battery. The charging terminal 73 is electrically connected to the charging circuit. The charging terminal 73 is mechanically and electrically connected to the charging terminal 71 of the vacuum cleaner 11 that has returned to the charging device 12.

次に、上記一実施形態の動作を説明する。 Next, the operation of the above embodiment will be described.

まず、電気掃除機11による掃除の開始から終了までの概略を説明する。電気掃除機11は、掃除を開始すると、メモリ68に記憶された地図データに基づいて走行しつつ床面を掃除し、地図データを随時更新していく。そして、掃除が終了すると、電気掃除機11は、例えば充電装置12へと帰還した後、電池の充電作業に移行する。 First, an outline from the start to the end of cleaning by the vacuum cleaner 11 will be described. When the vacuum cleaner 11 starts cleaning, it cleans the floor surface while traveling based on the map data stored in the memory 68, and updates the map data as needed. Then, when the cleaning is completed, the vacuum cleaner 11 returns to, for example, the charging device 12, and then shifts to the battery charging operation.

上記の制御をより具体的に説明すると、電気掃除機11は、例えば予め設定された掃除開始時刻となったときや、リモコンまたは外部装置によって送信された掃除開始の制御コマンドを入出力部によって受信したときなどのタイミングで、制御部26が走行モードに切り換わり、掃除を開始する。このとき、メモリ68に走行領域の地図データが記憶されていない場合には、所定の動作を行ってカメラ51、検出部64、およびセンサ部23などによって電気掃除機11(本体ケース20)の周囲の障害物などを検出することで地図作成部66により地図データを作成することもできるし、外部から地図データを入力または読み込むこともできる。 More specifically, the vacuum cleaner 11 receives, for example, a cleaning start control command transmitted by a remote controller or an external device by the input / output unit when the cleaning start time is set in advance. At such a timing, the control unit 26 switches to the traveling mode and starts cleaning. At this time, if the map data of the traveling area is not stored in the memory 68, the camera 51, the detection unit 64, the sensor unit 23, etc. perform a predetermined operation to surround the electric vacuum cleaner 11 (main body case 20). Map data can be created by the map creation unit 66 by detecting obstacles and the like, and map data can be input or read from the outside.

次いで、地図データに基づき、走行制御部61が走行経路を作成する。例えば、本実施形態では、電気掃除機11(本体ケース20)が走行領域をジグザグ状に走行する走行経路(以下、ジグザグ走行)とする。 Next, the travel control unit 61 creates a travel route based on the map data. For example, in the present embodiment, the vacuum cleaner 11 (main body case 20) is set as a traveling path (hereinafter referred to as zigzag traveling) in which the traveling area is traveled in a zigzag shape.

そして、走行制御部61が駆動輪21(モータ33)を制御することで本体ケース20を設定した走行経路に沿って自律走行させつつ、掃除制御部62が掃除部22を動作させて走行領域(掃除対象領域)の床面を掃除する(掃除モード)。掃除部22では、例えば掃除制御部62により駆動された電動送風機35、ブラシモータ37(回転ブラシ36)、あるいはサイドブラシモータ39(サイドブラシ38)により床面の塵埃を、吸込口31を介して集塵部40へと捕集する。また、電気掃除機11は、自律走行の際、センサ部23や検出部64により地図に記されていない走行領域内の障害物などの物体を検出すると、その物体の三次元座標を取得して地図作成部66が地図データに反映させ、メモリ68に記憶していく。 Then, the traveling control unit 61 controls the drive wheels 21 (motor 33) to autonomously drive the main body case 20 along the set traveling path, while the cleaning control unit 62 operates the cleaning unit 22 to operate the traveling area (travel area (motor 33). Clean the floor surface of the area to be cleaned (cleaning mode). In the cleaning unit 22, dust on the floor surface is collected through the suction port 31 by, for example, an electric blower 35 driven by the cleaning control unit 62, a brush motor 37 (rotary brush 36), or a side brush motor 39 (side brush 38). Collect to the dust collection unit 40. Further, when the electric vacuum cleaner 11 detects an object such as an obstacle in the traveling area not shown on the map by the sensor unit 23 or the detection unit 64 during autonomous traveling, the electric vacuum cleaner 11 acquires the three-dimensional coordinates of the object. The map creation unit 66 reflects the map data and stores it in the memory 68.

この電気掃除機11(本体ケース20)の走行(掃除)時、走行領域の長手方向や幅方向(短手方向)を基準としてジグザグ走行することで走行領域内を短距離、短時間で効率よく走行(掃除)できる。このとき、電気掃除機11は、走行開始位置となる充電装置12が走行領域の外枠を区画する障害物(外壁)に対して平行(略平行も含む)に配置されていることを前提として、この充電装置12に対して垂直(略垂直も含む)な方向とその方向に対して交差(直交)する方向とを基準としてジグザグ走行する。そのため、仮に地図データの基準方向と実際の走行領域の前後左右方向との向きのずれや地図データと実際の走行領域との位置のずれがある場合、ジグザグ走行の品位が損なわれる可能性がある。 When the electric vacuum cleaner 11 (main body case 20) is running (cleaning), it runs in a zigzag manner with reference to the longitudinal direction and the width direction (short direction) of the traveling area, so that the traveling area can be efficiently traveled in a short distance in a short time. Can run (clean). At this time, it is premised that the electric vacuum cleaner 11 is arranged parallel (including substantially parallel) to the obstacle (outer wall) that divides the outer frame of the traveling area of the charging device 12 which is the traveling start position. , The vehicle travels in a zigzag manner with reference to a direction perpendicular to the charging device 12 (including substantially vertical) and a direction intersecting (orthogonal) with the direction. Therefore, if there is a deviation between the reference direction of the map data and the front-back and left-right directions of the actual traveling area, or if there is a deviation between the map data and the actual traveling area, the quality of zigzag driving may be impaired. ..

例えば、図6(a)に示すように、充電装置12の位置や向きが何らかの原因で変化してメモリ68に記憶している地図データMDと実際の走行領域CAとの向きや位置が変化して地図データMDの基準方向(図中のx方向およびy方向)に対して実際の走行領域CAの前後左右方向が傾斜している場合、あるいは、図6(b)に示すように、充電装置12が走行領域の外枠を区画する障害物(外壁)Wに対して非平行、すなわちこの障害物Wに対して斜めに配置されている場合などが挙げられる。これらの場合、上記のように充電装置12の位置や角度を基準としてジグザグ走行すると、走行制御部61により設定された走行経路の途中で予期しない障害物に衝突したり、実際の走行領域の外枠まで到達しないうちに走行方向を変化させたりすることが発生し(例えば図6(a)の矢印に示す)、余分な回避動作や場所によって走行距離が異なり走行制御が複雑になる(例えば図6(b)の矢印に示す)など、ジグザグ走行の品位が低下する可能性がある。 For example, as shown in FIG. 6A, the position and orientation of the charging device 12 changes for some reason, and the orientation and position of the map data MD stored in the memory 68 and the actual traveling area CA change. When the front-back and left-right directions of the actual traveling area CA are inclined with respect to the reference direction (x-direction and y-direction in the figure) of the map data MD, or as shown in FIG. 6 (b), the charging device. There is a case where 12 is not parallel to the obstacle (outer wall) W that divides the outer frame of the traveling area, that is, is arranged diagonally to the obstacle W. In these cases, if the vehicle travels in a zigzag manner based on the position and angle of the charging device 12 as described above, it may collide with an unexpected obstacle in the middle of the traveling route set by the traveling control unit 61, or may be outside the actual traveling area. It may happen that the traveling direction is changed before reaching the frame (for example, shown by the arrow in Fig. 6 (a)), and the traveling distance differs depending on the extra avoidance operation and location, and the traveling control becomes complicated (for example, Fig. 6). There is a possibility that the quality of zigzag running will deteriorate, such as (shown by the arrow in 6 (b)).

そこで、本実施形態の電気掃除機11は、上記のようなずれを補正する機能を有する。 Therefore, the vacuum cleaner 11 of the present embodiment has a function of correcting the deviation as described above.

例えば、図6(a)に示すように、地図データMDの基準方向(図中のx方向およびy方向)に対して実際の走行領域CAの前後左右方向が傾斜している場合には、走行領域CAの外枠を区画する障害物(外壁)ROBを利用して電気掃除機11(本体ケース20)の走行方向を補正する。すなわち、本実施形態では走行領域CAの外枠を区画する障害物(外壁)ROBに対して所定の関係を有する方向、例えば走行領域CAの外枠を区画する障害物(外壁)ROBに対して平行(略平行を含む)な方向、または垂直(略垂直を含む)な方向に対して電気掃除機11(本体ケース20)の走行方向を合わせるように補正する。 For example, as shown in FIG. 6A, when the actual traveling area CA is inclined in the front-rear and left-right directions with respect to the reference direction (x direction and y direction in the figure) of the map data MD, the vehicle travels. The traveling direction of the electric vacuum cleaner 11 (main body case 20) is corrected by using the obstacle (outer wall) ROB that divides the outer frame of the area CA. That is, in the present embodiment, with respect to the direction having a predetermined relationship with the obstacle (outer wall) ROB that divides the outer frame of the traveling area CA, for example, with respect to the obstacle (outer wall) ROB that divides the outer frame of the traveling area CA. Correction is made so that the traveling direction of the electric vacuum cleaner 11 (main body case 20) is aligned with the parallel (including substantially parallel) direction or the vertical (including substantially vertical) direction.

概略として、電気掃除機11(本体ケース20)は、走行開始位置(充電装置12の位置)に近接して位置する障害物ROBに向かって走行し、その障害物ROBに対して所定距離以下(衝突も含む)の位置(以下、障害物ROBに対して所定距離以下となった状態を「障害物ROBに到達した」という)から障害物ROBに対して平行(略平行を含む)、または垂直(略垂直を含む)方向に走行方向を沿わせるように旋回動作することで、走行方向を補正する。このとき、補正部67では、メモリ68に記憶された地図データMDの角度、および、位置の少なくともいずれかを補正する。具体的に、補正部67は、本体ケース20(電気掃除機11)の向きを基準として、この向きとメモリ68に記憶された地図データMDのいずれかの基準方向との角度差に対応する角度、この基準方向を補正する。また、補正部67は、本体ケース20(電気掃除機11)が走行領域CAの外枠を区画する障害物ROBに到達した位置を基準として、この位置に対応するメモリ68に記憶された地図データMD中の位置との差分、この地図データMDの位置を補正する。そして、走行制御部61は、この補正された地図データMDに基づいて走行経路を設定し、電気掃除機11(本体ケース20)をジグザグ走行させるように駆動輪21(モータ33)の動作を制御する。 As a general rule, the electric vacuum cleaner 11 (main body case 20) travels toward an obstacle ROB located close to the traveling start position (position of the charging device 12), and is less than or equal to a predetermined distance (with respect to the obstacle ROB). Parallel (including substantially parallel) or perpendicular to the obstacle ROB from the position (including the collision) (hereinafter, the state where the distance is less than or equal to the predetermined distance to the obstacle ROB is referred to as "reaching the obstacle ROB"). The traveling direction is corrected by turning so as to follow the traveling direction (including substantially vertical). At this time, the correction unit 67 corrects at least one of the angle and the position of the map data MD stored in the memory 68. Specifically, the correction unit 67 uses the orientation of the main body case 20 (electric vacuum cleaner 11) as a reference, and the angle corresponding to the angle difference between this orientation and one of the reference directions of the map data MD stored in the memory 68. , Correct this reference direction. Further, the correction unit 67 uses the position where the main body case 20 (vacuum cleaner 11) reaches the obstacle ROB that divides the outer frame of the traveling area CA as a reference, and the map data stored in the memory 68 corresponding to this position. The difference from the position in MD and the position of this map data MD are corrected. Then, the travel control unit 61 sets a travel route based on the corrected map data MD, and controls the operation of the drive wheels 21 (motor 33) so that the vacuum cleaner 11 (main body case 20) travels in a zigzag manner. do.

より詳細に、まず、電気掃除機11は、走行制御部61が駆動輪21(モータ33)の動作を制御して、地図データMD中の仮想的な障害物(外壁)IOBに対して電気掃除機11(本体ケース20)の走行方向が垂直(略垂直も含む)に向くように旋回(その場旋回)し(図7(a))、その後、走行領域CAに実在する障害物(外壁)ROBに到達するまで直進する(図7(b))。すなわち、地図データMD中の障害物IOBに向かうように電気掃除機11(本体ケース20)を走行させることで、走行領域CA中の障害物ROBに対して到達させる。このとき、例えば、地図データMDを利用して、走行開始位置(充電装置12の位置)から基準方向のいずれか(例えばx方向)に目標とする障害物ROB以外の障害物がないことを確認した上で、走行する向き(+x方向または-x方向)を選択してもよい。そして、障害物ROBに対して到達した電気掃除機11は、例えばセンサ部23の赤外線センサや超音波センサにより検出した本体ケース20の側部と障害物との距離などを利用し、走行制御部61が駆動輪21(モータ33)の動作を制御して、障害物ROBに対して走行方向が平行(略平行も含む)となるように旋回(その場旋回)する(図7(c))。この結果、旋回することで補正された電気掃除機11(本体ケース20)の走行方向の向きがジグザグ走行の走行開始方向となるため、補正部67では、その向きと、地図データMDのいずれかの基準方向(例えばy方向)との差分θを計算し、その差分θを補正情報として、地図データMDに反映する(地図データMDの基準方向を補正する)。そして、この補正された地図データMDに基づき走行制御部61がジグザグ走行を実施するように走行経路を設定して駆動輪21(モータ33)の動作を制御する。これにより、走行開始位置(充電装置12の位置)が、他の走行領域に移設されるなどでない限り、すなわち同一の走行領域CA内で地図データMDに示される位置とは異なる位置に移設されたとしても、図8に示すように、ジグザグ走行を実際の走行領域CAに沿って正確に実施できる。 More specifically, first, in the vacuum cleaner 11, the traveling control unit 61 controls the operation of the drive wheel 21 (motor 33) to electrically clean the virtual obstacle (outer wall) IOB in the map data MD. Turn (turn in place) so that the traveling direction of the machine 11 (main body case 20) faces vertical (including substantially vertical) (Fig. 7 (a)), and then an obstacle (outer wall) that actually exists in the traveling area CA. Go straight until you reach ROB (Fig. 7 (b)). That is, by running the vacuum cleaner 11 (main body case 20) toward the obstacle IOB in the map data MD, the vacuum cleaner 11 (main body case 20) is made to reach the obstacle ROB in the traveling area CA. At this time, for example, using the map data MD, it is confirmed that there is no obstacle other than the target obstacle ROB in any of the reference directions (for example, the x direction) from the running start position (position of the charging device 12). Then, the traveling direction (+ x direction or −x direction) may be selected. Then, the electric vacuum cleaner 11 that has reached the obstacle ROB uses, for example, the distance between the obstacle and the side of the main body case 20 detected by the infrared sensor or the ultrasonic sensor of the sensor unit 23, and is a traveling control unit. The 61 controls the operation of the drive wheel 21 (motor 33) to turn (turn in place) so that the traveling direction is parallel (including substantially parallel) to the obstacle ROB (FIG. 7 (c)). .. As a result, the direction of the traveling direction of the electric vacuum cleaner 11 (main body case 20) corrected by turning becomes the traveling start direction of the zigzag traveling. Therefore, in the correction unit 67, either the direction or the map data MD is used. The difference θ from the reference direction (for example, the y direction) of is calculated, and the difference θ is reflected in the map data MD as correction information (corrects the reference direction of the map data MD). Then, based on the corrected map data MD, the travel control unit 61 sets a travel route so as to perform zigzag travel, and controls the operation of the drive wheel 21 (motor 33). As a result, unless the traveling start position (position of the charging device 12) is relocated to another traveling area, that is, the traveling area CA is relocated to a position different from the position shown in the map data MD. Even so, as shown in FIG. 8, the zigzag running can be accurately carried out along the actual running area CA.

また、例えば図7(b)において、走行領域CAに実在する障害物(外壁)ROBに対して到達するまでの走行距離が、地図データMD上で障害物IOBに対して想定された距離と乖離している場合、すなわち障害物ROBと障害物IOBとの位置がずれている場合には、補正部67がその差分も補正情報として、地図データMDに反映する(地図データMDの位置を補正する)ことで、充電装置12の位置が変更された場合に対応可能となる。 Further, for example, in FIG. 7B, the mileage until reaching the obstacle (outer wall) ROB existing in the traveling area CA deviates from the distance assumed for the obstacle IOB on the map data MD. If this is the case, that is, if the positions of the obstacle ROB and the obstacle IOB are misaligned, the correction unit 67 also reflects the difference as correction information in the map data MD (corrects the position of the map data MD). ) This makes it possible to respond when the position of the charging device 12 is changed.

なお、上記の制御において補正部67が走行領域CAに実在する障害物(外壁)ROBに向かって走行する際には、センサ部23の赤外線センサや超音波センサにより検出した本体ケース20と障害物との距離などを利用し、走行方向を判断してもよい。 In the above control, when the correction unit 67 travels toward the obstacle (outer wall) ROB that actually exists in the traveling area CA, the main body case 20 and the obstacle detected by the infrared sensor or the ultrasonic sensor of the sensor unit 23 The traveling direction may be determined by using the distance to and the like.

また、例えば図6(b)に示すように、充電装置12が走行領域の外枠を区画する障害物(外壁)ROBに対して非平行、すなわちこの障害物ROBに対して斜めに配置されている場合など、実際の走行領域CAと地図データMDとが一致しているものの、走行開始位置となる充電装置12が傾斜して配置されている場合には、地図データMD中の走行領域CAの外枠を区画する障害物IOB、または、実際の走行領域CAの外枠を区画する障害物ROBを利用し、走行開始位置(充電装置12の位置)に対して最短距離に位置する障害物IOBまたは障害物ROBに向かって走行し、上記図6(a)の場合と同様に補正動作を行うことで、同様に対応できる。 Further, for example, as shown in FIG. 6B, the charging device 12 is arranged non-parallel to the obstacle (outer wall) ROB that divides the outer frame of the traveling region, that is, diagonally to the obstacle ROB. If the actual travel area CA and the map data MD match, but the charging device 12 that is the travel start position is tilted, the travel area CA in the map data MD Using the obstacle IOB that divides the outer frame or the obstacle ROB that divides the outer frame of the actual travel area CA, the obstacle IOB located at the shortest distance to the travel start position (position of the charging device 12) Alternatively, the same can be achieved by traveling toward the obstacle ROB and performing the correction operation in the same manner as in the case of FIG. 6A.

このように、上記一実施形態によれば、走行領域CAの外枠を区画する障害物ROBに沿う方向と地図データMDの基準方向とのいずれかに対して所定の関係を有する方向と本体ケース20(電気掃除機11)の走行方向とを相対的に合わせるように補正する。この結果、例えば走行制御部61が本体ケース20(電気掃除機11)をジグザグ走行させる場合には、走行領域CAを区画する障害物(外壁)ROBに対して平行(略平行も含む)、または垂直(略垂直も含む)な方向に沿って往復走行を繰り返すことが可能になるため、ジグザグ走行においては走行効率への寄与が大きい、方向転換のための旋回時に生じる角度や距離の誤差を抑制でき、走行領域CA内を短距離、短時間で効率よく走行(掃除)できる。 As described above, according to the above embodiment, the direction having a predetermined relationship with either the direction along the obstacle ROB that divides the outer frame of the traveling area CA and the reference direction of the map data MD and the main body case. Correct so that it is relatively aligned with the traveling direction of 20 (vacuum cleaner 11). As a result, for example, when the traveling control unit 61 runs the main body case 20 (electric vacuum cleaner 11) in a zigzag manner, it is parallel (including substantially parallel) to the obstacle (outer wall) ROB that divides the traveling area CA. Since it is possible to repeat reciprocating running along a vertical direction (including almost vertical), it greatly contributes to running efficiency in zigzag running, and suppresses angle and distance errors that occur when turning for direction change. It is possible to travel (clean) efficiently in a short distance and in a short time in the traveling area CA.

しかも、走行制御部61が本体ケース20(電気掃除機11)をジグザグ走行させる場合には、走行領域CAの縦横方向に沿って、より賢く、動きとしても綺麗に走行領域CAを走行(掃除)させることができ、走行動作の見栄えを向上できるとともに、走行領域CAを隅々まで余すところなく走行させやすくなり、掃除部22による掃除残しも抑制できる。 Moreover, when the traveling control unit 61 makes the main body case 20 (vacuum cleaner 11) run in a zigzag manner, it travels (cleans) the traveling area CA more wisely and neatly as a movement along the vertical and horizontal directions of the traveling area CA. It is possible to improve the appearance of the traveling operation, it becomes easy to drive the traveling area CA to every corner, and the cleaning residue by the cleaning unit 22 can be suppressed.

また、走行制御部61が、走行領域CAの外枠を区画する障害物ROBと地図データMDの基準方向とのいずれかに対して所定の関係を有する方向に本体ケース20(電気掃除機11)の走行方向を合わせるように補正し、その方向を本体ケース20(電気掃除機11)の走行開始方向とすることで、走行制御部61が本体ケース20(電気掃除機11)を例えばジグザグ走行させる際に、本体ケース20(電気掃除機11)の向きを変えたりすることなく、そのまま効率よくジグザグ走行を開始できる。 Further, the main body case 20 (vacuum cleaner 11) has a direction in which the traveling control unit 61 has a predetermined relationship with any one of the obstacle ROB that divides the outer frame of the traveling area CA and the reference direction of the map data MD. By correcting to match the traveling direction of the main body case 20 and setting that direction as the traveling start direction of the main body case 20 (vacuum cleaner 11), the traveling control unit 61 causes the main body case 20 (vacuum cleaner 11) to travel in a zigzag manner, for example. At that time, the zigzag running can be started efficiently as it is without changing the direction of the main body case 20 (vacuum cleaner 11).

さらに、本体ケース20(電気掃除機11)が走行領域CAの外枠を区画する障害物ROBに到達した際に補正を実施することで、地図データMDの向きや位置、電気掃除機11の自己位置を実際の障害物ROBに合わせて適切に補正できる。 Furthermore, by performing correction when the main body case 20 (vacuum cleaner 11) reaches the obstacle ROB that divides the outer frame of the traveling area CA, the orientation and position of the map data MD and the self of the vacuum cleaner 11 The position can be properly corrected according to the actual obstacle ROB.

このとき、走行制御部61が、走行開始時に、駆動輪21(モータ33)の動作を制御して本体ケース20(電気掃除機11)を走行開始位置に近接した走行領域CAの外枠を区画する障害物ROBに向かって走行させることで、本体ケース20(電気掃除機11)を走行領域CAの外枠を区画する障害物ROBに効率よく、かつ、精度よく到達させることができ、上記の補正をより確実に実施できる。 At this time, the travel control unit 61 controls the operation of the drive wheels 21 (motor 33) at the start of travel to partition the main body case 20 (vacuum cleaner 11) into the outer frame of the travel region CA close to the travel start position. By traveling toward the obstacle ROB, the main body case 20 (vacuum cleaner 11) can be efficiently and accurately reached the obstacle ROB that divides the outer frame of the traveling area CA. The correction can be performed more reliably.

しかも、地図データMD中の仮想的な障害物IOBの位置を利用して障害物ROBに到達させることができるので、地図データMDが実際の走行領域CAに対してずれていても、地図データMDに基づいて障害物IOBに向かって本体ケース20(電気掃除機11)を走行させることにより、走行領域CAを闇雲に走行させる場合と比較して、他の障害物などに衝突したりすることなく、電気掃除機11を障害物ROBに到達させる確率を向上できる。 Moreover, since the position of the virtual obstacle IOB in the map data MD can be used to reach the obstacle ROB, even if the map data MD deviates from the actual traveling area CA, the map data MD By driving the main body case 20 (vacuum cleaner 11) toward the obstacle IOB based on the above, the traveling area CA does not collide with other obstacles as compared with the case of traveling in the dark clouds. , The probability that the vacuum cleaner 11 will reach the obstacle ROB can be improved.

そして、走行制御部61が、本体ケース20(電気掃除機11)の走行領域の外枠を区画する障害物に到達した位置で駆動輪21(モータ33)の動作を制御して本体ケース20(電気掃除機11)を障害物に対して垂直な方向と平行な方向とのいずれかに走行方向を向けるように旋回させることでこの走行方向を補正することにより、走行制御部61により本体ケース20(電気掃除機11)をジグザグ走行させる際の走行方向を精度よく設定できる。 Then, the traveling control unit 61 controls the operation of the drive wheel 21 (motor 33) at a position where the traveling control unit 61 reaches an obstacle that divides the outer frame of the traveling region of the main body case 20 (vacuum cleaner 11), and controls the operation of the main body case 20 (motor 33). The main body case 20 is corrected by the traveling control unit 61 by turning the vacuum cleaner 11) so that the traveling direction is directed to either the direction perpendicular to the obstacle or the direction parallel to the obstacle. The traveling direction when the (vacuum cleaner 11) is driven in a zigzag manner can be set accurately.

また、補正部67が、本体ケース20(電気掃除機11)の向きを基準として、この向きとメモリ68に記憶された地図データのいずれかの基準方向との角度の差分θに対応する角度、この基準方向を補正することで、メモリ68に記憶された地図データと実際の走行領域CAとの向きが異なっている場合にそれらを合わせることができる。 Further, the correction unit 67 uses the orientation of the main body case 20 (electric vacuum cleaner 11) as a reference, and the angle corresponding to the difference θ between this orientation and the reference direction of any of the map data stored in the memory 68. By correcting this reference direction, if the directions of the map data stored in the memory 68 and the actual traveling area CA are different, they can be matched.

さらに、補正部67が、本体ケース20(電気掃除機11)が走行領域の外枠を区画する障害物に到達した位置を基準として、この位置に対応するメモリ68に記憶された地図データ中の位置との差分、この地図データの位置を補正することで、メモリ68に記憶された地図データと実際の走行領域CAとの位置が異なっている場合にそれらを合わせることができる。 Further, the correction unit 67 is in the map data stored in the memory 68 corresponding to this position based on the position where the main body case 20 (electric vacuum cleaner 11) reaches the obstacle that divides the outer frame of the traveling area. By correcting the difference from the position and the position of this map data, it is possible to match them when the positions of the map data stored in the memory 68 and the actual traveling area CA are different.

したがって、これら補正部67による補正によって、走行制御部61が電気掃除機11(本体ケース20)を走行させる際に、補正された地図データに基づき走行経路を実際の走行領域CAに合わせて適切に設定できる。 Therefore, due to the correction by these correction units 67, when the travel control unit 61 travels the vacuum cleaner 11 (main body case 20), the travel route is appropriately adjusted to the actual travel area CA based on the corrected map data. Can be set.

また、走行制御部61が、本体ケース20(電気掃除機11)の走行開始時に、駆動輪21(モータ33)の動作を制御してこの本体ケース20(電気掃除機11)を所定の一方向へと直進させることで、障害物ROBに到達するようにすることで、充電装置12が斜めに置かれた場合にも誤った外壁を検出するリスクを低減できる。 Further, the travel control unit 61 controls the operation of the drive wheels 21 (motor 33) at the start of travel of the main body case 20 (vacuum cleaner 11) to move the main body case 20 (vacuum cleaner 11) in a predetermined direction. By making it reach the obstacle ROB by going straight to, the risk of detecting an erroneous outer wall even when the charging device 12 is placed at an angle can be reduced.

このとき、走行制御部61が、駆動論21(モータ33)の動作を制御して、図9に示すように、本体ケース20(電気掃除機11)を地図データMDのいずれかの基準方向(例えばx方向)においてこの地図データMD中の障害物IOBとの距離が小さい方向へと直進させることで、距離が大きい方向へと直進させる場合と比較して、目標とする走行領域CAの外枠を区画する障害物ROBに本体ケース20(電気掃除機11)を接近させる際に他の障害物を誤って検出(他の障害物に誤って衝突)しにくくできる。したがって、走行領域CAの外枠を区画する障害物ROBへとより到達しやすくできる。 At this time, the traveling control unit 61 controls the operation of the drive theory 21 (motor 33), and as shown in FIG. 9, the main body case 20 (vacuum cleaner 11) is set to one of the reference directions of the map data MD ( For example, in the x direction), by going straight in the direction where the distance from the obstacle IOB in this map data MD is small, the outer frame of the target traveling area CA is compared with the case where the distance is going straight in the direction where the distance is large. When the main body case 20 (vacuum cleaner 11) is brought close to the obstacle ROB that divides the space, it is possible to prevent accidental detection of other obstacles (accidental collision with other obstacles). Therefore, it is possible to more easily reach the obstacle ROB that divides the outer frame of the traveling area CA.

なお、例えば充電装置12に対して地図データMDの基準方向(例えばx方向)側に位置する障害物ROBを利用して補正を実施するのに代えて、例えば図10(a)の矢印に示すように、走行領域CAに実在する障害物(外壁)ROBに到達する際に、椅子や机の脚などの他の障害物に衝突することを避けるために、走行開始位置となる充電装置12の背後に位置する外形である障害物ROB側に走行させ、この障害物ROBを利用して補正を実施してもよい。すなわち、充電装置12の位置を利用して、走行領域CA中の障害物ROBに到達させてもよい。 In addition, for example, instead of performing correction using the obstacle ROB located on the reference direction (for example, x direction) side of the map data MD with respect to the charging device 12, for example, it is shown by the arrow in FIG. 10 (a). In order to avoid colliding with other obstacles such as chairs and desk legs when reaching the obstacle (outer wall) ROB that actually exists in the traveling area CA, the charging device 12 that is the traveling start position The vehicle may be driven to the obstacle ROB side, which is an outer shape located behind, and correction may be performed using this obstacle ROB. That is, the position of the charging device 12 may be used to reach the obstacle ROB in the traveling area CA.

この場合には、まず、電気掃除機11は、走行制御部61が駆動輪21(モータ33)の動作を制御して、電気掃除機11(本体ケース20)の走行方向が充電装置12から離れる方向に対して垂直(略垂直も含む)に向くように旋回(その場旋回)し、その方向(例えばx方向)に所定距離(例えば数10cm程度)直進した後、さらに充電装置12側に(例えば90°)旋回して走行方向を変え、直進する。すなわち、電気掃除機11(本体ケース20)を充電装置12に沿って、この充電装置12を迂回してこの充電装置12の背後に向かうようにL字状に走行する。充電装置12は、通常走行領域CAの外枠を区画する外壁沿いに設置されている可能性が高いことから、この方法を用いることにより、短時間で、かつ、他の障害物に衝突しにくい走行経路で、走行領域CAを区画する外枠となる障害物ROBに対して効率よく到達可能となる。 In this case, first, in the vacuum cleaner 11, the travel control unit 61 controls the operation of the drive wheel 21 (motor 33), and the travel direction of the vacuum cleaner 11 (main body case 20) is separated from the charging device 12. Turn (turn in place) so as to be perpendicular to the direction (including substantially vertical), go straight in that direction (for example, in the x direction) for a predetermined distance (for example, about several tens of cm), and then move further to the charging device 12 side (for example, about several tens of centimeters). For example, turn 90 °) to change the traveling direction and go straight. That is, the vacuum cleaner 11 (main body case 20) travels along the charging device 12 in an L-shape so as to bypass the charging device 12 and head toward the back of the charging device 12. Since the charging device 12 is likely to be installed along the outer wall that divides the outer frame of the normal traveling area CA, by using this method, it is difficult to collide with other obstacles in a short time. It is possible to efficiently reach the obstacle ROB, which is the outer frame that divides the traveling area CA, on the traveling route.

また、図10(b)に示すように、走行制御部61が駆動輪21(モータ33)の動作を制御して、電気掃除機11(本体ケース20)の走行方向が充電装置12から離れる方向に対して垂直(略垂直も含む)に向くように旋回(その場旋回)し、その方向(例えばx方向)に所定距離直進したときに障害物ROBに到達した場合、すなわち目標とする充電装置12の背後に位置する障害物ROBに向かって走行している途中で地図データMDの基準方向(x方向)に沿って数10cm程度の走行距離で障害物ROBに到達した場合には、この障害物ROBが走行領域CAの外枠を区画する障害物ROBである可能性が高いので、この障害物ROBを利用して補正を行うことで、より短時間で補正を実施できる。 Further, as shown in FIG. 10B, the travel control unit 61 controls the operation of the drive wheel 21 (motor 33) so that the travel direction of the vacuum cleaner 11 (main body case 20) is away from the charging device 12. When the obstacle ROB is reached when turning (turning in place) so as to face perpendicular to (including substantially vertical) and going straight for a predetermined distance in that direction (for example, x direction), that is, the target charging device. If the obstacle ROB is reached within a mileage of several tens of centimeters along the reference direction (x direction) of the map data MD while traveling toward the obstacle ROB located behind 12, this obstacle Since there is a high possibility that the object ROB is an obstacle ROB that divides the outer frame of the traveling area CA, the correction can be performed in a shorter time by performing the correction using this obstacle ROB.

さらに、電気掃除機11(本体ケース20)のジグザグ走行における走行開始方向は、地図データの縦横比に基づき決定するようにしてもよい。この場合には、例えば地図データの縦横比から、相対的に長い方向、すなわち地図データの長手方向を走行開始方向とすることで、例えば相対的に短い方向、すなわち地図データの短手方向を走行開始方向とする場合と比較して、ジグザグ走行の方向転換時の旋回の回数を低減でき、走行領域を短時間で効率よく走行(掃除)できるとともに、ジグザグ走行の動作の見栄えを向上できる。 Further, the traveling start direction in the zigzag traveling of the vacuum cleaner 11 (main body case 20) may be determined based on the aspect ratio of the map data. In this case, for example, from the aspect ratio of the map data, a relatively long direction, that is, a longitudinal direction of the map data is set as the traveling start direction, so that the traveling is performed in a relatively short direction, that is, a short direction of the map data. Compared with the case where the starting direction is set, the number of turns at the time of changing the direction of the zigzag running can be reduced, the running area can be efficiently run (cleaned) in a short time, and the appearance of the zigzag running operation can be improved.

また、障害物ROBに到達した位置によっては、補正動作として障害物ROBに対して平行(略平行も含む)となるように旋回する、いわゆる壁平行スピンではなく、障害物ROBに対して垂直(略垂直)となるように旋回する、壁垂直スピンを用い、その方向をジグザグ走行の走行開始方向としてもよい。 Also, depending on the position where the obstacle ROB is reached, it is not a so-called wall parallel spin that turns so as to be parallel to the obstacle ROB (including substantially parallel) as a correction operation, but is perpendicular to the obstacle ROB ( A wall vertical spin that turns so as to be substantially vertical) may be used, and that direction may be set as the running start direction of zigzag running.

また、上記各実施形態において、ジグザグ走行中、走行領域CAの外枠を区画する障害物ROBに電気掃除機11(本体ケース20)が到達した際に補正の要否を逐次確認し、必要に応じて補正動作をしてもよい。この場合には、仮に何らかの原因で推定した電気掃除機11の自己位置の向きの精度が悪化してしまった場合でも、自己推定の誤差をキャンセルすることができる。 Further, in each of the above embodiments, when the vacuum cleaner 11 (main body case 20) reaches the obstacle ROB that divides the outer frame of the traveling area CA during zigzag traveling, the necessity of correction is sequentially confirmed and necessary. A correction operation may be performed accordingly. In this case, even if the accuracy of the self-position orientation of the vacuum cleaner 11 estimated for some reason deteriorates, the self-estimation error can be canceled.

さらに、例えば初回の走行時など、電気掃除機11のメモリ68にまだ地図データが記憶されていない場合には、実際の障害物ROBを基準として地図データの基準方向を設定し、この基準方向に基づき地図作成部66によって地図データを作成することもできる。例えば、この場合には、走行領域CAの外壁である可能性が高い、充電装置12に沿ってこの充電装置12の背後に位置する障害物ROBに向かって走行し、この障害物ROBに対して平行(略平行も含む)な方向、または垂直(略垂直も含む)な方向が走行方向となるように上記の補正動作を行うことで、地図データの基準方向を設定することが可能になる。したがって、地図データの基準方向と実際の走行領域の縦横方向とのずれが生じにくくなるとともに、充電装置12は一般的に障害物ROBの近傍に配置されていることから、地図データの基準方向を短時間で設定できる。 Furthermore, if the map data is not yet stored in the memory 68 of the vacuum cleaner 11, for example, during the first run, the reference direction of the map data is set with reference to the actual obstacle ROB, and the reference direction is set to this reference direction. Based on this, the map creation unit 66 can also create map data. For example, in this case, travel along the charging device 12, which is likely to be the outer wall of the traveling area CA, toward the obstacle ROB located behind the charging device 12, and against this obstacle ROB. By performing the above correction operation so that the parallel (including substantially parallel) direction or the vertical (including substantially vertical) direction is the traveling direction, it is possible to set the reference direction of the map data. Therefore, the deviation between the reference direction of the map data and the vertical and horizontal directions of the actual traveling area is less likely to occur, and since the charging device 12 is generally arranged near the obstacle ROB, the reference direction of the map data is set. It can be set in a short time.

なお、上記一実施形態において、走行領域CA(地図データMD)は、説明を明確にするために、単なる四角形状としたが、障害物が様々に配置された走行領域や、四角形状でない走行領域であっても、同様の処理によって対応できる。 In the above embodiment, the traveling area CA (map data MD) is simply a square shape for the sake of clarity, but a traveling area in which various obstacles are arranged or a traveling area that is not a square shape. However, it can be dealt with by the same processing.

さらに、補正部67は、地図データの補正の際に、充電装置12の位置や向きを固定し地図データ全体を補正するようにしたが、例えば地図データ全体を固定し、充電装置12の位置や向きを補正するようにしてもよい。 Further, when correcting the map data, the correction unit 67 fixes the position and orientation of the charging device 12 to correct the entire map data. For example, the correction unit 67 fixes the entire map data and determines the position and orientation of the charging device 12. The orientation may be corrected.

また、例えば地図データと実際の走行領域とが一時的にずれているのみの場合を考慮し、補正部67により地図データを補正せずに、走行制御部61により設定する走行経路の走行方向のみを補正してもよい。 Further, for example, in consideration of the case where the map data and the actual traveling area are only temporarily deviated from each other, only the traveling direction of the traveling route set by the traveling control unit 61 is not corrected by the correction unit 67. May be corrected.

そして、自律走行体として自走式の電気掃除機11を例に挙げて説明したが、例えば掃除部22を備えない、いわゆる見守りロボットなどの自律走行体でもよい。 The self-propelled electric vacuum cleaner 11 has been described as an example of the autonomous traveling body, but for example, an autonomous traveling body such as a so-called watching robot that does not have a cleaning unit 22 may be used.

本発明のいくつかの実施形態を説明したが、これらの実施形態は、例として提示したものであり、発明の範囲を限定することは意図していない。これら新規な実施形態は、その他の様々な形態で実施されることが可能であり、発明の要旨を逸脱しない範囲で、種々の省略、置き換え、変更を行うことができる。これら実施形態やその変形は、発明の範囲や要旨に含まれるとともに、特許請求の範囲に記載された発明とその均等の範囲に含まれる。 Although some embodiments of the present invention have been described, these embodiments are presented as examples and are not intended to limit the scope of the invention. These novel embodiments can be implemented in various other embodiments, and various omissions, replacements, and changes can be made without departing from the gist of the invention. These embodiments and variations thereof are included in the scope and gist of the invention, and are also included in the scope of the invention described in the claims and the equivalent scope thereof.

11 自律走行体としての電気掃除機
12 基地装置としての充電装置
20 本体である本体ケース
21 走行駆動部である駆動輪
61 走行制御手段である走行制御部
65 自己位置推定手段である推定部
66 マッピング手段である地図作成
68 記憶手段としてのメモリ
11 Vacuum cleaner as an autonomous vehicle
12 Charging device as a base device
20 Main body case
21 Drive wheels that are the driving drive unit
61 Travel control unit, which is a travel control means
65 Estimator, which is a self-position estimation means
66 Cartography unit , which is a mapping method
68 Memory as a means of storage

Claims (7)

本体と、
この本体を走行させる走行駆動部と、
自己位置を推定する自己位置推定手段と、
互いに交差する基準方向に基づいて作成され前記本体が走行可能な領域を示す地図データを記憶する記憶手段と、
前記走行駆動部の動作を制御することにより前記走行可能な領域で前記本体を走行させる走行制御手段とを具備し、
前記本体の走行開始位置となる基地装置から、前記走行制御手段が前記走行駆動部の動作を制御して前記本体を前記地図データ中の前記基地装置からの距離が小さい障害物に向かって直進させ、前記基地装置の位置を基準として前記本体が走行可能な領域の外枠を区画する障害物に到達した位置に基づき前記地図データ中の位置および基準方向を補正する機能を備えた
ことを特徴とした自律走行体。
With the main body
The traveling drive unit that drives this main body and
Self-position estimation means for estimating self-position and
A storage means for storing map data created based on reference directions intersecting with each other and indicating an area in which the main body can travel, and a storage means.
It is provided with a travel control means for traveling the main body in the travelable area by controlling the operation of the travel drive unit.
From the base device that is the travel start position of the main body, the travel control means controls the operation of the travel drive unit to cause the main body to go straight toward an obstacle having a small distance from the base device in the map data. It is characterized by having a function of correcting the position and the reference direction in the map data based on the position reached by the obstacle that divides the outer frame of the area where the main body can travel with reference to the position of the base device. Autonomous vehicle.
走行制御手段は、走行可能な領域の外枠を区画する障害物に対して所定の関係を有する方向に対して本体の走行方向を合わせるように補正し、その方向を前記本体の走行開始方向とする
ことを特徴とした請求項1記載の自律走行体
The travel control means corrects the traveling direction of the main body to match the traveling direction of the main body with respect to the direction having a predetermined relationship with the obstacle that divides the outer frame of the travelable area, and the direction is set to the traveling start direction of the main body. The autonomous vehicle according to claim 1, wherein the autonomous vehicle is characterized by the above .
走行制御手段は、本体の走行開始時に、走行駆動部の動作を制御してこの本体を地図データにて基地装置の背後に位置する外形側へと走行させる
ことを特徴とした請求項1または2記載の自律走行体
Claim 1 or 2 characterized in that the travel control means controls the operation of the travel drive unit at the start of travel of the main body and causes the main body to travel to the outer shape side located behind the base device by map data. The described autonomous vehicle .
走行制御手段は、本体の走行開始時に、走行駆動部の動作を制御してこの本体を地図データのいずれかの基準方向においてこの地図データ中の障害物との距離が小さい方向へと直進させる
ことを特徴とした請求項1ないし3いずれか一記載の自律走行体。
The travel control means controls the operation of the travel drive unit at the start of travel of the main body to make the main body go straight in one of the reference directions of the map data in the direction in which the distance from the obstacle in the map data is small. The autonomous vehicle according to any one of claims 1 to 3 , wherein the autonomous vehicle is characterized by the above.
走行制御手段は、地図データの外形の縦横比に基づきこの地図データの長手方向を本体の走行開始方向とするように補正する
ことを特徴とした請求項1ないしいずれか一記載の自律走行体。
The autonomous traveling body according to any one of claims 1 to 4 , wherein the traveling control means corrects the longitudinal direction of the map data to be the traveling start direction of the main body based on the aspect ratio of the outer shape of the map data. ..
本体が地図データの外形に対応する位置に到達する度に補正の要否を判断する機能を備えた
ことを特徴とした請求項1ないしいずれか一記載の自律走行体。
The autonomous vehicle according to any one of claims 1 to 5 , characterized in that it has a function of determining whether or not correction is necessary each time the main body reaches a position corresponding to the outer shape of the map data.
地装置に沿った走行可能な領域の外枠を区画する障害物に対して平行な方向と垂直な方向とを基準方向として前記本体が走行可能な領域を示す地図データを作成するマッピング手段を備えた
ことを特徴とした請求項1ないしいずれか一記載の自律走行体。
A mapping means for creating map data indicating an area in which the main body can travel, with a direction parallel to an obstacle and a direction perpendicular to an obstacle that divides the outer frame of the travelable area along the base device as a reference direction. The autonomous vehicle according to any one of claims 1 to 6 , characterized in that it is provided.
JP2018000716A 2018-01-05 2018-01-05 Autonomous vehicle Active JP7023719B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2018000716A JP7023719B2 (en) 2018-01-05 2018-01-05 Autonomous vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2018000716A JP7023719B2 (en) 2018-01-05 2018-01-05 Autonomous vehicle

Publications (2)

Publication Number Publication Date
JP2019121189A JP2019121189A (en) 2019-07-22
JP7023719B2 true JP7023719B2 (en) 2022-02-22

Family

ID=67307292

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018000716A Active JP7023719B2 (en) 2018-01-05 2018-01-05 Autonomous vehicle

Country Status (1)

Country Link
JP (1) JP7023719B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115177178A (en) * 2021-04-06 2022-10-14 美智纵横科技有限责任公司 Cleaning method, cleaning device and computer storage medium

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004139265A (en) 2002-10-16 2004-05-13 Toshiba Tec Corp Autonomous traveling robot
JP2004139266A (en) 2002-10-16 2004-05-13 Toshiba Tec Corp Autonomous traveling robot
JP2005346477A (en) 2004-06-03 2005-12-15 Toshiba Tec Corp Autonomous travelling body

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09114523A (en) * 1995-10-13 1997-05-02 Shizukou Kk Autonomously traveling vehicle and driving method for the vehicle
JP2006039682A (en) * 2004-07-22 2006-02-09 Toshiba Tec Corp Autonomous travel robot

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004139265A (en) 2002-10-16 2004-05-13 Toshiba Tec Corp Autonomous traveling robot
JP2004139266A (en) 2002-10-16 2004-05-13 Toshiba Tec Corp Autonomous traveling robot
JP2005346477A (en) 2004-06-03 2005-12-15 Toshiba Tec Corp Autonomous travelling body

Also Published As

Publication number Publication date
JP2019121189A (en) 2019-07-22

Similar Documents

Publication Publication Date Title
WO2018087952A1 (en) Electric vacuum cleaner
CN109843139B (en) Electric vacuum cleaner
KR101524020B1 (en) Method for gradually building map by mobile robot and correcting position of mobile robot
CN110325938B (en) Electric vacuum cleaner
KR101840158B1 (en) Electric vacuum cleaner
CN111405862B (en) Electric vacuum cleaner
JP6864433B2 (en) Vacuum cleaner
JP7141220B2 (en) self-propelled vacuum cleaner
KR102003787B1 (en) Electrical vacuum cleaner
CN110650667B (en) Electric vacuum cleaner
JP6331971B2 (en) Self-propelled vacuum cleaner
CN110325089B (en) Electric vacuum cleaner
JP6912937B2 (en) Vacuum cleaner
JP7023719B2 (en) Autonomous vehicle
JP2010172441A (en) Self-propelling type vacuum cleaner
JP6969994B2 (en) Vacuum cleaner
JP7014586B2 (en) Autonomous vehicle
WO2020059292A1 (en) Autonomous traveling cleaner
JP2010167055A (en) Self-travelling vacuum cleaner
JP2014219824A (en) Mobile robot system

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20201012

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20210630

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20210714

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210910

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20220209

R150 Certificate of patent or registration of utility model

Ref document number: 7023719

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150