CN109497889A - 一种悬崖检测方法、装置、设备及机器人 - Google Patents
一种悬崖检测方法、装置、设备及机器人 Download PDFInfo
- Publication number
- CN109497889A CN109497889A CN201811160482.1A CN201811160482A CN109497889A CN 109497889 A CN109497889 A CN 109497889A CN 201811160482 A CN201811160482 A CN 201811160482A CN 109497889 A CN109497889 A CN 109497889A
- Authority
- CN
- China
- Prior art keywords
- light
- unit
- steep cliff
- parameter
- detection
- 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
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/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/4002—Installations of electric equipment
- A47L11/4008—Arrangements of switches, indicators or the like
-
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
-
- 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
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Optical Communication System (AREA)
- Investigating Or Analysing Materials By Optical Means (AREA)
Abstract
本发明提供一种悬崖检测方法,该悬崖检测方法包括:控制所述光收发装置进入强光检测模式、弱光检测模式或者普通光检测模式;若进入强光检测模式,检测所述光收发装置当前产生的第一光参数,以及根据所述第一光参数和第一阈值判断出是否存在悬崖;若进入弱光检测模式,检测所述光收发装置当前产生的第二光参数,以及根据所述第二光参数和第二阈值判断出是否存在悬崖;若进入普通光检测模式,检测所述光收发装置当前产生的第三光参数,以及根据所述第三光参数和第三阈值判断出是否存在悬崖。本发明提供的悬崖检测方法,能够在多种光环境下实现悬崖检测,不受环境光光影响。本发明还提供一种悬崖检测装置、设备以及机器人。
Description
技术领域
本发明涉及智能机器人技术领域,尤其涉及一种悬崖检测方法、装置、设备及机器人。
背景技术
清洁机器人是为人类服务的特种机器人,主要从事家庭卫生的清扫、清洗等清洁工作。随着人工智能的发展,清洁机器人增加了智能避障、自救防卡死、自动充电、自主导航路径规划等功能,使得清洁机器人智能化程度大幅提升,整个清洁过程不需要人控制,大大解放了人们的双手,清洁过程省时省力,越来越受到年轻人青睐。
然而在强光和吸光环境中的悬崖检测依然是清洁机器人所要面对的一大难题,现有技术中,清洁机器人领域悬崖检测的方法有很多种。常见的方案有以下几种:
基于测距方法的悬崖检测方案,常见的测距方法有TOF测距、三角测距、超声波测距等等。这类型方案的优点是不受环境光的影响,极大得提升了悬崖检测的稳定性,但其缺点也十分突出,那就是成本高。
基于反射光量的悬崖检测方案,该方案使用由发射管2和接收管3组成的对管来构成悬崖检测模块4,如图1所示。
模块安装4在机器(图未示)下方,通过接收主光轴的反射光量来实现悬崖检测。当离地距离位于ABCD构成的四边形区域内,接收管3可以接收到反射回来的光。当离地距离为主光轴交点(F)时,接收管接收到的光量最大(DataMax)。当接收到的数据在DataMax±误差范围以外时,则认为检测到悬崖,此时执行相应躲避策略。此方案优点是,成本低且实现简单,但其容易收到环境光影响。
在强光环境下,接收管3容易饱和,在吸光环境下,接收到反射光量少,这两种环境都会使模块失去检测能力。
发明内容
本发明实施例提供一种基于反射光量的悬崖检测方法、装置、设备及机器人,可以避免环境光影响,提高检测准确性。
本发明实施例第一方面提供一种悬崖检测方法,利用光收发装置实现扫地机检测悬崖,光收发装置用于发射光和接收光,所述悬崖检测方法包括:
控制所述光收发装置进入强光检测模式、弱光检测模式或者普通光检测模式,其中,在不同的检测模式下,所述光收发装置的光接收饱和值不同;
若进入强光检测模式,检测所述光收发装置当前产生的第一光参数,以及根据所述第一光参数和第一阈值判断出是否存在悬崖,其中,所述第一光参数为所述光收发装置根据当前接收到的光所产生的,所述第一光参数至少包括当前环境光的参数;
若进入弱光检测模式,检测所述光收发装置当前产生的第二光参数,以及根据所述第二光参数和第二阈值判断出是否存在悬崖,其中,所述第二参数为所述光收发装置根据当前接收到的光所产生的,所述第二光参数至少包括反射光的参数;所述反射光为所述发射光经反射回来的光;
若进入普通光检测模式,检测所述光收发装置当前产生的第三光参数,以及根据所述第三光参数和第三阈值判断出是否存在悬崖,其中,所述第三光参数为所述光收发装置根据当前接收到的光所产生的,所述第三光参数为所述反射光的参数。
本发明实施例第二方面提供一种悬崖检测装置,利用光收发装置实现扫地机检测悬崖,所述光收发装置用于发射光和接收光,所述悬崖检测装置包括存储单元和处理单元,所述存储单元用于存储计算机程序,所述处理单元用于执行所述计算程序实现上述悬崖检测方法。
本发明实施例第三方面提供一种悬崖检测设备,包括光收发装置和悬崖检测装置,所述光收发装置用于发射光和接收光,所述悬崖检测装置包括存储单元和处理单元,所述存储单元用于存储计算机程序,所述处理单元用于执行所述计算程序实现上述悬崖检测方法。
本发明实施例第四方面提供一种智能机器人,智能机器人包括主体以及如上述悬崖检测设备,所述悬崖检测设备设置于所述主体。
本发明实施例可以控制光收发装置选择进入不同的检测模式,避免光收发装置受环境影响检测准确性。
附图说明
图1为现有技术中悬崖检测模块4的结构示意图。
图2为本发明第一实施例的机器人结构示意图。
图3为本发明第一实施例的机器人功能模块图。
图4为本发明第一实施例的机器人的电路结构示意图。
图5为本发明第一实施例悬崖检测装置的结构示意图。
图6为本发明第一实施例悬崖检测方法的流程示意图。
图7为本发明第一实施例悬崖检测方法的子流程示意图。
图8为本发明第一实施例悬崖检测方法的另一子流程示意图。
图9为本发明第二实施例悬崖检测方法的流程示意图。
具体实施方式
本发明实施例提供一种光收发装置进行悬崖检测的悬崖检测方法、装置、设备及机器人。本发明实施例可以根据当前的环境控制光收发装置选择进入不同的检测模式,避免光收发装置受环境影响检测准确性。
请参看图1和图2,智能机器人99包括主体10和设置于主体10的悬崖检测设备20。主体10的底部11设有滑轮(图中未示出),以驱动所述智能机器人在地面上移动。悬崖检测设备20包括悬崖检测装置21和光收发装置22。光收发装置22设置于底部11。悬崖检测装置21执行悬崖检测方法并利用光收发装置22进行悬崖检测功能,从而防止智能机器人99翻倒、跌落等。在本实施例中,智能机器人99为智能扫地机机器人或者其他类似结构的智能玩具机器人。悬崖检测装置21为但不限于单片机或者集成芯片。其中,悬崖检测装置21和光收发装置22可以集成于一体,也可以设置为两个独立的模块。在本实施中,悬崖检测装置21可以包括一个单片机或者一个集成芯片;或者也可以包括多个单片机或者多个集成芯片;或者也可以包括一个或者多个单片机和一个或者多个集成芯片组合。
光收发装置22用于发射光和接收光,并根据接收的光产生电信号。该电信号用于表示光收发装置22接收光的强弱。光收发装置22还用于提供三种检测模式:强光检测模式、弱光检测模式和普通光检测模式。悬崖检测装置21控制光收发装置22进入相应的检测模式进行检测。在一些可行的实施例中,悬崖检测装置21根据用户的选择控制光收发装置22进入相应的检测模式或者检测当前环境光并根据检测结果控制光收发装置22进入相应的检测模式;悬崖检测装置21还用于根据光收发装置22在相应的检测模式下产生的电信号检测是否存在悬崖。
具体地,请结合参看图3和图4,光收发装置22包括光发射装置220和光接收装置221。光发射装置220用于发射光。光发射装置220包括但不限于发光二极管2201,用于发射光。在一些可行的实施例中,光发射装置220可以发射激光或者是红外光。其中,发光二极管2201的正极电性通过上拉电阻Ra电性连接于电源VCC。发光二极管2201负极电性连接至悬崖检测装置21。
具体地,请参看图4,光接收装置221包括光接收管2210和电连接于光接收管2210的电阻切换模组2212。光接收管2210用于接收光并根据接收到的光转换为电信号。光接收管2210接收的光包括环境光和/或光发射装置220发射的光经地面反射后的反射光。在本实施例中,光接收管2210包括但不限于三极管。电阻切换模组2212用于提供不同阻值的电阻接入接收管2210以使得光接收管2210具有三种检测模式。电阻切换模组2212包括第一电阻R0、第二电阻R1、第三电阻R2、第一电子开关S1以及第二电子开关S2。
光接收管2210的集电极通过上拉电阻Rb电性连接电源VCC。光接收管2210的发射极电性连接于第一电阻R0、第二电阻R1及第三电阻R2。光接收管2210的基极与悬崖检测装置21电性连接。第一电阻R0接地。第二电阻R1和第三电阻R2分别通过第一电子开关S1以及第二电子开关S2接地,第一电子开关S1以及第二电子开关S2电连接第二电阻R1和第三电阻R2的一端还电性连接于悬崖检测装置21。在本实施例中,第二电阻R1及第三电阻R2。第一电子开关S1以及第二电子开关S2可以为但不限于开关晶闸管、晶体管、场效应管或者继电器。在一些可行的实施例方式中,光接收装置221还可以省略第一电子开关S1以及第二电子开关S2开关,直接将第二电阻R1和第三电阻R2连接至悬崖检测装置21,通过悬崖检测装置21实现第二电阻R1和第三电阻R2的接入或者断开,即在悬崖检测装置21形成相应的电子开关与第二电阻R1和第三电阻R2电性连接。
若第一电子开关S1以及第二电子开关S2皆断开,第一电阻R0与接收管2210电性连接,此时,光收发装置22进入普通光检测模式。若第一电子开关S1闭合,第二电子开关S2断开,第一电阻R0和第二电阻R1并联后与光接收管2210电性连接,此时,光收发装置22进入强光检测模式。若第一电子开关S1断开,第二电子开关S2闭合,第一电阻R0和第三电阻R2并联后与光接收管2210电性连接,此时,光收发装置22进入弱光检测模式。可以理解地,在强光检测模式下,光收发收装置22接入一电阻R0和第二电阻R1,即电阻阻值相对较小,因此,光接收装置221的光接收饱和值也最大,可以用于接收强度较强的光。在弱检测模式下,光收发收装置22接入第一电阻R0和第三电阻R2,即电阻阻值相对较大,光接收装置221的光接收饱和值最小,可以用于接收强度较弱的光,即灵敏度较好。因此,强光检测模式适合强光环境,即光强度较强的环境;若光检测模式适合弱光环境,即光强度较弱的环境;普通光检测模式适合普通光环境,即光强度介于强光环境和弱光环境的光强度之间的环境。
在一些可行的实施方式中,光收发装置22在初始状态处于普通光检测模式,即第一电子开关S1以及第二电子开关S2在初始状态处于断开状态。在一些可行的实施例中,第一电子开关S1或者第二电子开关S2在初始状态处于闭合状态,或者第一电子开关S1以及第二电子开关S2在初始状态处于闭合状态。在本实施例中,第一电子开关S1以及第二电子开关S2在初始状态皆处于断开状态。光发射装置220处于关闭状态,即光发射装置220处于非发光状态。
悬崖检测装置21用于控制光收发装置22接入相应的电阻,以控制光收发装置22进入相应的检测模式。悬崖检测装置21还用于控制光发射装置220发射光和关闭光发射装置220发射光以使光收发装置22处于发光状态和非发光状态。
请结合参看图5至图7,图5为本发明第一实施例提供的悬崖检测装置21的结构示意图,图6为本发明第一实施例提供悬崖检测方法的流程图,图7为本发明第一实施例提供悬崖检测方法的子流程图。悬崖检测装置21包括处理器500和存储器600。存储器600用于存储计算机程序。处理器500用于执行该计算机程序实现悬崖检测方法。
步骤S601,控制光收发装置22进入强光检测模式、弱光检测模式或者普通光检测模式,其中,光收发装置22在强光检测模式、弱光检测模式或者普通光检测模式下的光接收饱和度或者电流饱和度不同。具体地,控制光收发装置22进入强光检测模式即控制光收发装置22发光,并控制第一电子开关S1闭合,第二电子开关S2断开;控制光收发装置22进入弱光检测模式,即控制光收发装置22发光,并控制第一电子开关S1断开,第二电子开关S2闭合;控制光收发装置22进入普通光检测模式,即控制光收发装置22发光,并控制第一电子开关S1和第二电子开关S2断开。在一些可行的实施例中,在机器人99设置若干检测模式选择的实体按键或者软按键,以供用户根据当前环境选择匹配的检测模式并产生模式选择指令。因此,控制光收发装置22进入强光检测模式、弱光检测模式或者普通光检测模式具体包括:若接收到模式选择指令,根据模式选择指令选择控制光收发装置22进入强光检测模式、弱光检测模式或者普通光检测模式。如图7所示,在一些可行的实施例中,悬崖检测方法还可以自动识别出跟当前环境匹配的检测模式并控制光收发装置22进入相应的检测模式。因此,控制光收发装置22进入强光检测模式、弱光检测模式或者普通光检测模式具体包括:步骤S6010,检测环境光;步骤S6012,根据检测结果控制光收发装置22进入强光检测模式、弱光检测模式或者普通光检测模式。
步骤S603,若进入强光检测模式,检测光收发装置22产生的第一光参数,以及根据第一光参数和第一阈值判断出是否存在悬崖,其中,第一光参数是光收发装置22根据当前接收到的光所产生的,即第一光参数包括环境光参数和发射光经反射回来的反射光参数。若检测到第一光参数小于第一阈值,可以判断出存在悬崖。反之,不存在悬崖。可以理解地,由于在强光检测模式用于强光环境下进行检测,光收发装置22接收到的光近似于环境光,即光收发装置22产生的发生发射光可以忽略不计。在一些可行的实施例中,还可以利用环境光与第一阈值进行比较也可检测出是否存在悬崖。即在强光检测模式下还可以控制光收发装置22不发光,即关闭光发射装置220,从而可以使得光收发装置22仅接收到环境光的光线。因此,第一光参数可以包括当前环境光参数和/反射光参数。
步骤S605,若进入弱光检测模式,检测光收发装置22产生的第二光参数,以及根据第二光参数和第二阈值判断出是否存在悬崖。其中,第二光参数是光收发装置22根据当前接收到的光所产生的,即第二光参数包括环境光参数和发射光经反射回来的反射光参数。若检测到第二光参数小于第二阈值,可以判断出存在悬崖。反之,不存在悬崖。可以理解地,由于在弱光检测模式用于弱光环境下进行检测,光收发装置22接收到的光近似于反射光,即环境光可以忽略不计,在一些可行的实施例中,还可以利用第一光参数中的反射光参数与第一阈值进行比较检测出是否存在悬崖。因此,第二光参数可以包括当前环境光参数和/反射光参数。优选地,第二阈值小于第一阈值。
步骤S607,若进入普通光检测模式,检测光收发装置22产生的第三光参数,以及根据第三光参数和第三阈值判断出是否存在悬崖。若检测到第三光参数小于第三阈值,可以判断出存在悬崖。其中,第三光参数是光收发装置22根据当前接收到反射光所产生的。即第三光参数为反射光参数。具体地,检测光收发装置22在发光和非发光状态下产生的参数,根据发光和非发光状态下产生参数进行差值计算,即可算出发射光参数。其中,第三阈值小于第一阈值大于第二阈值。
上述实施例的悬崖检测方法可以控制光收发装置选择进入不同的光检测模式,可以在不同环境进行检测,避免光收发装置受环境光影响检测准确性。
请参看图8,在一些可行的实施例中,控制光收发装置22进入强光检测模式、弱光检测模式或者普通光检测模式是根据环境光进行控制的。具体地,该悬崖检测方法还包括检测环境光流程400。检测环境光流程400包括下面步骤。
步骤S401,控制光收发装置22进入普通光模式。
步骤S403,在光收发装置22处于非发光状态下,获取光收发装置22根据接收的光产生的环境光参数。
步骤S405,在光收发装置22处于发光状态下,获取光收发装置22根据接收的光产生的混合光参数。
步骤S407,判断环境光参数是否大于强光阈值。若环境光参数大于阈值进入步骤S409,反之进入步骤S411。
步骤S409,识别出当前环境为强光环境。
步骤S411,判断混合参数是否小于吸光阈值。若混合光参数小于吸光阈值,进入步骤S413,反之进入步骤S415。
步骤S413,识别出当前环境光为弱光环境。
步骤S415,识别出当前环境为普通光模式。
上述实施例的悬崖检测方法可以利用光收发装置22检测当前的环境光。在一些可行的实施例中,悬崖检测方法还可以利用现有其他具有环境光检测功能的设备,例如光传感器,来检测环境光,从而识别出强光环境、弱光环境或者普通光环境。
请结合参看图9,其为第二实施例的悬崖检测方法流程图。处理器500用于执行该计算机程序实现该悬崖检测方法。该悬崖检测方法包括下面步骤。
步骤S801,控制光收发装置22进入普通光模式。
步骤S803,在光收发装置22处于非发光状态下,获取光收发装置根据接收的光产生的环境光参数。
步骤S805,在光收发装置22处于发光状态下,获取光收发装置根据接收的光产生的混合光参数。
步骤S807,判断环境光参数是否大于强光阈值。若环境光参数大于阈值进入步骤S809,反之进入步骤S813。
步骤S809,切换光收发装置为强光检测模式。
步骤S811,检测强光模式下光收发装置22产生的第一光参数,以及根据第一光参数和第一阈值判断出是否存在悬崖,其中,第一光参数是光收发装置22根据当前接收到的光所产生的,即第一光参数包括环境光参数和发射光经反射回来的反射光参数。若检测到第一光参数小于第一阈值,可以判断出存在悬崖。反之,不存在悬崖。可以理解地,由于在强光检测模式用于强光环境下进行检测,光收发装置22接收到的光近似于环境光,即光收发装置22产生的发生发射光可以忽略不计。在一些可行的实施例中,还可以利用环境光与第一阈值进行比较也可检测出是否存在悬崖。即在强光检测模式下还可以控制光收发装置22不发光,即关闭光发射装置220,从而可以使得光收发装置22仅接收到环境光的光线。因此,第一光参数可以包括当前环境光参数和/反射光参数。
步骤S813,判断混合光参数是否小于吸光阈值。若混合光参数小于吸光阈值,进入步骤S815,反之进入步骤S819。
步骤S815,切换光收发装置22为弱光检测模式。
步骤S817,检测强光模式下光收发装置22产生的第二光参数,以及根据第一光参数和第一阈值判断出是否存在悬崖,其中,第二光参数是光收发装置22根据当前接收到的光所产生的,即第二光参数包括环境光参数和发射光经反射回来的反射光参数。若检测到第二光参数小于第二阈值,可以判断出存在悬崖。反之,不存在悬崖。可以理解地,由于在弱光检测模式用于弱光环境下进行检测,光收发装置22接收到的光近似于反射光,即环境光可以忽略不计,在一些可行的实施例中,还可以利用第二光参数中的反射光参数与第一阈值进行比较检测出是否存在悬崖。因此,第二光参数可以包括当前环境光参数和/反射光参数。优选地,第二阈值小于第一阈值。
步骤S819,根据混合光参数和环境光参数计算出第三光参数,以及根据第三光参数和第三阈值判断出是否存在悬崖。具体地,若第三光参数小于第三阈值,判断存在悬崖,反之不存在悬崖。其中,在本实施例中,第三阈值小于第一阈值大于第二阈值。
上述实施例的悬崖检测方法可以根据当前的环境光控制光收发装置选择进入不同的光检测模式,避免光收发装置受环境影响检测准确性。
请再次参看图6和图7,该悬崖检测方法用于利用光收发装置实现悬崖检测。其中光收发装置提供若干不同检测模式。检测模式包括强光检测模式、弱光检测模式和普通光检测模式。光收发装置包括光发射装置和光接收装置。光发射装置用于发射光。光接收装置用于接收光。在不同的检测模式下,光接收装置接收的光饱和值不同。强光检测模式适合强光环境,即光强度较强的环境;若光检测模式适合弱光环境,即光强度较弱的环境;普通光检测模式适合普通光环境,即光强度介于强光环境和弱光环境的光强度之间的环境。该悬崖检测方法包括下面步骤。
步骤S601,控制光收发装置进入强光检测模式、弱光检测模式或者普通光检测模式,其中,光收发装置在强光检测模式、弱光检测模式或者普通光检测模式下的光接收饱和度或者电流饱和度不同。在一些可行的实施例中,该悬崖检测方法可通过若干检测模式选择的实体按键或者软按键,以供用户根据当前环境选择匹配的检测模式并产生模式选择指令。因此,控制光收发装置进入强光检测模式、弱光检测模式或者普通光检测模式具体包括:若接收到模式选择指令,根据模式选择指令选择控制光收发装置进入强光检测模式、弱光检测模式或者普通光检测模式。如图7所示,在一些可行的实施例中,悬崖检测方法还可以自动识别出跟当前环境匹配的检测模式并控制光收发装置进入相应的检测模式。因此,控制光收发装置进入强光检测模式、弱光检测模式或者普通光检测模式具体包括:步骤S6010,检测环境光;步骤S6012,根据检测结果控制光收发装置进入强光检测模式、弱光检测模式或者普通光检测模式。
步骤S603,若进入强光检测模式,检测光收发装置产生的第一光参数,以及根据第一光参数和第一阈值判断出是否存在悬崖,其中,第一光参数是光收发装置根据当前接收到的光所产生的,即第一光参数包括环境光参数和发射光经反射回来的反射光参数。若检测到第一光参数小于第一阈值,可以判断出存在悬崖。反之,不存在悬崖。可以理解地,由于在强光检测模式用于强光环境下进行检测,光收发装置接收到的光近似于环境光,即光收发装置产生的发生发射光可以忽略不计。在一些可行的实施例中,还可以利用环境光与第一阈值进行比较也可检测出是否存在悬崖。即在强光检测模式下还可以控制光收发装置不发光,从而可以使得光收发装置仅接收到环境光的光线。因此,第一光参数可以包括当前环境光参数和/反射光参数。
步骤S605,若进入弱光检测模式,检测光收发装置产生的第二光参数,以及根据第二光参数和第二阈值判断出是否存在悬崖。其中,第二光参数是光收发装置根据当前接收到的光所产生的,即第二光参数包括环境光参数和发射光经反射回来的反射光参数。若检测到第二光参数小于第二阈值,可以判断出存在悬崖。反之,不存在悬崖。可以理解地,由于在弱光检测模式用于弱光环境下进行检测,光收发装置接收到的光近似于反射光,即环境光可以忽略不计,在一些可行的实施例中,还可以利用第一光参数中的反射光参数与第一阈值进行比较检测出是否存在悬崖。因此,第二光参数可以包括当前环境光参数和/反射光参数。优选地,第二阈值小于第一阈值。
步骤S607,若进入普通光检测模式,检测光收发装置产生的第三光参数,以及根据第三光参数和第三阈值判断出是否存在悬崖。若检测到第三光参数小于第三阈值,可以判断出存在悬崖。其中,第三光参数是光收发装置22根据当前接收到反射光所产生的。即第三光参数为反射光参数。具体地,检测光收发装置在发光和非发光状态下产生的参数,根据发光和非发光状态下产生参数进行差值计算,即可算出发射光参数。其中,第三阈值小于第一阈值大于第二阈值。
请再次参看图8,在一些可行的实施例中,控制光收发装置进入强光检测模式、弱光检测模式或者普通光检测模式是根据环境光进行控制的。具体地,该悬崖检测方法还包括检测环境光流程400。检测环境光流程400包括下面步骤。
步骤S401,控制光收发装置进入普通光模式。
步骤S403,在光收发装置处于非发光状态下,获取光收发装置根据接收的光产生的环境光参数。
步骤S405,在光收发装置处于发光状态下,获取光收发装置根据接收的光产生的混合光参数。
步骤S407,判断环境光参数是否大于强光阈值。若环境光参数大于阈值进入步骤S409,反之进入步骤S411。
步骤S409,识别出当前环境为强光环境。
步骤S411,判断混合参数是否小于吸光阈值。若混合光参数小于吸光阈值,进入步骤S413,反之进入步骤S415。
步骤S413,识别出当前环境光为弱光环境。
步骤S415,识别出当前环境为普通光模式。
请再次参看图9,其为本发明第二实施例提供的一种悬崖检测方法。该悬崖检测方法利用光收发装置实现悬崖检测。具体地,该悬崖检测方法包括如下步骤。
步骤S801,控制光收发装置进入普通光模式。
步骤S803,在光收发装置处于非发光状态下,获取光收发装置根据接收的光产生的环境光参数。
步骤S805,在光收发装置处于发光状态下,获取光收发装置根据接收的光产生的混合光参数。
步骤S807,判断环境光参数是否大于强光阈值。若环境光参数大于阈值进入步骤S809,反之进入步骤S813。
步骤S809,切换光收发装置为强光检测模式。
步骤S811,检测强光模式下光收发装置根据接收的光产生的第一光参数,以及根据第一光参数和第一阈值判断出是否存在悬崖,其中,第一光参数是光收发装置22根据当前接收到的光所产生的,即第一光参数包括环境光参数和发射光经反射回来的反射光参数。若检测到第一光参数小于第一阈值,可以判断出存在悬崖。反之,不存在悬崖。可以理解地,由于在强光检测模式用于强光环境下进行检测,光收发装置22接收到的光近似于环境光,即光收发装置22产生的发生发射光可以忽略不计。在一些可行的实施例中,还可以利用环境光与第一阈值进行比较也可检测出是否存在悬崖。即在强光检测模式下还可以控制光收发装置22不发光,即关闭光发射装置220,从而可以使得光收发装置22仅接收到环境光的光线。因此,第一光参数可以包括当前环境光参数和/反射光参数。
步骤S813,判断混合光参数是否小于吸光阈值。若混合光参数小于吸光阈值,进入步骤S815,反之进入步骤S819。
步骤S815,切换光收发装置为弱光检测模式。
步骤S817,检测强光模式下光收发装置产生的第二光参数,以及根据第一光参数和第一阈值判断出是否存在悬崖,其中,第二光参数是光收发装置22根据当前接收到的光所产生的,即第二光参数包括环境光参数和发射光经反射回来的反射光参数。若检测到第二光参数小于第二阈值,可以判断出存在悬崖。反之,不存在悬崖。可以理解地,由于在弱光检测模式用于弱光环境下进行检测,光收发装置22接收到的光近似于反射光,即环境光可以忽略不计,在一些可行的实施例中,还可以利用第一光参数中的反射光参数与第一阈值进行比较检测出是否存在悬崖。因此,第二光参数可以包括当前环境光参数和/反射光参数。优选地,第二阈值小于第一阈值。
步骤S819,根据混合光参数和环境光参数计算出第三光参数,以及根据第三光参数和第三阈值判断出是否存在悬崖。具体地,若第三光参数小于第三阈值,判断存在悬崖,反之不存在悬崖。其中,在本实施例中,第三阈值小于第一阈值大于第二阈值。
上述实施例的悬崖检测方法可以根据当前的环境光控制光收发装置选择进入不同的光检测模式,避免光收发装置受环境影响检测准确性。
另外,本发明实施例还提供了一种计算机存储介质,该计算机存储介质可存储有程序,该程序执行时可运行本发明实施例所述的方法的部分或全部步骤。具体实现中,本发明实施例的计算机存储介质包括:RAM、ROM、EEPROM、闪存、CD-ROM、DVD或其他光存储器,磁带、磁盘或其他磁存储器,或者其他任何可以用于存储所需信息并可被计算机设备所访问的介质。
显然,本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样,倘且本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内,则本发明也意图包含这些改动和变型在内。
以上所列举的仅为本发明较佳实施例而已,当然不能以此来限定本发明之权利范围,因此依本发明权利要求所作的等同变化,仍属本发明所涵盖的范围。
Claims (10)
1.一种悬崖检测方法,利用光收发装置实现悬崖检测,光收发装置用于发射光和接收光,其特征在于,所述悬崖检测方法包括:
控制所述光收发装置进入强光检测模式、弱光检测模式或者普通光检测模式,其中,在不同的检测模式下,所述光收发装置的光接收饱和值不同;
若进入强光检测模式,检测所述光收发装置当前产生的第一光参数,以及根据所述第一光参数和第一阈值判断出是否存在悬崖,其中,所述第一光参数为所述光收发装置根据当前接收到的光所产生的,所述第一光参数至少包括当前环境光的参数;
若进入弱光检测模式,检测所述光收发装置当前产生的第二光参数,以及根据所述第二光参数和第二阈值判断出是否存在悬崖,其中,所述第二参数为所述光收发装置根据当前接收到的光所产生的,所述第二光参数至少包括反射光的参数;所述反射光为所述发射光经反射回来的光;
若进入普通光检测模式,检测所述光收发装置当前产生的第三光参数,以及根据所述第三光参数和第三阈值判断出是否存在悬崖,其中,所述第三光参数为所述光收发装置根据当前接收到的光所产生的,所述第三光参数为所述反射光的参数。
2.如权利要求1所述的悬崖检测方法,其特征在于,控制所述光收发装置进入强光检测模式、弱光检测模式或者普通光检测模式之前,所述方法还包括:
检测当前环境光;
根据检测结果控制所述光收发装置进入相应的检测模式。
3.如权利要求2所述的悬崖检测方法,其特征在于,所述检测当前环境光包括:
控制所述光收发装置进入普通光检测模式;
在所述收发装置处于非发光状态下,采集所述光收发装置根据接收的光产生的环境光参数;
判断所述环境光参数是否大于强光阈值;以及
若所述环境光参数大于强光阈值,识别出所述当前环境为强光环境,所述强光环境与所述强光检测模式相对应。
4.如权利要求3所述的悬崖检测方法,其特征在于,
在所述收发装置处于发光状态下,采集所述光收发装置根据接收的光产生的混合光参数;
若所述环境光参数不大于所述强光阈值,根据所述混合光参数和所述环境光参数计算出反射光参数;
若所述反射光参数小于吸光阈值,识别出当前环境为弱光环境,所述弱光环境与所述弱光检测模式相对应。
5.如权利要求4所述的悬崖检测方法,其特征在于,若所述环境光参数不大于所述强光阈值且所述反射光参数不小于吸光阈值,识别出当前环境为普通光环境,所述普通光环境与所述普通光检测模式相对应。
6.如权利要求3所述的方法,其特征在于,所述方法还包括,
控制所述光收发装置在所述采集环境光参数后处于发光状态。
7.一种悬崖检测装置,利用光收发装置实现扫地机检测悬崖,所述光收发装置用于发射光和接收光,所述悬崖检测装置包括存储单元和处理单元,所述存储单元用于存储计算机程序,所述处理单元用于执行所述计算程序实现如权利要求1~6任意一项所述的方法。
8.一种悬崖检测设备,包括光收发装置和悬崖检测装置,所述光收发装置用于发射光和接收光,其特征在于,所述悬崖检测装置包括存储单元和处理单元,所述存储单元用于存储计算机程序,所述处理单元用于执行所述计算程序实现如权利要求1~6任意一项所述的方法。
9.如权利要求8所述的悬崖检测设备,其特征在于,所述光收发装置包括光发射装置和光接收装置,所述光接收装置包括光接收元件和与所述光接收装置连接的电阻切换模组,所述电阻切换模组用于提供不同的电阻接入所述光接收装置,以使得所述光收发装置进入不同检测模式。
10.一种智能机器人,其特征在于,智能机器人包括主体以及如权利要求8~9任意一项所述的悬崖检测设备,所述悬崖检测设备设置于所述主体。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811160482.1A CN109497889B (zh) | 2018-09-30 | 2018-09-30 | 一种悬崖检测方法、装置、设备及机器人 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811160482.1A CN109497889B (zh) | 2018-09-30 | 2018-09-30 | 一种悬崖检测方法、装置、设备及机器人 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109497889A true CN109497889A (zh) | 2019-03-22 |
CN109497889B CN109497889B (zh) | 2020-11-17 |
Family
ID=65746303
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811160482.1A Active CN109497889B (zh) | 2018-09-30 | 2018-09-30 | 一种悬崖检测方法、装置、设备及机器人 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109497889B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110091360A (zh) * | 2019-05-07 | 2019-08-06 | 珠海市一微半导体有限公司 | 一种悬崖检测装置、移动机器人及检测控制方法 |
CN111685662A (zh) * | 2020-05-19 | 2020-09-22 | 湖北如新电子有限公司 | 一种清扫方法、装置、扫地机器人及存储介质 |
CN112022023A (zh) * | 2020-07-16 | 2020-12-04 | 湖南格兰博智能科技有限责任公司 | 一种扫地机的地面传感器自适应校准学习方法 |
CN113854900A (zh) * | 2021-09-28 | 2021-12-31 | 北京石头世纪科技股份有限公司 | 一种自移动机器人 |
CN114532922A (zh) * | 2022-01-31 | 2022-05-27 | 深圳市云鼠科技开发有限公司 | 一种强光下的清洁机器人探地检测方法和装置 |
CN114680736A (zh) * | 2020-12-29 | 2022-07-01 | 深圳乐动机器人有限公司 | 清洁机器人的控制方法和清洁机器人 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2713586A2 (en) * | 2011-06-24 | 2014-04-02 | Huawei Device Co., Ltd. | Method and device for adjusting detecting threshold of infrared proximity sensor |
CN106142104A (zh) * | 2015-04-10 | 2016-11-23 | 科沃斯机器人股份有限公司 | 自移动机器人及其控制方法 |
CN107608360A (zh) * | 2017-10-26 | 2018-01-19 | 深圳市银星智能科技股份有限公司 | 移动机器人 |
CN107621641A (zh) * | 2017-09-20 | 2018-01-23 | 歌尔股份有限公司 | 红外测障方法、装置及机器人 |
CN108020844A (zh) * | 2017-11-27 | 2018-05-11 | 深圳市沃特沃德股份有限公司 | 悬崖检测方法与机器人 |
CN108553027A (zh) * | 2018-01-04 | 2018-09-21 | 深圳悉罗机器人有限公司 | 移动机器人 |
CN108572369A (zh) * | 2017-03-13 | 2018-09-25 | 北醒(北京)光子科技有限公司 | 一种微镜扫描探测装置及探测方法 |
-
2018
- 2018-09-30 CN CN201811160482.1A patent/CN109497889B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2713586A2 (en) * | 2011-06-24 | 2014-04-02 | Huawei Device Co., Ltd. | Method and device for adjusting detecting threshold of infrared proximity sensor |
CN106142104A (zh) * | 2015-04-10 | 2016-11-23 | 科沃斯机器人股份有限公司 | 自移动机器人及其控制方法 |
CN108572369A (zh) * | 2017-03-13 | 2018-09-25 | 北醒(北京)光子科技有限公司 | 一种微镜扫描探测装置及探测方法 |
CN107621641A (zh) * | 2017-09-20 | 2018-01-23 | 歌尔股份有限公司 | 红外测障方法、装置及机器人 |
CN107608360A (zh) * | 2017-10-26 | 2018-01-19 | 深圳市银星智能科技股份有限公司 | 移动机器人 |
CN108020844A (zh) * | 2017-11-27 | 2018-05-11 | 深圳市沃特沃德股份有限公司 | 悬崖检测方法与机器人 |
CN108553027A (zh) * | 2018-01-04 | 2018-09-21 | 深圳悉罗机器人有限公司 | 移动机器人 |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110091360A (zh) * | 2019-05-07 | 2019-08-06 | 珠海市一微半导体有限公司 | 一种悬崖检测装置、移动机器人及检测控制方法 |
CN110091360B (zh) * | 2019-05-07 | 2021-06-01 | 珠海市一微半导体有限公司 | 一种悬崖检测装置、移动机器人及检测控制方法 |
CN111685662A (zh) * | 2020-05-19 | 2020-09-22 | 湖北如新电子有限公司 | 一种清扫方法、装置、扫地机器人及存储介质 |
CN112022023A (zh) * | 2020-07-16 | 2020-12-04 | 湖南格兰博智能科技有限责任公司 | 一种扫地机的地面传感器自适应校准学习方法 |
CN114680736A (zh) * | 2020-12-29 | 2022-07-01 | 深圳乐动机器人有限公司 | 清洁机器人的控制方法和清洁机器人 |
CN113854900A (zh) * | 2021-09-28 | 2021-12-31 | 北京石头世纪科技股份有限公司 | 一种自移动机器人 |
CN113854900B (zh) * | 2021-09-28 | 2023-01-03 | 北京石头世纪科技股份有限公司 | 一种自移动机器人 |
CN114532922A (zh) * | 2022-01-31 | 2022-05-27 | 深圳市云鼠科技开发有限公司 | 一种强光下的清洁机器人探地检测方法和装置 |
CN114532922B (zh) * | 2022-01-31 | 2023-12-12 | 深圳市云鼠科技开发有限公司 | 一种强光下的清洁机器人探地检测方法和装置 |
Also Published As
Publication number | Publication date |
---|---|
CN109497889B (zh) | 2020-11-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109497889A (zh) | 一种悬崖检测方法、装置、设备及机器人 | |
CN110403528B (zh) | 一种基于清洁机器人提高清洁覆盖率的方法和系统 | |
CN107817801A (zh) | 机器人控制方法、装置、机器人以及充电座 | |
CN105849620B (zh) | 扫描测距仪 | |
CN106142104B (zh) | 自移动机器人及其控制方法 | |
WO2017107742A1 (zh) | 充电桩及其识别方法、装置和自动清洁设备 | |
CN107825425A (zh) | 机器人控制方法、装置、机器人以及充电座 | |
CN101393262A (zh) | 距离检测感应装置及其近距离检测方法 | |
CN107851354B (zh) | 用于与表面处理设备连接的基站、由表面处理设备和基站组成的系统和运行基站的方法 | |
CN106056085A (zh) | 手势识别方法、手势识别装置和设备 | |
CN103809210A (zh) | 接近感测器及其运作方法 | |
CN111948661A (zh) | 一种自移动设备及探测装置 | |
CN208228910U (zh) | 一种集成有IPCamera的家用报警扫地机器人 | |
CN207020534U (zh) | 基于多红外的机器人避障装置 | |
CN208421229U (zh) | 一种红外调制的障碍物检测装置及机器人 | |
US20240045098A1 (en) | Hybrid Time-of-Flight Sensor and IR Sensor | |
CN108614651A (zh) | 一种移动终端和红外检测方法 | |
CN211042693U (zh) | 一种两线控制阀耐用性的检测装置 | |
CN106502464B (zh) | 封装盖板、触控显示面板、显示装置及触控驱动方法 | |
CN110091360A (zh) | 一种悬崖检测装置、移动机器人及检测控制方法 | |
CN115721221A (zh) | 清洁机器人 | |
CN110262270A (zh) | 家电设备的运行控制方法、装置和家电设备 | |
CN108562103A (zh) | 一种冰箱的竖隔板回位检测方法和装置及冰箱 | |
CN114305260B (zh) | 一种清洁机器人的控制方法、装置、介质和清洁机器人 | |
CN110134123A (zh) | 一种智能电网巡线机器人的控制方法 |
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 | ||
CP03 | Change of name, title or address | ||
CP03 | Change of name, title or address |
Address after: 518110 1701, building 2, Yinxing Zhijie, No. 1301-72, sightseeing Road, Xinlan community, Guanlan street, Longhua District, Shenzhen, Guangdong Province Patentee after: Shenzhen Yinxing Intelligent Group Co.,Ltd. Address before: 518110 building A1, Yinxing hi tech Industrial Park, sightseeing Road, Guanlan street, Longhua New District, Shenzhen, Guangdong Patentee before: Shenzhen Silver Star Intelligent Technology Co.,Ltd. |