TWI634403B - 自動清潔機及其控制方法 - Google Patents
自動清潔機及其控制方法 Download PDFInfo
- Publication number
- TWI634403B TWI634403B TW106110983A TW106110983A TWI634403B TW I634403 B TWI634403 B TW I634403B TW 106110983 A TW106110983 A TW 106110983A TW 106110983 A TW106110983 A TW 106110983A TW I634403 B TWI634403 B TW I634403B
- Authority
- TW
- Taiwan
- Prior art keywords
- cleaning machine
- automatic cleaning
- angle
- walking
- distances
- Prior art date
Links
- 238000004140 cleaning Methods 0.000 title claims abstract description 238
- 238000000034 method Methods 0.000 title claims description 45
- 238000012937 correction Methods 0.000 claims description 44
- 238000004364 calculation method Methods 0.000 claims description 9
- 238000012417 linear regression Methods 0.000 claims description 7
- 230000008569 process Effects 0.000 claims description 4
- 238000010586 diagram Methods 0.000 description 11
- 239000000428 dust Substances 0.000 description 5
- 238000003384 imaging method Methods 0.000 description 4
- 230000010354 integration Effects 0.000 description 4
- 238000009825 accumulation Methods 0.000 description 3
- 235000006679 Mentha X verticillata Nutrition 0.000 description 2
- 235000002899 Mentha suaveolens Nutrition 0.000 description 2
- 235000001636 Mentha x rotundifolia Nutrition 0.000 description 2
- 241001417527 Pempheridae Species 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 241000755666 Neato Species 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 239000004744 fabric Substances 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000011086 high cleaning Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000010408 sweeping Methods 0.000 description 1
- 230000001052 transient effect Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Classifications
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
- A47L11/4011—Regulation of the cleaning machine by electric means; Control systems and remote control systems therefor
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/24—Floor-sweeping machines, motor-driven
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L9/00—Details or accessories of suction cleaners, e.g. mechanical means for controlling the suction or for effecting pulsating action; Storing devices specially adapted to suction cleaners or parts thereof; Carrying-vehicles specially adapted for suction cleaners
- A47L9/28—Installation of the electric equipment, e.g. adaptation or attachment to the suction cleaner; Controlling suction cleaners by electric means
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
- A47L11/4061—Steering means; Means for avoiding obstacles; Details related to the place where the driver is accommodated
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
- A47L11/4063—Driving means; Transmission means therefor
- A47L11/4066—Propulsion of the whole machine
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0219—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0259—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0272—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising means for registering the travel distance, e.g. revolutions of wheels
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L2201/00—Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L2201/00—Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
- A47L2201/04—Automatic control of the travelling movement; Automatic obstacle detection
Abstract
一種自動清潔機其距離感測器用以在多個相異的時間點t,測量自動清潔機與一牆面間的多個間距Y(t)。其控制模組用以在該些相異時間點t,計算出行走裝置的多個行走距離X(t)。根據該些間距Y(t)及該些行走距離X(t),求得自動清潔機的行走方向與牆面之延伸方向間的一偏差角度A。
Description
本發明係關於一種自動清潔機及其控制方法,尤其關於一種利用一牆面校正路徑的自動清潔機及其控制方法。
習知的清潔機器人1,在清掃室內地板時,以一演算法來進行路徑的規劃,為了減少沒有被清掃或擦拭的區域,較佳地規劃出弓字型(Zigzag)路徑。例如,美國專利號US 7515991B2亦提出一種弓字型路徑的規劃方法。圖1顯示習知清潔機器人所規劃之預定路徑的示意圖。如圖1所示,要清掃的房間30由具有4個壁面區間21、22、23、24的壁面20圍成。在房間30內放置著椅子、沙發等的障礙物31、32。將清潔機器人1放置在房間30內的任意位置。開始時,使它認識清掃區域。更體而言,使清潔機器人1保持現在的方向前進,沿路徑201一直移動到壁面20。其次使清潔機器人1沿路徑202、203沿壁面20繞房間30行走一周。通過該行走設定清掃區域,並且建立地圖資訊,隨後再將所得到的地圖資訊記錄於控制裝置的存儲器中。
清潔機器人1在行走過程中,清潔機器人1的方位角會有誤差的產生。因此,美國專利號US 7515991B2提出一種校正方法,自動行走式清掃機存取有地圖資訊,在從存儲在地圖資訊中的“壁面”資訊,並且利用行走中記錄的記憶路徑的方位角和地圖資訊中記錄的壁面方位角,對清掃機的方位角的檢測誤差進行校正。
目前市售的一清潔機器人(LG,LrV5900)其設置有一影像感測器,取得天花板的影像並且鑑定天花板的線條,進而不間斷地計算出機器人與房間壁面間平行與垂直的座標,而避免誤差的累積。機器人再據此座標作行走“弓字型”路徑,並來回清掃。然而,影像系統需要計算能力較好的硬體,因此成本高昂。目前市售的另一清潔機器人(irobot 980),則利用影像,鑑定家具的尖點計算出機器人與房間壁面間平行與垂直的座標,但是如上述影像系統的成本高昂。
目前市售的另一清潔機器人(Neato),利用光學雷達(LIDAR)其使用一束脈衝雷射來測量目標的距離等參數,且可量測範圍高達6米(meter)。並且透過持續旋轉雷射頭,以量測周圍房間的牆壁並測繪地圖,機器人再據此地圖行走弓字型路徑來回清掃,然而光學雷達(LIDAR)成本高昂。
目前市售的另一擦地機器人(mint)採用一種北極星系統,其投射一光點到天花板,機器人機上設有一影像裝置,利用該光點可決定原點位置與機器人的座標,而避免誤差的累積。機器人再據此座標行走弓字型路徑來
回清掃,然而影像系統成本高昂。
本發明一實施例之目的在於,提供一種自動清潔機利用一牆面校正路徑的自動機器人及其控制方法。本發明一實施例之目的在於,提供一種自動清潔機其利用已測得的多個局部地圖,以更新或擴張一地圖資訊;以及其控制方法。
依據本發明一實施例,自動清潔機包含一距離感測器、一控制模組及一行走裝置。控制模組具有一陀螺儀,並且電連接距離感測器及行走裝置。行走裝置用以移動自動清潔機,藉以使自動清潔機從一第一位置移動至一第二位置。距離感測器用以在多個相異的時間點t,測量自動清潔機與一牆面間的多個間距Y(t)。控制模組用以在該些相異時間點t,計算出行走裝置的多個行走距離X(t)。在該第二位置時,根據該些間距Y(t)及該些行走距離X(t),求得自動清潔機的行走方向與牆面之延伸方向間的一偏差角度A。
於一實施例中,控制模組更對該些行走距離X(t)及該些間距Y(t),進行線性回歸取得回歸線L,並依據回歸線L求得偏差角度A。
於一實施例中,控制模組更計算出一方位角Q,並且再根據偏差角度A校正方位角Q。於一實施例中,控制模組依據一第一運算式校正方位角Q,
校正後方位角Q=校正前方位角Q-偏差角度A。於一實施例中,控制模組依據一第二運算式校正方位角Q,校正後方位角Q=校正前方位角Q-校正角度a,並且偏差角度A大於校正角度a。
於一實施例中,控制模組包含:一馬達模組及一編碼器。馬達模組連接行走裝置。編碼器電連接馬達模組,並且依據馬達模組的一操作信號,求得該些行走距離X(t),用以依據該些行走距離X(t)及方位角Q慣性導航。於一實施例中,陀螺儀用以量測的自動清潔機的角速度,然後以時間對角速度積分而得到一積分角度(iA),積分角度用以供控制模組求得方位角Q。
於一實施例中,預定角度G為360度,行走裝置用以向前行走,以使自動清潔機從第一位置移動至第二位置,且行走裝置用以向後行走,以使自動清潔機從第二位置移動至第三位置。
於一實施例中,控制模組更使自動清潔機旋轉一預定角度G後,再控制行走裝置以使自動清潔機從第二位置移動至一第三位置;於自動清潔機旋轉預定角度G後,利用距離感測器,在多個相異的時間點t,求得自動清潔機與牆面間的多個間距Y1(t);於自動清潔機旋轉預定角度G後,在該些相異時間點t,計算出行走裝置的多個行走距離X1(t);在第三位置時,根據該些間距Y1(t)及該些行走距離X1(t),求得自動清潔機的行走方向與牆面之延伸方向間的一偏差角度A1;並且根據偏差角度A及偏差角度A1來校正陀螺儀的常數K。
依據本發明一實施例,自動清潔機的控制方法,適用於一自動清潔機,自動清潔機包含一距離感測器、具有一陀螺儀的一控制模組及一行走裝置。該控制方法包含以下步驟。使自動清潔機從一第一位置移動至一第二位置。利用距離感測器在多個相異的時間點t,求得自動清潔機與一牆面間的多個間距Y(t)。在該些相異時間點t,計算出行走裝置的多個行走距離X(t)。在第二位置時,根據該些間距Y(t)及該些行走距離X(t),求得自動清潔機的行走方向與牆面之延伸方向間的一偏差角度A。
於一實施例中,該求得該偏差角度A的步驟包含:對該些行走距離X(t)及該些間距Y(t),進行線性回歸取得回歸線L,並依據回歸線L求得偏差角度A。
於一實施例中,利用控制模組用以計算出一方位角Q,並且再利用控制模組根據偏差角度A校正方位角Q。於一實施例中,該根據該偏差角度A校正該方位角Q的步驟包含:依據一運算式校正方位角Q,該運算式為校正後方位角Q=校正前方位角Q-校正角度a,並且偏差角度A大於校正角度a。
於一實施例中,該根據偏差角度A校正方位角Q的步驟包含以下步驟。判斷是否為第一次校正。若是第一次校正,依據一第一運算式校正方位角Q,該第一運算式為校正後方位角Q=校正前方位角Q-偏差角度A。判斷偏差角度A是否小於一臨界值Th。若不是第一次校正且偏差角度A小於一
臨界值Th,依據一第二運算式校正方位角Q,該第二運算式為校正後方位角Q=校正前方位角Q-校正角度a,並且偏差角度A大於校正角度a。若偏差角度A大於一臨界值Th,不校正方位角Q。
於一實施例中,該控制方法更包含以下步驟。使自動清潔機旋轉一預定角度G。使自動清潔機從第二位置移動至一第三位置。於該使自動清潔機旋轉一預定角度G的步驟後,利用距離感測器,在多個相異的時間點t,求得自動清潔機與牆面間的多個間距Y1(t)。於該使該自動清潔機旋轉一預定角度G的步驟後,在該些相異時間點t,計算出行走裝置的多個行走距離X1(t)。在第三位置時,根據該些間距Y1(t)及該些行走距離X1(t),求得自動清潔機的行走方向與牆面之延伸方向間的一偏差角度A1。以及根據偏差角度A及偏差角度A1來校正陀螺儀的常數K。
於一實施例中,預定角度G為360度。該使該自動清潔機從一第一位置移動至一第二位置的步驟,包含使行走裝置向前行走。該使該自動清潔機從該第二位置移動至一第三位置的步驟,包含使行走裝置向後行走。
依據本發明一實施例,自動清潔機的控制方法,適用於一自動清潔機包含以下步驟。啟動一自動清潔機,以使自動清潔機尋找一啟始點。利用如請求項8-12任一項所述的自動清潔機的控制方法,使自動清潔機開始行走。利用自動清潔機的至少一距離感測器,在不同的時間點測得自動清潔機的周圍環境,以測得多個局部地圖。依據已測得的該些局部地圖決定一
弓字型軌跡,並依據弓字型軌跡持續行走。以及,依據已測得的該些局部地圖,以更新一地圖資訊,並將地圖資訊存儲於自動清潔機的一存儲器中。
依據本發明一實施例,藉由持續地量測自動清潔機與牆面間的間距,鑑定出它與牆面間的角度,並利用偏差角度A校正自動清潔機的方位角Q,而使自動清潔機的路徑不會偏移。於一實施例中,可以採用低成本的測距雷射IC,而不是光學雷達(LIDAR),此方法成本低廉。
1‧‧‧清潔機器人
20‧‧‧壁面
21-24‧‧‧壁面區間
30‧‧‧房間
31-32‧‧‧障礙物
102‧‧‧地板
103‧‧‧牆面
104‧‧‧牆面
200‧‧‧自動清潔機
201-203‧‧‧路徑
210‧‧‧距離感測器
211‧‧‧雷射束
221‧‧‧防撞桿
222‧‧‧側刷
223‧‧‧行走裝置
224‧‧‧清潔裝置
225‧‧‧清潔裝置
231‧‧‧輪子
232‧‧‧皮帶
330‧‧‧幫浦模組
331‧‧‧吸塵口
340‧‧‧控制模組
341‧‧‧編碼器
342‧‧‧馬達模組
343‧‧‧陀螺儀
344‧‧‧處理器
345‧‧‧存儲器
390‧‧‧電源模組
400‧‧‧牆面
從以下之詳細說明及附圖,其僅是用以說明而非本發明所限定,能夠更全面地理解本發明。
圖1顯示習知清潔機器人所規劃之預定路徑的示意圖。
圖2A示意地顯示本發明一實施例自動清潔機沿牆面行走時的俯視圖。
圖2B顯示圖2A實施例之自動清潔機的仰視圖。
圖2C顯示圖2A實施例之自動清潔機的側視圖。
圖3顯示本發明一實施例之清潔機的功能方塊圖。
圖4顯示本發明一實施例之自動清潔機所行走之實際路徑之一部分的示意圖。
圖5顯示圖2A實施例自動清潔機與牆面間之間距Y(t);與行走距離X(t)的關係圖。
圖6顯示本發明一實施例之控制方法的流程圖。
圖7顯示本發明一實施例之自動清潔機規劃路徑的示意圖。
圖8顯示本發明一實施例之自動清潔機規劃路徑的流程圖。
圖9A顯示本發明另一實施例之自動清潔機所行走之實際路徑之一部分的示意圖。
圖9B顯示本發明另一實施例之自動清潔機所行走之實際路徑之一部分的示意圖。
圖10A-10B顯示本發明一實施例之能夠校正陀螺儀的控制方法的流程圖。
將參照附圖,詳細地說明本發明,其中相同的標號將用於識別多個視點的相同或近似的元件。應注意的是,圖式應以標號的取向方向觀看。
依據本發明一實施例的自動機器人及其控制方法,自動清潔機200邊行走邊建地圖,並且依局部地圖規劃有效清潔路徑,在清潔過程中繼續擴張地圖,直到全部整個房間地板102清潔完畢。此外,在行走的同時,依據牆面,隨時地校正自動清潔機200的方位角Q,使得自動清潔機200能夠以平行或垂直於牆面400的方式,並以“弓字型”路徑來回清掃房間,藉以提高清潔效率。以下,將更進一步地說明本發明的具體實施例。
圖2A示意地顯示本發明一實施例自動清潔機沿牆面行走時的俯視圖。圖2B顯示圖2A實施例之自動清潔機的仰視圖。圖2C顯示圖2A實施例之自動清潔機的側視圖。如圖2A、2B及2C所示,自動清潔機200含有至少一距離感測器210、一防撞桿221、至少一側刷222、一行走裝置223、及一清潔裝置224、225。防撞桿221設於自動清潔機200的前方,用以感測與碰撞一障礙物的事件。側刷222向下延伸用以將地面的灰塵掃入吸塵口331。清潔裝置224、225可以包含一清潔布設於底側且面向下用以擦拭地面。如圖2C所示,行走裝置223可以為一皮帶輪裝置其包含兩個輪子231及一皮帶232,而且皮帶232連接於該些輪子231之間。
圖3為本發明一實施例之清潔機的功能方塊圖。請參照圖3,於本實施例中,自動清潔機200更包含一幫浦模組330、一控制模組340及一電源模組390。電源模組390用以提供一電源給幫浦模組330及控制模組340。幫浦模組330驅動真空吸塵裝置(未圖示)進行真空吸塵,從吸塵口331吸入灰塵後將灰塵收集在集塵帶(未圖示)中。距離感測器210電連接於控制模組340,用以傳送一距離資料給控制模組340。控制模組340包含一編碼器341、一馬達模組342、一陀螺儀343、一處理器(CPU)344及存儲器345。馬達模組342驅動行走裝置223,使自動清潔機200前後移動或左右轉動。更具體而言,馬達模組342連接該些輪子231,並驅動該些輪子23旋轉進而帶動皮帶232轉動。馬達模組342電連接有一個編碼器341(Encoder),編碼器341依據馬達模組342的一操作信號,以求得行走距離或轉彎角度。由編碼器341的讀值可計算出自動清潔機200行走的距離或轉彎的角度。控制模組340的
陀螺儀343用以量測的自動清潔機200的角速度(ω),然後對角速度(ω)的積分而得到機器的積分角度(iA),如下公式eq1。編碼器341依據行走距離、轉彎的角度及積分角度(iA)至少其中之一作出慣性導航(inertial navigation),並且進行“弓字型”來回清掃。
iA=ʃ Kωdt eq1
其中,iA表示積分角度,K為陀螺儀的常數,ω為角速度,t為時間。
然而,由於自動清潔機200取得方位角的方式,是以積分方式求得,因此會不斷地累積過去的誤差,而造成實際路徑的傾斜,且脫離原先預期的路徑。圖4顯示自動清潔機所行走之實際路徑之一部分的示意圖。如圖4所示,自動清潔機200置於一房間的地板102上。自動清潔機200因為誤差的累積,而造成實際路徑已脫離原先預期的路徑。此外,自動清潔機200的座標或方位角會因偏差,因而無法行走大致平行或垂直於牆面的路徑,因此其所建立之地圖資訊也會偏差。
更具體而言,在自動清潔機200的行進中,其積分陀螺儀343檢測出的角速度。自動清潔機200的編碼器341用檢測出的移動距離,並且利用該角速度來求得校正前實際行走的方位角Q。由於隨著時間會累積誤差,而造成自動清潔機200之校正前方位角Q與其原本被預期(desired)的方位角Q(亦即牆面400延伸方向Qc)不一致,結果是自動清潔機200行走方向不平行於牆面400延伸方向。
於一實施例中,距離感測器210設於自動清潔機200的一側邊。較佳地,如圖2A所示,距離感測器210分別設於自動清潔機200的兩個側邊和前側。於一實施例中,距離感測器210可以為一固定式的雷射量測積體電路(integrated circuit,IC),距離感測器210發射雷射束211,以量測自動清潔機200與牆面400之間的距離。距離感測器210在多個相異的時間點t,量測自動清潔機200與牆面400間的間距Y(t)。控制模組340用以在該些相異時間點t,計算出行走裝置223的多個行走距離X(t),並且將該些資料記錄於控制模組340中。對該些行走距離X(t)及間距Y(t)進行線性回歸取得回歸線L,並求得回歸線L及X軸間的角度,作為自動清潔機200行走方向與牆面400延伸方向間的角度,亦即偏差角度A。
圖5顯示圖2A實施例自動清潔機與牆面間之間距Y(t);與行走距離X(t)的關係圖。更詳細說明,例如將該些資料繪製於圖表上,如圖5所示,每個時間點t可以得到一組X(t)及Y(t)的數值,即可在圖5上繪製多個點。再對該些點進行線性回歸取得回歸線L,求得回歸線L及X軸間的角度,即可計算出偏差角度A。
要校正自動清潔機200的方位角Q時,自動清潔機200的控制模組340將本體旋轉偏差角度A後,即可使自動清潔機200的行走方向平行於牆面400的延伸方向,此時控制模組340再對方位角Q進行校正,亦即校正後方位角Q=(校正前方位角Q-偏差角度A)=方位角Qc,並將校正後方位角Q存儲於控制模組340中。如此,自動清潔機200可以平行或垂直於牆面,以進行“弓
字型”來回清掃。應了解的是,於本實施例中,雖然是以自動清潔機200的行走方向與參考物為平行作為示例加以說明,但平行並非本發明限定者,其可以為垂直。或者,依據產品設計的需求,採用個種預設的角度。於一實施例中,只要自動清潔機200的行走方向與參考物為一預定角度即可。
於前述實施例中,有時會因所計算出的偏差角度A過大而造成過渡的校正,因此較佳的情況是,能夠以分時方式,在不同時間點進行校正,而且每次校正的角度皆小於偏差角度A,藉以漸漸地逼近預期(desired)方位角Qc。如此,可以避免自動清潔機200左右旋轉的振幅過大。
圖6顯示本發明一實施例之控制方法的流程圖。自動清潔機200開始運行時,進行初始定位步驟。於初始定位步驟後開始行走(步驟S01),並在行走的同時進行本發明一實施例之控制方法。如圖6所示,自動清潔機200的控制方法包含以下步驟。
步驟S02:利用距離感測器210,在多個相異的時間點t,求得自動清潔機200與一牆面400間的多個間距Y(t)。
步驟S04:在該些相異時間點t,計算出行走裝置223的多個行走距離X(t)。
步驟S06:根據該些間距Y(t)及該些行走距離X(t),求得自動清潔機200的行走方向與牆面400之延伸方向間的一偏差角度。更詳言之,對該些行走距離X(t)及間距Y(t)進行線性回歸取得回歸線L,並求得回歸線L及X軸間的角度,作為偏差角度A。
步驟S08:根據偏差角度A校正方位角Q。
於一實施例中,為了避免過渡的校正的情況,能夠以分時方式,在不同時間點進行微幅校正。具體而言,前述步驟S08可以包含以下步驟。
步驟S82:判斷是否為第一次校正。若是,則進行步驟S84。若否,則進行步驟S85。
步驟S84:依下述運算式校正自動清潔機200的方位角Q,校正後方位角Q=(校正前方位角Q-偏差角度A)。執行步驟S84後,再回到步驟S02。
步驟S85:判斷偏差角度A是否小於一臨界值Th。若是,則進行步驟S86。若否,則進行步驟S87。
步驟S86:依下述運算式微幅校正自動清潔機200的方位角Q,校正後方位角Q=(校正前方位角Q-校正角度a),其中校正角度a小於偏差角度A。執行步驟S86後,再回到步驟S02。
步驟S87:不校正自動清潔機200的方位角Q。若偏差角度A超過臨界值時,表示牆面400是傾斜的,並不是正交性的牆面,因此不進行修正。執行步驟S87後,再回到步驟S02。
自動清潔機200開始運行時,進行初始定位步驟。於初始定位步驟後開始行走,隨後進行方位角Q第一次校正,並且以編碼器341與陀螺儀343(Gyro)作慣性導航。但是持續行走過程中,可能會有滑步與累積誤差,造成方位角Q的偏差。依據本實施例,自動清潔機200在行走時,持續鑑定自動清潔機200行走方向與附近牆面400間的角度,當判斷出兩者間有偏差
角度A時,針對偏差角度A進行少量修正,以調整自動清潔機200軟體內的方位角Q。但是,偏差角度A過大時表示牆面400是斜的,不是垂直或平行的牆面400,因此偏差角度A過大則不修正自動清潔機200軟體內的方位角Q。如圖2A所示,自動清潔機200在房間行走時,距離感測器210量測包含牆、廚櫃、床等的牆面400;與自動清潔機200間的偏差角度A,並利用該偏差角度A校正自動清潔機200的方位角Q,以使得自動清潔機200可以平行或垂直於牆面400的方式,並以“弓字型”路徑來回清掃房間。
圖7顯示本發明一實施例之自動清潔機規劃路徑的示意圖。圖8顯示本發明一實施例之自動清潔機規劃路徑的流程圖。如圖7及圖8所示,本發明一實施例之規劃路徑方法包含以下步驟。
步驟S20:啟動一自動清潔機200,自動清潔機200開始運行時,進行初始定位步驟,以尋找啟始點M0。於一實施例中,可以將自動清潔機200置於任意位置,作為啟始點M0。於一實施例中,自動清潔機200進行尋找一牆面,於找到牆面時的位置當作啟始點M0。於一實施例中,尋找由兩個牆面所構成的角,找到該角時的位置當作啟始點M0。
步驟S22:利用如前所述圖6實施例的自動清潔機的控制方法,使自動清潔機200開始行走。
步驟S24:利用多個距離感測器210,在不同的時間點測得自動清潔機200的周圍環境,以測得多個局部地圖Sq。更具體而言,一開始時,利用該些距離感測器210,測得自動清潔機200的周圍環境,以求得一局部地圖S0。局部地圖S0是地板102中的一局部區域,其可以用2維陣列S0(i,j)表示,其中
i及j的大小是依據距離感測器210所能夠感測到的最大距離所決定。自動清潔機200沿牆面103行走至點A1,在行走的同時依圖6方法進行方向角Q的校正,並且測得自動清潔機200的周圍環境,以求得一局部地圖S1。
步驟S26:依據已測得的該些局部地圖Sq決定一弓字型軌跡,並依據該弓字型軌跡持續行走。更詳言之,自動清潔機200依據該些已知的局部地圖Sq決定一弓字型軌跡,並依據該弓字型軌跡持續沿橫軸地或沿蹤軸地行走至點Aq+1,在行走的同時依圖6方法進行方向角Q的校正,並且持續地求得最新的局部地圖Sq+1。依據弓字型軌跡,自動清潔機200持續行走直到障礙時向左或右旋轉90度。如圖7所示,自動清潔機200遇到牆面104時向左90度旋轉,持續行走,遇到壁面105後再向左90度旋轉,行走一預定距離W後再向左90度旋轉,藉以走“弓字型”路徑。
步驟S28:依據已測得的該些局部地圖Sq,以更新一地圖資訊,並將該地圖資訊存儲於自動清潔機200的存儲器345中。自動清潔機200整合所有局部地圖S0至局部地圖Sq,以更新並擴大地圖資訊map(i,j)。橫軸行走距離愈長可以偵測的i值愈大,蹤軸行走距離愈長可以偵測的j值愈大,因此局部地圖S1包含局部地圖S0所未知的部分,局部地圖Sq+1包含局部地圖Sq所未知的部分,自動清潔機200整合已測得的該些局部地圖,以更新並擴大地圖資訊map(i,j)。此外,於圖7中,向右及向上的方向可以設為正值;向左及向下可以設為負值。
如上述,自動清潔機200能夠在行走的同時測得多個局部地圖,並依據該些局部地圖來更新並擴大地圖資訊map(i,j)。依據本發明一實施例,其優
點在於,自動清潔機200邊行走邊建地圖,並且依局部地圖規劃有效清潔路徑,在清潔過程中繼續擴張地圖,直到全部整個房間地板102清潔完畢,因此在開始清潔前,不需要繞整個房間一圈來建立地圖,而可以減少時間。此外,在自動清潔機200行走的同時,依前述方法進行方向角Q的校正,因此能夠以平行或垂直於牆面400的方式,並以“弓字型”路徑來回清掃房間。
此外,陀螺儀343之積分角度的誤差,是其常數K所形成的。依據本發明一實施例,亦可以使用偏差角度A來校正陀螺儀343的陀螺儀常數K。圖9A顯示本發明另一實施例之自動清潔機所行走之實際路徑之一部分的示意圖。圖9B顯示本發明另一實施例之自動清潔機所行走之實際路徑之一部分的示意圖。圖10A-10B顯示本發明一實施例之能夠校正陀螺儀的控制方法的流程圖。如圖9A及圖10A-10B所示,本發明一實施例之控制方法其能夠校正陀螺儀,該控制方法包含以下步驟。
步驟S60:使自動清潔機200從一第一位置移動至一第二位置。如圖9A所示,第一位置可以為點P1,第二位置可以為點P2。
步驟S61:自動清潔機200利用距離感測器210,在多個相異的時間點t,求得自動清潔機200與一牆面400間的多個間距Y(t)。
步驟S62:在該些相異時間點t,計算出行走裝置223向前方行走的多個行走距離X(t)。
步驟S63:在該第二位置時,根據該些間距Y(t)及該些行走距離X(t),
求得自動清潔機200的行走方向與牆面400之延伸方向間的一偏差角度A。
步驟S64:使自動清潔機200旋轉一預定角度G。於一實施例中,如圖9A所示,預定角度G可以為360度,此時,在理想狀態下自動清潔機200的方位不變。於另一實施例中,如圖9B所示,預定角度G可以為小於90度的任一角度。
步驟S65:使自動清潔機200從一第二位置移動至一第三位置。如圖9A所示,第二位置可以為點P2,而第三位置分別可以為點P3。於一實施例,使行走裝置223的輪子231向後旋轉,在自動清潔機200的方位不變的情況下,使其向後行走至P5。如圖9B所示,第二位置可以為點P2,而第三位置分別可以為點P4。
步驟S66:利用距離感測器210,在多個相異的時間點t,求得自動清潔機200與一牆面400間的多個間距Y1(t)。
步驟S67:在該些相異時間點t,計算出行走裝置223向前方或向後方行走的多個行走距離X1(t)。此時,如圖9A所示,於一實施例中,當自動清潔機200向前方行走時,它從點P2走至點P3。於另一實施例中,當自動清潔機200向後方行走時,它從點P2再走回至點P1附近的點P5。於圖9B實施例中,自動清潔機200從點P2走至點P4。
步驟S68:在該第三位置時,根據該些間距Y1(t)及該些行走距離X1(t),求得自動清潔機200的行走方向與牆面400之延伸方向間的一偏差角度A1。
步驟S69:根據偏差角度A及偏差角度A1來校正陀螺儀343的常數K。舉例而言,於一實施例中,可以利用下式來校正陀螺儀343的常數K。
其中,Knew表示修正後的陀螺儀常數,Kold表示修正前的陀螺儀常數,G表示自動清潔機200所旋轉的預定角度,A1表示自動清潔機200旋轉後的偏差角度,A表示自動清潔機200旋轉前的偏差角度,mod(G,360)表示餘數函數其中被除數為G而除數為360。
於圖9A實施例中,由於預定角度G為360°,因此mod(G,360)的值為0。此時方程式eq2為:Knew=(1+(A1-A)/360)* Kold。此外,當預定角度G為30°或390°時,在理想狀態下所測得的A1與A間的差皆為30°,因此陀螺儀343所造成的誤差角度,其一般通式為A1-A-mod(G,360)。最後,再利用方程式eq2校正陀螺儀常數K。透過前述校正陀螺儀的控制方法,能夠得到更準確的陀螺儀常數。
綜上所述,依據本發明一實施例,藉由持續地量測自動清潔機200與牆面400間的間距,鑑定出它與牆面400間的角度,並利用偏差角度A校正自動清潔機200的方位角Q,而使自動清潔機200的路徑不會偏移。於一實施例中,可以採用低成本的測距雷射IC,而不是光學雷達(LIDAR),此方法成本低廉,而且清掃效率高,覆蓋率高。於一實施例中,提出一種比光學雷達(LIDAR)導航、或影像系統辨認導航更簡單,且成本更低的方案。於一實施例中,還提出一種陀螺儀的校正方法。
已詳細地說明本發明,相同的方法還能夠用很多種方法來改變,這是
很明顯的。該些變形不應視為脫離本發明的精神和範圍。所有該些對於本領域具有通常知識者為明顯的修正,皆包含在本說明書之申請專利範圍中。
Claims (15)
- 一種自動清潔機,包含一距離感測器、一控制模組及一行走裝置,該控制模組具有一陀螺儀,並且電連接該距離感測器及該行走裝置,其中,該行走裝置用以移動該自動清潔機,藉以使該自動清潔機從一第一位置移動至一第二位置,該距離感測器,用以在多個相異的時間點t,測量該自動清潔機與一牆面間的多個間距Y(t),其中該距離感測器包含一測距雷射裝置,用以發射一雷射束,以求得該自動清潔機與該牆面間的該些間距Y(t);該控制模組,用以在該些相異時間點t,計算出該行走裝置的多個行走距離X(t);並且,在該第二位置時,根據該些間距Y(t)及該些行走距離X(t),求得該自動清潔機的行走方向與該牆面之延伸方向間的一偏差角度A,藉以利用該牆面來鑑定出該自動清潔機與該牆面間的角度,其中,該控制模組更根據該陀螺儀來計算出一方位角Q,並且根據該偏差角度A校正該方位角Q;利用該自動清潔機的該距離感測器,在不同的時間點測得該自動清潔機的周圍環境,以測得多個局部地圖;依據已測得的該些局部地圖決定一軌跡,並依據該軌跡持續行走;以及依據已測得的該些局部地圖,以更新一地圖資訊,並將該地圖資訊存儲於該自動清潔機的一存儲器中,其中,該自動清潔機行走距離愈長偵測的值愈大,使該些局部地圖中一目前局部地圖包含前一局部地圖所未知的部分,以更新並擴大該地圖資訊,藉以在清潔過程中繼續擴張該地圖資訊,而不繞一空間一圈來建立地圖。
- 根據請求項1所述的自動清潔機,其中,該控制模組更對該些行走距離X(t)及該些間距Y(t),進行線性回歸取得回歸線L,並依據該回歸線L求得該偏差角度A。
- 根據請求項1所述的自動清潔機,其中,該控制模組更對該些行走距離X(t)及該些間距Y(t)進行回歸,以求得該偏差角度A。
- 根據請求項1所述的自動清潔機,其中,該控制模組依據一第一運算式校正該方位角Q,校正後方位角Q=校正前方位角Q-偏差角度A。
- 根據請求項1所述的自動清潔機,其中,該控制模組依據一第二運算式校正該方位角Q,校正後方位角Q=校正前方位角Q-校正角度a,並且該偏差角度A大於該校正角度a。
- 根據請求項1所述的自動清潔機,其中,該控制模組更使該自動清潔機旋轉一預定角度G後,再控制該行走裝置以使該自動清潔機從該第二位置移動至一第三位置;於該自動清潔機旋轉該預定角度G後,利用該距離感測器,在多個相異的時間點t,求得該自動清潔機與該牆面間的多個間距Y1(t);於該自動清潔機旋轉該預定角度G後,在該些相異時間點t,計算出該行走裝置的多個行走距離X1(t);在該第三位置時,根據該些間距Y1(t)及該些行走距離X1(t),求得該自動清潔機的行走方向與該牆面之延伸方向間的一偏差角度A1;並且根據該偏差角度A及該偏差角度A1來校正該陀螺儀的常數K。
- 一種自動清潔機的控制方法,適用於一自動清潔機,該自動清潔機包含一距離感測器、具有一陀螺儀的一控制模組及一行走裝置,該控制方法包含:使該自動清潔機從一第一位置移動至一第二位置;利用該距離感測器,在多個相異的時間點t,求得該自動清潔機與一牆面間的多個間距Y(t),其中該距離感測器包含一測距雷射裝置,發射一雷射束,以求得該自動清潔機與該牆面間的該些間距Y(t);在該些相異時間點t,計算出該行走裝置的多個行走距離X(t);在該第二位置時,根據該些間距Y(t)及該些行走距離X(t),求得該自動清潔機的行走方向與該牆面之延伸方向間的一偏差角度A,藉以利用該牆面來鑑定出該自動清潔機與該牆面間的角度;利用該控制模組根據該陀螺儀來計算出一方位角Q;利用該控制模組根據該偏差角度A校正該方位角Q;利用該自動清潔機的該距離感測器,在不同的時間點測得該自動清潔機的周圍環境,以測得多個局部地圖;依據已測得的該些局部地圖決定一軌跡,並依據該軌跡持續行走;以及依據已測得的該些局部地圖,以更新一地圖資訊,並將該地圖資訊存儲於該自動清潔機的一存儲器中,其中,該自動清潔機行走距離愈長可以偵測的的值愈大,使該些局部地圖中一目前局部地圖包含前一局部地圖所未知的部分,以更新並擴大該地圖資訊,藉以在清潔過程中繼續擴張該地圖資訊,而不繞一空間一圈來建立地圖。
- 根據請求項7所述的自動清潔機的控制方法,其中,該求得該偏差角度A的步驟包含:對該些行走距離X(t)及該些間距Y(t),進行線性回歸取得回歸線L,並依據該回歸線L求得該偏差角度A。
- 根據請求項7所述的自動清潔機的控制方法,其中,該求得該偏差角度A的步驟包含:對該些行走距離X(t)及該些間距Y(t)進行回歸,以求得該偏差角度A。
- 根據請求項7所述的自動清潔機的控制方法,其中,該根據該偏差角度A校正該方位角Q的步驟包含:依據一運算式校正該方位角Q,該運算式為校正後方位角Q=校正前方位角Q-校正角度a,並且該偏差角度A大於該校正角度a。
- 根據請求項7所述的自動清潔機的控制方法,其中,該根據該偏差角度A校正該方位角Q的步驟包含:判斷是否為第一次校正;若是第一次校正,依據一第一運算式校正該方位角Q,該第一運算式為校正後方位角Q=校正前方位角Q-該偏差角度A;判斷該偏差角度A是否小於一臨界值Th;若不是第一次校正且該偏差角度A小於一臨界值Th,依據一第二運算式校正該方位角Q,該第二運算式為校正後方位角Q=校正前方位角Q-校正角度a,並且該偏差角度A大於該校正角度a;若該偏差角度A大於一臨界值Th,不校正該方位角Q。
- 根據請求項7所述的自動清潔機的控制方法,更包含:使該自動清潔機旋轉一預定角度G;使該自動清潔機從該第二位置移動至一第三位置;於該使該自動清潔機旋轉一預定角度G的步驟後,利用該距離感測器,在多個相異的時間點t,求得該自動清潔機與該牆面間的多個間距Y1(t);於該使該自動清潔機旋轉一預定角度G的步驟後,在該些相異時間點t,計算出該行走裝置的多個行走距離X1(t);在該第三位置時,根據該些間距Y1(t)及該些行走距離X1(t),求得該自動清潔機的行走方向與該牆面之延伸方向間的一偏差角度A1;以及根據該偏差角度A及該偏差角度A1來校正該陀螺儀的常數K。
- 根據請求項12所述的自動清潔機的控制方法,其中,該預定角度G為360度,該使該自動清潔機從一第一位置移動至一第二位置的步驟,包含使該行走裝置向前行走,而且該使該自動清潔機從該第二位置移動至一第三位置的步驟,包含使該行走裝置向後行走。
- 一種自動清潔機的控制方法,適用於一自動清潔機,該自動清潔機包含一距離感測器、具有一陀螺儀的一控制模組及一行走裝置,該控制方法包含:使該自動清潔機從一第一位置移動至一第二位置;利用該距離感測器,在多個相異的時間點t,求得該自動清潔機與一牆面間的多個間距Y(t),其中該距離感測器包含一測距雷射裝置,發射一雷射束,以求得該自動清潔機與該牆面間的該些間距Y(t);在該些相異時間點t,計算出該行走裝置的多個行走距離X(t);在該第二位置時,根據該些間距Y(t)及該些行走距離X(t),求得該自動清潔機的行走方向與該牆面之延伸方向間的一偏差角度A,藉以利用該牆面來鑑定出該自動清潔機與該牆面間的角度;利用該控制模組根據該陀螺儀來計算出一方位角Q;利用該控制模組根據該偏差角度A校正該方位角Q;利用該自動清潔機的該距離感測器,在不同的時間點測得該自動清潔機的周圍環境,以測得多個局部地圖;依據已測得的該些局部地圖決定一軌跡,並依據該軌跡持續行走;以及依據已測得的該些局部地圖,以更新一地圖資訊,並將該地圖資訊存儲於該自動清潔機的一存儲器中,其中,該自動清潔機行走距離愈長可以偵測的值愈大,使該些局部地圖中一目前局部地圖包含前一局部地圖所未知的部分,以更新並擴大該地圖資訊,藉以在清潔過程中繼續擴張該地圖資訊,直到一空間的地板清潔完畢,而不繞整個該空間一圈來建立地圖。
- 根據請求項14所述的自動清潔機的控制方法,其中,該利用該控制模組根據該偏差角度A校正該方位角Q的步驟包含:校正該陀螺儀的常數K。
Priority Applications (6)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW106110983A TWI634403B (zh) | 2017-01-26 | 2017-03-31 | 自動清潔機及其控制方法 |
CN201710304249.5A CN108354524B (zh) | 2017-01-26 | 2017-05-03 | 自动清洁机及其控制方法 |
EP17186058.8A EP3354180B1 (en) | 2017-01-26 | 2017-08-11 | Automatic cleaner and controlling method of the same |
US15/695,578 US20180206688A1 (en) | 2017-01-26 | 2017-09-05 | Automatic Cleaner and Controlling Method of the Same |
RU2017131719A RU2017131719A (ru) | 2017-01-26 | 2017-09-11 | Автоматическое чистящее устройство и способ управления им |
JP2017179368A JP2018120572A (ja) | 2017-01-26 | 2017-09-19 | 自動清掃機及びその制御方法 |
Applications Claiming Priority (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW106103119 | 2017-01-26 | ||
??106103119 | 2017-01-26 | ||
TW106109150 | 2017-03-20 | ||
??106109150 | 2017-03-20 | ||
TW106110983A TWI634403B (zh) | 2017-01-26 | 2017-03-31 | 自動清潔機及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
TW201827968A TW201827968A (zh) | 2018-08-01 |
TWI634403B true TWI634403B (zh) | 2018-09-01 |
Family
ID=59592963
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
TW106110983A TWI634403B (zh) | 2017-01-26 | 2017-03-31 | 自動清潔機及其控制方法 |
Country Status (6)
Country | Link |
---|---|
US (1) | US20180206688A1 (zh) |
EP (1) | EP3354180B1 (zh) |
JP (1) | JP2018120572A (zh) |
CN (1) | CN108354524B (zh) |
RU (1) | RU2017131719A (zh) |
TW (1) | TWI634403B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI766325B (zh) * | 2019-07-31 | 2022-06-01 | 南韓商Lg電子股份有限公司 | 移動式機器人 |
TWI766326B (zh) * | 2019-07-31 | 2022-06-01 | 南韓商Lg電子股份有限公司 | 移動式機器人 |
US11771285B2 (en) | 2019-07-31 | 2023-10-03 | Lg Electronics Inc. | Mobile robot |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10751875B2 (en) * | 2018-05-31 | 2020-08-25 | Indoor Robotics Ltd | Rotatable mobile robot for mapping an area and a method for mapping the same |
CN109512344A (zh) * | 2019-01-04 | 2019-03-26 | 云鲸智能科技(东莞)有限公司 | 一种移动机器人 |
DE102019209417B3 (de) * | 2019-06-27 | 2020-11-12 | Volkswagen Aktiengesellschaft | Verfahren zum Betrieb eines Reinigungsroboters |
CN112256011B (zh) * | 2019-07-05 | 2022-05-17 | 苏州宝时得电动工具有限公司 | 回归引导方法、回归引导装置、移动机器人及存储介质 |
KR102224638B1 (ko) | 2019-07-31 | 2021-03-05 | 엘지전자 주식회사 | 이동 로봇 및 그 제어방법 |
CN113440049B (zh) * | 2020-03-25 | 2023-06-09 | 尚科宁家(中国)科技有限公司 | 一种清洁机器人及其控制方法 |
CN112198876B (zh) * | 2020-09-28 | 2023-10-03 | 湖南格兰博智能科技有限责任公司 | 一种适用于扫地机器人的带地图全覆盖清扫模块化控制方法 |
CN114355871A (zh) * | 2020-09-30 | 2022-04-15 | 好样科技有限公司 | 一种自行走装置及其控制方法 |
CN114913223A (zh) * | 2021-02-09 | 2022-08-16 | 北京盈迪曼德科技有限公司 | 一种视觉扫地机正方向识别方法及系统 |
CN113455951B (zh) * | 2021-06-23 | 2022-05-27 | 中铁建工集团山东有限公司 | 一种适用于幕墙的自动化清洁系统 |
CN113359766B (zh) * | 2021-07-05 | 2023-06-23 | 杭州萤石软件有限公司 | 一种移动机器人的移动控制方法、以及移动机器人 |
CN113966976B (zh) * | 2021-09-28 | 2023-09-22 | 安克创新科技股份有限公司 | 清洁机器人及用于控制清洁机器人行进的方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TW201035710A (en) * | 2009-03-30 | 2010-10-01 | Yan cheng xiang | Edge following movement device |
CN102871608A (zh) * | 2007-04-06 | 2013-01-16 | 三星电子株式会社 | 沿墙机器人吸尘器和控制该沿墙机器人吸尘器的方法 |
CN102354436B (zh) * | 2011-07-12 | 2013-05-08 | 深圳市卡琳娜机器人软件开发有限公司 | 室内安防巡逻机器人系统的报警方法 |
CN205247205U (zh) * | 2015-03-18 | 2016-05-18 | 美国iRobot公司 | 自主机器人 |
CN105606101A (zh) * | 2015-12-21 | 2016-05-25 | 北京航天科工世纪卫星科技有限公司 | 一种基于超声波测量的机器人室内导航方法 |
CN103376801B (zh) * | 2012-04-13 | 2016-08-03 | 科沃斯机器人有限公司 | 自移动地面处理机器人及其清洁工作的控制方法 |
CN205681138U (zh) * | 2015-12-21 | 2016-11-09 | 小米科技有限责任公司 | 充电桩和自动清洁系统 |
Family Cites Families (39)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0142594B1 (en) * | 1983-10-26 | 1989-06-28 | Automax Kabushiki Kaisha | Control system for mobile robot |
JPS62276611A (ja) * | 1986-05-24 | 1987-12-01 | Toyota Central Res & Dev Lab Inc | 基準面判定装置 |
JPS6398005A (ja) * | 1986-10-14 | 1988-04-28 | Toshiba Corp | 無人走行装置 |
JPS63104111A (ja) * | 1986-10-21 | 1988-05-09 | Toshiba Corp | 無人走行装置 |
JP3191334B2 (ja) * | 1991-09-03 | 2001-07-23 | 松下電器産業株式会社 | 移動作業ロボット |
KR0156722B1 (ko) * | 1995-08-08 | 1998-11-16 | 김광호 | 로보트의 위치인식장치 및 그 제어방법 |
US6574536B1 (en) * | 1996-01-29 | 2003-06-03 | Minolta Co., Ltd. | Moving apparatus for efficiently moving on floor with obstacle |
EP1098587A1 (de) * | 1998-07-31 | 2001-05-16 | Volker Sommer | Haushaltsroboter zum automatischen staubsaugen von bodenflächen |
CA2388870A1 (en) * | 1999-11-18 | 2001-05-25 | The Procter & Gamble Company | Home cleaning robot |
US6496754B2 (en) * | 2000-11-17 | 2002-12-17 | Samsung Kwangju Electronics Co., Ltd. | Mobile robot and course adjusting method thereof |
US6809490B2 (en) * | 2001-06-12 | 2004-10-26 | Irobot Corporation | Method and system for multi-mode coverage for an autonomous robot |
SE0200197L (sv) * | 2002-01-23 | 2003-07-24 | Electrolux Ab | Förfarande för en anordning på hjul |
KR100486505B1 (ko) * | 2002-12-31 | 2005-04-29 | 엘지전자 주식회사 | 로봇 청소기의 자이로 오프셋 보정방법 |
JP2004275468A (ja) * | 2003-03-17 | 2004-10-07 | Hitachi Home & Life Solutions Inc | 自走式掃除機およびその運転方法 |
JP2005296508A (ja) * | 2004-04-15 | 2005-10-27 | Funai Electric Co Ltd | 自走式掃除機 |
JP2005304540A (ja) * | 2004-04-16 | 2005-11-04 | Funai Electric Co Ltd | 監視カメラを備えた自走式掃除機 |
KR100560966B1 (ko) * | 2004-10-12 | 2006-03-15 | 삼성광주전자 주식회사 | 로봇 청소기의 자이로 센서 보정방법 |
KR100600487B1 (ko) * | 2004-10-12 | 2006-07-13 | 삼성광주전자 주식회사 | 로봇 청소기의 좌표보정방법 및 이를 이용한 로봇 청소기시스템 |
JP2006268499A (ja) * | 2005-03-24 | 2006-10-05 | Funai Electric Co Ltd | 走行機および自走式掃除機。 |
KR101323597B1 (ko) * | 2005-09-02 | 2013-11-01 | 니토 로보틱스 인코퍼레이티드 | 다기능 로봇 장치 |
JP2007286730A (ja) * | 2006-04-13 | 2007-11-01 | Funai Electric Co Ltd | 自走式掃除機 |
US8961695B2 (en) * | 2008-04-24 | 2015-02-24 | Irobot Corporation | Mobile robot for cleaning |
JP5259286B2 (ja) * | 2008-07-16 | 2013-08-07 | 株式会社日立製作所 | 3次元物体認識システム及びそれを用いた棚卸システム |
EP2323890B1 (de) * | 2008-09-10 | 2012-09-05 | Continental Teves AG & Co. oHG | Verfahren zur lenkunterstützung bei notmanöver |
KR101641237B1 (ko) * | 2009-11-20 | 2016-07-21 | 엘지전자 주식회사 | 로봇 청소기 및 이의 제어 방법 |
US8435359B2 (en) * | 2010-06-17 | 2013-05-07 | Chi-Mou Chao | Cleaner and path controlling method thereof |
CN102853832B (zh) * | 2011-06-29 | 2015-07-08 | 财团法人车辆研究测试中心 | 车辆动态惯性感测器学习校正方法及其装置 |
KR101887055B1 (ko) * | 2011-11-14 | 2018-09-11 | 삼성전자주식회사 | 로봇 청소기 및 그 제어 방법 |
KR101984214B1 (ko) * | 2012-02-09 | 2019-05-30 | 삼성전자주식회사 | 로봇 청소기의 청소 작업을 제어하기 위한 장치 및 방법 |
TWI491374B (zh) * | 2012-03-22 | 2015-07-11 | Ememe Robot Co Ltd | 清潔機器人及控制清潔機器人沿障礙物行走的方法 |
JP6076852B2 (ja) * | 2013-07-11 | 2017-02-08 | 株式会社 日立産業制御ソリューションズ | カメラシステム、その制御方法およびその制御プログラム |
EP3091887A4 (en) * | 2014-01-10 | 2017-09-13 | iRobot Corporation | Autonomous mobile robot |
CN104061934B (zh) * | 2014-06-10 | 2017-04-26 | 哈尔滨工业大学 | 基于惯性传感器的行人室内位置跟踪方法 |
EP3282912B1 (en) * | 2015-04-17 | 2020-06-10 | Aktiebolaget Electrolux | Robotic cleaning device and a method of controlling the robotic cleaning device |
GB201510373D0 (en) * | 2015-06-12 | 2015-07-29 | Mitchell Timothy P And Gendel Alon | An automated floor cleaner |
CN205671994U (zh) * | 2015-12-16 | 2016-11-09 | 小米科技有限责任公司 | 自动清洁设备 |
CN105982625B (zh) * | 2016-04-14 | 2019-07-09 | 北京小米移动软件有限公司 | 自动清洁设备及其清扫组件 |
US9968234B2 (en) * | 2016-06-15 | 2018-05-15 | Hobot Technology Inc. | Automatic cleaning machine |
CN107816989B (zh) * | 2017-10-13 | 2021-01-08 | 中国船舶重工集团公司七五0试验场 | 水下机器人航向数据处理方法和装置 |
-
2017
- 2017-03-31 TW TW106110983A patent/TWI634403B/zh active
- 2017-05-03 CN CN201710304249.5A patent/CN108354524B/zh active Active
- 2017-08-11 EP EP17186058.8A patent/EP3354180B1/en active Active
- 2017-09-05 US US15/695,578 patent/US20180206688A1/en not_active Abandoned
- 2017-09-11 RU RU2017131719A patent/RU2017131719A/ru not_active Application Discontinuation
- 2017-09-19 JP JP2017179368A patent/JP2018120572A/ja active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102871608A (zh) * | 2007-04-06 | 2013-01-16 | 三星电子株式会社 | 沿墙机器人吸尘器和控制该沿墙机器人吸尘器的方法 |
TW201035710A (en) * | 2009-03-30 | 2010-10-01 | Yan cheng xiang | Edge following movement device |
CN102354436B (zh) * | 2011-07-12 | 2013-05-08 | 深圳市卡琳娜机器人软件开发有限公司 | 室内安防巡逻机器人系统的报警方法 |
CN103376801B (zh) * | 2012-04-13 | 2016-08-03 | 科沃斯机器人有限公司 | 自移动地面处理机器人及其清洁工作的控制方法 |
CN205247205U (zh) * | 2015-03-18 | 2016-05-18 | 美国iRobot公司 | 自主机器人 |
CN105606101A (zh) * | 2015-12-21 | 2016-05-25 | 北京航天科工世纪卫星科技有限公司 | 一种基于超声波测量的机器人室内导航方法 |
CN205681138U (zh) * | 2015-12-21 | 2016-11-09 | 小米科技有限责任公司 | 充电桩和自动清洁系统 |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI766325B (zh) * | 2019-07-31 | 2022-06-01 | 南韓商Lg電子股份有限公司 | 移動式機器人 |
TWI766326B (zh) * | 2019-07-31 | 2022-06-01 | 南韓商Lg電子股份有限公司 | 移動式機器人 |
US11648898B2 (en) | 2019-07-31 | 2023-05-16 | Lg Electronics Inc. | Mobile robot |
US11771285B2 (en) | 2019-07-31 | 2023-10-03 | Lg Electronics Inc. | Mobile robot |
Also Published As
Publication number | Publication date |
---|---|
US20180206688A1 (en) | 2018-07-26 |
TW201827968A (zh) | 2018-08-01 |
CN108354524A (zh) | 2018-08-03 |
EP3354180B1 (en) | 2020-05-06 |
EP3354180A1 (en) | 2018-08-01 |
JP2018120572A (ja) | 2018-08-02 |
CN108354524B (zh) | 2020-08-14 |
RU2017131719A (ru) | 2019-03-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
TWI634403B (zh) | 自動清潔機及其控制方法 | |
US11960304B2 (en) | Localization and mapping using physical features | |
EP3552532B1 (en) | Method for angle correction of mobile robot in working area and mobile robot | |
US8195331B2 (en) | Method, medium, and apparatus for performing path planning of mobile robot | |
JP6772129B2 (ja) | 移動ロボットにおける光学式走行距離センサの使用のためのシステム及び方法 | |
US9339163B2 (en) | Mobile robot and operating method thereof | |
CA2870175C (en) | Carpet drift estimation using differential sensors or visual measurements | |
EP3018603B1 (en) | Adaptive mapping with spatial summaries of sensor data | |
CN109394095B (zh) | 一种机器人运动地毯偏移的控制方法、芯片及清洁机器人 | |
ES2681802T3 (es) | Método para detectar un error de medición en un dispositivo de limpieza robotizado | |
JP2007213236A (ja) | 自律走行ロボットの経路計画方法及び自律走行ロボット | |
CN109506652B (zh) | 一种基于地毯偏移的光流数据融合方法及清洁机器人 | |
US20210131805A1 (en) | Method for Determining the Orientation of a Robot, Orientation Determination Apparatus of a Robot, and Robot | |
US11143511B2 (en) | On-vehicle processing device | |
KR20080041890A (ko) | 로봇청소기의 외력감지방법, 이를 기록한 기록매체 및 이를이용한 로봇 청소기 | |
CN114355871A (zh) | 一种自行走装置及其控制方法 | |
JP2005346477A (ja) | 自律走行体 | |
JP2004355208A (ja) | 自律走行装置 | |
JP7420635B2 (ja) | 自律移動ロボット、作業エリア内移動システム | |
CN114305202B (zh) | 一种自行走装置及其控制方法 | |
CN117452924A (zh) | 一种机器人找直线方法及行走方向的调整方法 | |
CN117434935A (zh) | 基于tof模块的机器人寻找障碍物方法、芯片及机器人 | |
CN115700417A (zh) | 清洁机器人及建图误差消除方法 | |
JP2021101808A (ja) | 自走式掃除機 |