CN108354524A - 自动清洁机及其控制方法 - Google Patents
自动清洁机及其控制方法 Download PDFInfo
- Publication number
- CN108354524A CN108354524A CN201710304249.5A CN201710304249A CN108354524A CN 108354524 A CN108354524 A CN 108354524A CN 201710304249 A CN201710304249 A CN 201710304249A CN 108354524 A CN108354524 A CN 108354524A
- Authority
- CN
- China
- Prior art keywords
- auto
- cleaner
- misalignment angle
- azimuth
- angle
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 45
- 238000004140 cleaning Methods 0.000 title claims abstract description 24
- 238000012937 correction Methods 0.000 claims description 42
- 230000014509 gene expression Effects 0.000 claims description 14
- 238000012417 linear regression Methods 0.000 claims description 7
- 230000015654 memory Effects 0.000 claims description 6
- 238000000465 moulding Methods 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 12
- 239000000428 dust Substances 0.000 description 4
- 238000009825 accumulation Methods 0.000 description 3
- 230000004888 barrier function Effects 0.000 description 3
- 230000002045 lasting effect Effects 0.000 description 3
- 230000003287 optical effect Effects 0.000 description 3
- 238000010926 purge Methods 0.000 description 2
- 239000013558 reference substance Substances 0.000 description 2
- 238000010408 sweeping Methods 0.000 description 2
- 230000007704 transition Effects 0.000 description 2
- 235000006679 Mentha X verticillata Nutrition 0.000 description 1
- 235000002899 Mentha suaveolens Nutrition 0.000 description 1
- 235000001636 Mentha x rotundifolia Nutrition 0.000 description 1
- 241000755666 Neato Species 0.000 description 1
- 241000700647 Variola virus Species 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000008901 benefit Effects 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
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000004744 fabric Substances 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
- 230000002000 scavenging effect Effects 0.000 description 1
- 238000010407 vacuum cleaning Methods 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
- 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
- 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
- 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, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Mechanical Engineering (AREA)
- Optics & Photonics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Electric Vacuum Cleaner (AREA)
Abstract
本发明提出了一种自动清洁机及其控制方法,自动清洁机的距离感测器用以在多个相异的时间点t,测量自动清洁机与一墙面间的多个间距Y(t)。其控制模块用以在该些相异时间点t,计算出行走装置的多个行走距离X(t)。根据该些间距Y(t)及该些行走距离X(t),求得自动清洁机的行走方向与墙面的延伸方向间的一偏差角度A。
Description
技术领域
本发明关于一种自动清洁机及其控制方法,尤其关于一种利用一墙面校正路径的自动清洁机及其控制方法。
背景技术
已知的清洁机器人1,在清扫室内地板时,以一演算法来进行路径的规划,为了减少没有被清扫或擦拭的区域,较佳地规划出弓字型(Zigzag)路径。例如,美国专利号US7515991B2亦提出一种弓字型路径的规划方法。图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为已知清洁机器人所规划的预定路径的示意图。
图2A示意地显示本发明一实施例自动清洁机沿墙面行走时的俯视图。
图2B为图2A实施例的自动清洁机的仰视图。
图2C为图2A实施例的自动清洁机的侧视图。
图3为本发明一实施例的清洁机的功能方块图。
图4为本发明一实施例的自动清洁机所行走的实际路径的一部分的示意图。
图5为图2A实施例自动清洁机与墙面间的间距Y(t);与行走距离X(t)的关系图。
图6为本发明一实施例的控制方法的流程图。
图7为本发明一实施例的自动清洁机规划路径的示意图。
图8为本发明一实施例的自动清洁机规划路径的流程图。
图9A为本发明另一实施例的自动清洁机所行走的实际路径的一部分的示意图。
图9B为本发明另一实施例的自动清洁机所行走的实际路径的一部分的示意图。
图10A-图10B为本发明一实施例的能够校正陀螺仪的控制方法的流程图。
附图标号:
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 墙面
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域相关技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明的保护的范围。
将参照附图,详细地说明本发明,其中相同的标号将用于识别多个视点的相同或近似的元件。应注意的是,图式应以标号的取向方向观看。
依据本发明一实施例的自动机器人及其控制方法,自动清洁机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)
1.一种自动清洁机,其特征在于,包含一距离感测器、一控制模块及一行走装置,该控制模块具有一陀螺仪,并且电连接该距离感测器及该行走装置,其中,
该行走装置用以移动该自动清洁机,藉以使该自动清洁机从一第一位置移动至一第二位置,
该距离感测器,用以在多个相异的时间点t,测量该自动清洁机与一墙面间的多个间距Y(t),
该控制模块,用以在该些相异时间点t,计算出该行走装置的多个行走距离X(t);并且,在该第二位置时,根据该些间距Y(t)及该些行走距离X(t),求得该自动清洁机的行走方向与该墙面的延伸方向间的一偏差角度A。
2.根据权利要求1所述的自动清洁机,其特征在于,该控制模块更对该些行走距离X(t)及该些间距Y(t),进行线性回归取得回归线L,并依据该回归线L求得该偏差角度A。
3.根据权利要求1或2所述的自动清洁机,其特征在于,该控制模块更计算出一方位角Q,并且再根据该偏差角度A校正该方位角Q。
4.根据权利要求3所述的自动清洁机,其特征在于,该控制模块依据一第一运算式校正该方位角Q,校正后方位角Q=校正前方位角Q–偏差角度A。
5.根据权利要求3所述的自动清洁机,其特征在于,该控制模块依据一第二运算式校正该方位角Q,校正后方位角Q=校正前方位角Q–校正角度a,并且该偏差角度A大于该校正角度a。
6.根据权利要求1或2所述的自动清洁机,其特征在于,
该控制模块更使该自动清洁机旋转一预定角度G后,再控制该行走装置以使该自动清洁机从该第二位置移动至一第三位置;于该自动清洁机旋转该预定角度G后,利用该距离感测器,在多个相异的时间点t,求得该自动清洁机与该墙面间的多个间距Y1(t);于该自动清洁机旋转该预定角度G后,在该些相异时间点t,计算出该行走装置的多个行走距离X1(t);在该第三位置时,根据该些间距Y1(t)及该些行走距离X1(t),求得该自动清洁机的行走方向与该墙面的延伸方向间的一偏差角度A1;并且根据该偏差角度A及该偏差角度A1来校正该陀螺仪的常数K。
7.一种自动清洁机的控制方法,其特征在于,适用于一自动清洁机,该自动清洁机包含一距离感测器、具有一陀螺仪的一控制模块及一行走装置,该控制方法包含:
使该自动清洁机从一第一位置移动至一第二位置;
利用该距离感测器,在多个相异的时间点t,求得该自动清洁机与一墙面间的多个间距Y(t);
在该些相异时间点t,计算出该行走装置的多个行走距离X(t);以及
在该第二位置时,根据该些间距Y(t)及该些行走距离X(t),求得该自动清洁机的行走方向与该墙面的延伸方向间的一偏差角度A。
8.根据权利要求7所述的自动清洁机的控制方法,其特征在于,该求得该偏差角度A的步骤包含:
对该些行走距离X(t)及该些间距Y(t),进行线性回归取得回归线L,并依据该回归线L求得该偏差角度A。
9.根据权利要求7或8所述的自动清洁机的控制方法,其特征在于,更包含:
利用该控制模块用以计算出一方位角Q,并且
再利用该控制模块根据该偏差角度A校正该方位角Q。
10.根据权利要求9所述的自动清洁机的控制方法,其特征在于,该根据该偏差角度A校正该方位角Q的步骤包含:
依据一运算式校正该方位角Q,该运算式为校正后方位角Q=校正前方位角Q–校正角度a,并且该偏差角度A大于该校正角度a。
11.根据权利要求9所述的自动清洁机的控制方法,其特征在于,该根据该偏差角度A校正该方位角Q的步骤包含:
判断是否为第一次校正;
若是第一次校正,依据一第一运算式校正该方位角Q,该第一运算式为校正后方位角Q=校正前方位角Q–该偏差角度A;
判断该偏差角度A是否小于一临界值Th;
若不是第一次校正且该偏差角度A小于一临界值Th,依据一第二运算式校正该方位角Q,该第二运算式为校正后方位角Q=校正前方位角Q–校正角度a,并且该偏差角度A大于该校正角度a;
若该偏差角度A大于一临界值Th,不校正该方位角Q。
12.根据权利要求7或8所述的自动清洁机的控制方法,其特征在于,更包含:
使该自动清洁机旋转一预定角度G;
使该自动清洁机从该第二位置移动至一第三位置;
于该使该自动清洁机旋转一预定角度G的步骤后,利用该距离感测器,在多个相异的时间点t,求得该自动清洁机与该墙面间的多个间距Y1(t);
于该使该自动清洁机旋转一预定角度G的步骤后,在该些相异时间点t,计算出该行走装置的多个行走距离X1(t);
在该第三位置时,根据该些间距Y1(t)及该些行走距离X1(t),求得该自动清洁机的行走方向与该墙面的延伸方向间的一偏差角度A1;以及
根据该偏差角度A及该偏差角度A1来校正该陀螺仪的常数K。
13.根据权利要求12所述的自动清洁机的控制方法,其特征在于,
该预定角度G为360度,
该使该自动清洁机从一第一位置移动至一第二位置的步骤,包含使该行走装置向前行走,而且
该使该自动清洁机从该第二位置移动至一第三位置的步骤,包含使该行走装置向后行走。
14.一种自动清洁机的控制方法,适用于一自动清洁机,其特征在于,该方法包含:
启动一自动清洁机,以使该自动清洁机寻找一启始点;
利用如权利要求9-11任一项所述的自动清洁机的控制方法,使该自动清洁机开始行走;
利用该自动清洁机的至少一距离感测器,在不同的时间点测得该自动清洁机的周围环境,以测得多个局部地图;
依据已测得的该些局部地图决定一弓字型轨迹,并依据该弓字型轨迹持续行走;以及
依据已测得的该些局部地图,以更新一地图信息,并将该地图信息存储于该自动清洁机的一存储器中。
15.根据权利要求14所述的自动清洁机的控制方法,其特征在于,更包含:
利用如权利要求12-13任一项所述的自动清洁机的控制方法,来校正该陀螺仪的常数K。
Applications Claiming Priority (6)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW106103119 | 2017-01-26 | ||
TW106103119 | 2017-01-26 | ||
TW106109150 | 2017-03-20 | ||
TW106109150 | 2017-03-20 | ||
TW106110983 | 2017-03-31 | ||
TW106110983A TWI634403B (zh) | 2017-01-26 | 2017-03-31 | 自動清潔機及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108354524A true CN108354524A (zh) | 2018-08-03 |
CN108354524B CN108354524B (zh) | 2020-08-14 |
Family
ID=59592963
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710304249.5A Active CN108354524B (zh) | 2017-01-26 | 2017-05-03 | 自动清洁机及其控制方法 |
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 (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112198876A (zh) * | 2020-09-28 | 2021-01-08 | 湖南格兰博智能科技有限责任公司 | 一种适用于扫地机器人的带地图全覆盖清扫模块化控制方法 |
CN112256011A (zh) * | 2019-07-05 | 2021-01-22 | 苏州宝时得电动工具有限公司 | 回归引导方法、回归引导装置、移动机器人及存储介质 |
CN113359766A (zh) * | 2021-07-05 | 2021-09-07 | 杭州萤石软件有限公司 | 一种移动机器人的移动控制方法、以及移动机器人 |
CN113966976A (zh) * | 2021-09-28 | 2022-01-25 | 安克创新科技股份有限公司 | 清洁机器人及用于控制清洁机器人行进的方法 |
CN114355871A (zh) * | 2020-09-30 | 2022-04-15 | 好样科技有限公司 | 一种自行走装置及其控制方法 |
CN114913223A (zh) * | 2021-02-09 | 2022-08-16 | 北京盈迪曼德科技有限公司 | 一种视觉扫地机正方向识别方法及系统 |
Families Citing this family (11)
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 |
KR102224638B1 (ko) | 2019-07-31 | 2021-03-05 | 엘지전자 주식회사 | 이동 로봇 및 그 제어방법 |
KR20210015595A (ko) * | 2019-07-31 | 2021-02-10 | 엘지전자 주식회사 | 이동 로봇 |
WO2021020681A1 (ko) | 2019-07-31 | 2021-02-04 | 엘지전자 주식회사 | 이동 로봇 |
KR102314535B1 (ko) * | 2019-07-31 | 2021-10-18 | 엘지전자 주식회사 | 이동로봇 |
CN113440049B (zh) * | 2020-03-25 | 2023-06-09 | 尚科宁家(中国)科技有限公司 | 一种清洁机器人及其控制方法 |
JP7495293B2 (ja) | 2020-07-31 | 2024-06-04 | アマノ株式会社 | 自律走行作業装置及びプログラム |
CN113455951B (zh) * | 2021-06-23 | 2022-05-27 | 中铁建工集团山东有限公司 | 一种适用于幕墙的自动化清洁系统 |
CN114001732A (zh) * | 2021-10-28 | 2022-02-01 | 山东大学 | 一种移动机器人仿形内壁行走导航方法及系统 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1535646A (zh) * | 2003-03-17 | 2004-10-13 | ������������ʽ���� | 自动行走式清扫机及其运转方法 |
CN1759797A (zh) * | 2004-10-12 | 2006-04-19 | 三星光州电子株式会社 | 机器人清洁器坐标修正方法及机器人清洁器系统 |
US20060217854A1 (en) * | 2005-03-24 | 2006-09-28 | Funai Electric Co., Ltd. | Travel device and self-propelled cleaner |
JP2010023950A (ja) * | 2008-07-16 | 2010-02-04 | Hitachi Ltd | 3次元物体認識システム及びそれを用いた棚卸システム |
CN102853832A (zh) * | 2011-06-29 | 2013-01-02 | 财团法人车辆研究测试中心 | 车辆动态惯性感测器学习校正方法及其装置 |
US20130206177A1 (en) * | 2012-02-09 | 2013-08-15 | Samsung Electronics Co., Ltd | Apparatus and method for controlling cleaning in robotic cleaner |
CN104061934A (zh) * | 2014-06-10 | 2014-09-24 | 哈尔滨工业大学 | 基于惯性传感器的行人室内位置跟踪方法 |
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 |
US6459955B1 (en) * | 1999-11-18 | 2002-10-01 | 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 |
ATE510247T1 (de) * | 2001-06-12 | 2011-06-15 | Irobot Corp | Verfahren und system zur multimodalen bedeckung für einen autonomen roboter |
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 | 엘지전자 주식회사 | 로봇 청소기의 자이로 오프셋 보정방법 |
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 | 삼성광주전자 주식회사 | 로봇 청소기의 자이로 센서 보정방법 |
AU2006284577B2 (en) * | 2005-09-02 | 2012-09-13 | Neato Robotics, Inc. | Multi-function robotic device |
JP2007286730A (ja) * | 2006-04-13 | 2007-11-01 | Funai Electric Co Ltd | 自走式掃除機 |
KR101281512B1 (ko) * | 2007-04-06 | 2013-07-03 | 삼성전자주식회사 | 로봇청소기 및 그 제어방법 |
US8961695B2 (en) * | 2008-04-24 | 2015-02-24 | Irobot Corporation | Mobile robot for cleaning |
EP2323890B1 (de) * | 2008-09-10 | 2012-09-05 | Continental Teves AG & Co. oHG | Verfahren zur lenkunterstützung bei notmanöver |
TW201035710A (en) * | 2009-03-30 | 2010-10-01 | Yan cheng xiang | Edge following movement device |
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 |
CN102354436B (zh) * | 2011-07-12 | 2013-05-08 | 深圳市卡琳娜机器人软件开发有限公司 | 室内安防巡逻机器人系统的报警方法 |
KR101887055B1 (ko) * | 2011-11-14 | 2018-09-11 | 삼성전자주식회사 | 로봇 청소기 및 그 제어 방법 |
TWI491374B (zh) * | 2012-03-22 | 2015-07-11 | Ememe Robot Co Ltd | 清潔機器人及控制清潔機器人沿障礙物行走的方法 |
CN103376801B (zh) * | 2012-04-13 | 2016-08-03 | 科沃斯机器人有限公司 | 自移动地面处理机器人及其清洁工作的控制方法 |
JP6076852B2 (ja) * | 2013-07-11 | 2017-02-08 | 株式会社 日立産業制御ソリューションズ | カメラシステム、その制御方法およびその制御プログラム |
WO2015105712A1 (en) * | 2014-01-10 | 2015-07-16 | Irobot Corporation | Autonomous mobile robot |
US9630319B2 (en) * | 2015-03-18 | 2017-04-25 | Irobot Corporation | Localization and mapping using physical features |
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 | 小米科技有限责任公司 | 自动清洁设备 |
CN105606101B (zh) * | 2015-12-21 | 2018-07-17 | 北京航天科工世纪卫星科技有限公司 | 一种基于超声波测量的机器人室内导航方法 |
CN205681138U (zh) * | 2015-12-21 | 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 |
---|---|---|---|---|
CN1535646A (zh) * | 2003-03-17 | 2004-10-13 | ������������ʽ���� | 自动行走式清扫机及其运转方法 |
CN1759797A (zh) * | 2004-10-12 | 2006-04-19 | 三星光州电子株式会社 | 机器人清洁器坐标修正方法及机器人清洁器系统 |
US20060217854A1 (en) * | 2005-03-24 | 2006-09-28 | Funai Electric Co., Ltd. | Travel device and self-propelled cleaner |
JP2010023950A (ja) * | 2008-07-16 | 2010-02-04 | Hitachi Ltd | 3次元物体認識システム及びそれを用いた棚卸システム |
CN102853832A (zh) * | 2011-06-29 | 2013-01-02 | 财团法人车辆研究测试中心 | 车辆动态惯性感测器学习校正方法及其装置 |
US20130206177A1 (en) * | 2012-02-09 | 2013-08-15 | Samsung Electronics Co., Ltd | Apparatus and method for controlling cleaning in robotic cleaner |
CN104061934A (zh) * | 2014-06-10 | 2014-09-24 | 哈尔滨工业大学 | 基于惯性传感器的行人室内位置跟踪方法 |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112256011A (zh) * | 2019-07-05 | 2021-01-22 | 苏州宝时得电动工具有限公司 | 回归引导方法、回归引导装置、移动机器人及存储介质 |
CN112256011B (zh) * | 2019-07-05 | 2022-05-17 | 苏州宝时得电动工具有限公司 | 回归引导方法、回归引导装置、移动机器人及存储介质 |
CN112198876A (zh) * | 2020-09-28 | 2021-01-08 | 湖南格兰博智能科技有限责任公司 | 一种适用于扫地机器人的带地图全覆盖清扫模块化控制方法 |
CN112198876B (zh) * | 2020-09-28 | 2023-10-03 | 湖南格兰博智能科技有限责任公司 | 一种适用于扫地机器人的带地图全覆盖清扫模块化控制方法 |
CN114355871A (zh) * | 2020-09-30 | 2022-04-15 | 好样科技有限公司 | 一种自行走装置及其控制方法 |
CN114355871B (zh) * | 2020-09-30 | 2024-10-18 | 北京牛特机器人科技有限公司 | 一种自行走装置及其控制方法 |
CN114913223A (zh) * | 2021-02-09 | 2022-08-16 | 北京盈迪曼德科技有限公司 | 一种视觉扫地机正方向识别方法及系统 |
CN113359766A (zh) * | 2021-07-05 | 2021-09-07 | 杭州萤石软件有限公司 | 一种移动机器人的移动控制方法、以及移动机器人 |
CN113359766B (zh) * | 2021-07-05 | 2023-06-23 | 杭州萤石软件有限公司 | 一种移动机器人的移动控制方法、以及移动机器人 |
CN113966976A (zh) * | 2021-09-28 | 2022-01-25 | 安克创新科技股份有限公司 | 清洁机器人及用于控制清洁机器人行进的方法 |
CN113966976B (zh) * | 2021-09-28 | 2023-09-22 | 安克创新科技股份有限公司 | 清洁机器人及用于控制清洁机器人行进的方法 |
Also Published As
Publication number | Publication date |
---|---|
EP3354180B1 (en) | 2020-05-06 |
TW201827968A (zh) | 2018-08-01 |
JP2018120572A (ja) | 2018-08-02 |
EP3354180A1 (en) | 2018-08-01 |
CN108354524B (zh) | 2020-08-14 |
RU2017131719A (ru) | 2019-03-11 |
TWI634403B (zh) | 2018-09-01 |
US20180206688A1 (en) | 2018-07-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108354524A (zh) | 自动清洁机及其控制方法 | |
US20240241522A1 (en) | Localization and mapping using physical features | |
CN1535646A (zh) | 自动行走式清扫机及其运转方法 | |
US9481982B1 (en) | Method and control system for surveying and mapping a terrain while operating a bulldozer | |
US20150157182A1 (en) | Mobile robot and operating method thereof | |
EP3018603B1 (en) | Adaptive mapping with spatial summaries of sensor data | |
JP4788722B2 (ja) | 自律移動ロボット、自己位置推定方法、環境地図の生成方法、環境地図の生成装置、及び環境地図のデータ構造 | |
US20060167648A1 (en) | 3-Dimensional measurement device and electronic storage medium | |
JP2007213236A (ja) | 自律走行ロボットの経路計画方法及び自律走行ロボット | |
CN104302453A (zh) | 使用差动传感器或视觉测量的地毯偏移估计 | |
JP2017215240A (ja) | 測定装置及び測量システム | |
JP6893200B2 (ja) | 自走制御プログラム、および、自走式作業装置 | |
US11326879B2 (en) | Inclinometer-based surface profilometry | |
CN114355871A (zh) | 一种自行走装置及其控制方法 | |
CN114305202B (zh) | 一种自行走装置及其控制方法 | |
CN117452924A (zh) | 一种机器人找直线方法及行走方向的调整方法 | |
JP2022190894A (ja) | 走行用地図作成装置、自走式ロボットシステム、走行用地図作成方法、及び、プログラム | |
CN117434935A (zh) | 基于tof模块的机器人寻找障碍物方法、芯片及机器人 | |
WO2019085526A1 (zh) | 面向三维空间的定位校正方法、组合定位方法及其设备 | |
CN117434934A (zh) | 一种基于tof模块的机器人运动控制方法 | |
CN117434548A (zh) | 基于多点tof模块的障碍物识别方法、芯片及机器人 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right |
Effective date of registration: 20240719 Address after: 4th Floor, Longyuan Tonghui Building, No. 1111 Huihe South Street, Chaoyang District, Beijing Patentee after: Beijing bovine Robot Technology Co.,Ltd. Country or region after: China Address before: Hsinchu County, Taiwan, China Patentee before: HOBOT TECH Inc. Country or region before: TaiWan, China |
|
TR01 | Transfer of patent right |