CN117130376A - 一种分布式超声波避障系统及其避障方法 - Google Patents
一种分布式超声波避障系统及其避障方法 Download PDFInfo
- Publication number
- CN117130376A CN117130376A CN202311401976.5A CN202311401976A CN117130376A CN 117130376 A CN117130376 A CN 117130376A CN 202311401976 A CN202311401976 A CN 202311401976A CN 117130376 A CN117130376 A CN 117130376A
- Authority
- CN
- China
- Prior art keywords
- ultrasonic
- ultrasonic sensor
- distance
- obstacle avoidance
- correction
- 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 60
- 238000010408 sweeping Methods 0.000 claims abstract description 136
- 238000012937 correction Methods 0.000 claims abstract description 95
- 238000001514 detection method Methods 0.000 claims abstract description 29
- 238000004364 calculation method Methods 0.000 claims description 13
- 238000012545 processing Methods 0.000 claims description 10
- 230000005540 biological transmission Effects 0.000 claims description 8
- 238000005259 measurement Methods 0.000 claims 2
- 230000002035 prolonged effect Effects 0.000 abstract description 4
- 238000004140 cleaning Methods 0.000 description 5
- 239000000428 dust Substances 0.000 description 3
- 238000012544 monitoring process Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- 238000013473 artificial intelligence Methods 0.000 description 1
- 230000001680 brushing effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005201 scrubbing Methods 0.000 description 1
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02E—REDUCTION OF GREENHOUSE GAS [GHG] EMISSIONS, RELATED TO ENERGY GENERATION, TRANSMISSION OR DISTRIBUTION
- Y02E10/00—Energy generation through renewable energy sources
- Y02E10/50—Photovoltaic [PV] energy
Landscapes
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种分布式超声波避障系统及其避障方法,属于扫地机器人技术领域,包括传感器位置检测模块、距离获取模块、距离修正模块、避障模块。本发明通过设置的传感器位置检测模块,能够在进行扫地工作前对各个超声波传感器的位置进行检测,保证扫地机器人能够在满足避障要求的情况下进行扫地工作,避免扫地机器人的超声波传感器出现位置偏移后仍进行扫地工作而造成的二次损坏;通过设置的距离修正模块,能够对距离获取模块获取的距离数据进行修正,消除因地面不平造成的距离数据与实际距离产生的偏差,使扫地机器人在扫地工作中能够更准确地完成避障工作,大大降低了扫地机器人在工作中受损的几率,提高了扫地机器人的使用寿命。
Description
技术领域
本发明涉及扫地机器人技术领域,具体涉及一种分布式超声波避障系统及其避障方法。
背景技术
扫地机器人,又称自动打扫机、智能吸尘、机器人吸尘器等,是智能家电的一种,能凭借人工智能,自动在房间内完成地板清理工作。一般采用刷扫和真空方式,将地面杂物先吸纳进入自身的垃圾收纳盒,从而完成地面清理的功能。一般来说,将完成清扫、吸尘、擦地工作的机器人,也统一归为扫地机器人。扫地机器人的机身为无线机器,以圆盘型为主。使用充电电池运作,操作方式以遥控器、或是机器上的操作面板。一般能设定时间预约打扫,自行充电。前方有设置感应器,可侦测障碍物,如碰到墙壁或其他障碍物,会自行转弯。
目前扫地机器人多采用单个感应器对障碍物进行监测,监测获得的障碍物距离数据未考虑机身的水平度,没有经过校正,数据准确性较差。上述问题亟待解决,为此,提出一种分布式超声波避障系统及其避障方法。
发明内容
本发明所要解决的技术问题在于:如何解决目前扫地机器人多采用单个感应器对障碍物进行监测,监测获得的障碍物距离数据未考虑机身的水平度,没有经过校正,数据准确性较差的问题,提供了一种分布式超声波避障系统。
本发明是通过以下技术方案解决上述技术问题的,本发明包括传感器位置检测模块、距离获取模块、距离修正模块、避障模块;
所述传感器位置检测模块,用于在进行扫地工作前对各个测距超声波传感器以及校正超声波传感器的位置进行检测,获取各超声波传感器的位置准确度评分,根据位置准确评分判断当前扫地机器人是否能够在扫地工作过程中完成避障工作;
所述距离获取模块,用于在判断当前扫地机器人能够在扫地工作过程中完成避障工作后,在扫地工作过程中实时获取各个测距超声波传感器检测到的对应预设方向上与障碍物之间的距离数据;
所述距离修正模块,用于对距离获取模块获取的距离数据进行修正,获取修正后的距离数据;
所述避障模块,用于根据修正后的距离数据在扫地工作过程中进行实时避障。
更进一步地,所述传感器位置检测模块包括检测组件、距离计算单元、位置准确度评分单元;所述检测组件包括可升降的挡板、驱动电机,所述挡板通过驱动电机带动,进而将各个测距超声波传感器以及校正超声波传感器遮挡起来或露出;所述距离计算单元用于计算遮挡后各超声波传感器与挡板内侧面之间的距离,记为L1n、L2n;所述位置准确度评分单元用于根据各测距超声波传感器与对应的挡板之间的距离L1n、各校正超声波传感与对应的挡板之间的距离L2n获取各个测距超声波传感器、校正超声波传感器的位置准确度评分P1n、P2n,根据位置准确评分判断当前扫地机器人是否能够在扫地工作过程中完成避障工作;其中下标中的1表示测距超声波传感器,下标中的2表示校正超声波传感器,下标中的n表示第n个测距超声波传感器/校正超声波传感器;所述检测组件还包括传动齿轮;所述传动齿轮设置在所述驱动电机输出端,所述挡板的一侧面设置有齿槽,所述齿槽与所述传动齿轮啮合传动,所述挡板的另一侧面间隔布置有多个滚轮,挡板的两侧边缘、滚轮均位于扫地机器人壳体上开设的预留槽中。
更进一步地,所述位置准确度评分单元的处理过程具体如下:
S11:将各测距超声波传感器与对应的挡板之间的距离L1n除以预设的第一设定距离阈值L1预设得到第一比值B1n;将各校正超声波传感器与对应的挡板之间的距离L2n除以预设的第二设定距离阈值L2预设得到第二比值B2n;
S12:将第一比值B1n、第二比值B2n扩大100倍,即得到各个测距超声波传感器、校正超声波传感器的位置准确度评分P1n、P2n;
S13:将各个测距超声波传感器的位置准确度评分P1n、校正超声波传感器的位置准确度评分P1n,分别与预设的第一位置准确度评分阈值P1预设、第二位置准确度评分阈值P2预设进行比较;
S14:当任一个测距超声波传感器的位置准确度评分小于预设的第一位置准确度评分阈值P1预设或任一个校正超声波传感器的位置准确度评分小于预设的第一位置准确度评分阈值P2预设时,表示存在测距超声波传感器/校正超声波传感器的位置准确度无法满足避障要求,判断得到当前扫地机器人不能够在扫地工作过程中完成避障工作,当所有的测距超声波传感器的位置准确度评分、校正超声波传感器的位置准确度评分均大于等于对应的位置准确度评分阈值时,表示所有的测距超声波传感器/校正超声波传感器的位置准确度均满足避障要求,判断得到当前扫地机器人能够在扫地工作过程中完成避障工作。
更进一步地,所述距离获取模块包括多个预设方向上的超声波测距单元,所述超声波测距单元为测距超声波传感器,分布式布置在扫地机器人上,用于根据发射的超声波探测信号、接收回波信号之间的时间差与超声波传播速度的乘积得到各个测距超声波传感器在对应预设方向上与障碍物之间的距离数据,记为Jn,其中,n表示第n个测距超声波传感器。
更进一步地,所述测距超声波传感器分别布置在扫地机器人内部的前侧、后侧、左侧、右侧;其中,位于前侧、后侧的测距超声波传感器的预设方向在同一直水平线上,记为第一水平线,位于左侧、右侧的测距超声波传感器的预设方向在同一直水平线上,记为第二水平线,第一水平线与第二水平线相交且垂直。
更进一步地,所述距离修正模块包括多个超声波校正单元、修正计算单元;所述超声波校正单元为校正超声波传感器,分布式布置在扫地机器人的下端,与测距超声波传感器的位置相对应,用于根据发射的超声波探测信号、接收回波信号之间的时间差与超声波传播速度的乘积得到各个校正超声波传感器在对应预设方向上与地面之间的距离数据,记为Dn,其中,n表示第n个校正超声波传感器;所述修正计算单元用于根据各个校正超声波传感器在对应预设方向上与地面之间的距离数据Dn,对距离获取模块获取的距离数据进行修正,获取修正后的距离数据Xn,其中,n表示第n个校正超声波传感器。
更进一步地,各校正超声波传感器的下端面位于同一水平面上,校正超声波传感器分别布置扫地机器人内部下端的前侧、后侧、左侧、右侧,两个校正超声波传感器为一组,共两组,其中一组中两个校正超声波传感器的预设方向在两条平行的竖直线上,记为第一竖直线,两条第一竖直线均与第一水平线相交且垂直,另一组中两个校正超声波传感器的预设方向在另外两条平行的竖直线上,记为第二竖直线,两条第二竖直线与第二水平线相交且垂直。
更进一步地,所述修正计算单元的具体处理过程如下:
S21:获取第一水平线上的两个测距超声波传感器在对应预设方向上与障碍物之间的距离数据J1、J2,以及第二水平线上的两个测距超声波传感器在对应预设方向上与障碍物之间的距离数据J3、J4;
S22:获取两条第一竖直线上的两个校正超声波传感器在对应预设方向上与地面之间的距离数据D1、D2,以及两条第二竖直线上的两个校正超声波传感器在对应预设方向上与地面之间的距离数据D3、D4;
S23:根据两条第一竖直线之间的直线距离S1、距离数据D1、D2,利用三角函数计算得到扫地机器人在第一水平线上的倾角Z1,同理根据两条第二竖直线之间的直线距离S2、距离数据D3、D4,利用三角函数计算得到扫地机器人在第二水平线上的倾角Z2;
S24:根据得到的倾角Z1再次利用三角函数计算得到第一水平线上的两个测距超声波传感器在对应预设方向上与障碍物之间的修正后的距离数据X1、X2;同理根据得到的倾角Z2再次利用三角函数计算得到第二水平线上的两个测距超声波传感器在对应预设方向上与障碍物之间的修正后的距离数据X3、X4。
更进一步地,所述避障模块的具体处理过程如下:
S31:实时获取各测距超声波传感器在对应预设方向上与障碍物之间的修正后的距离数据X1、X2、X3、X4;
S32:根据实时获取的距离数据X1、X2、X3、X4,通过扫地机器人中内置的上位机实时控制扫地机器人的行进方向和行进速度,使各测距超声波传感器在对应预设方向上与障碍物之间的修正后的距离数据X1、X2、X3、X4均大于预设距离阈值X预设,即可完成避障工作。
本发明还提供了一种分布式超声波避障系统的避障方法,利用上述的分布式超声波避障系统完成扫地机器人的避障工作,包括以下步骤:
S1:在进行扫地工作前对各个测距超声波传感器以及校正超声波传感器的位置进行检测,获取各超声波传感器的位置准确度评分,根据位置准确评分判断当前扫地机器人是否能够在扫地工作过程中完成避障工作;
S2:在判断当前扫地机器人能够在扫地工作过程中完成避障工作后,在扫地工作过程中实时获取各个测距超声波传感器检测到的对应预设方向上与障碍物之间的距离数据;
S3:对步骤S3中获取的距离数据进行修正,获取修正后的距离数据;
S4:根据步骤S4中修正后的距离数据在扫地工作过程中进行实时避障。
本发明相比现有技术具有以下优点:该分布式超声波避障系统及其避障方法,通过设置的传感器位置检测模块,能够在进行扫地工作前对各个超声波传感器的位置进行检测,保证扫地机器人能够在满足避障要求的情况下进行扫地工作,避免扫地机器人的超声波传感器出现位置偏移后仍进行扫地工作而造成的二次损坏;通过设置的距离修正模块,能够对距离获取模块获取的距离数据进行修正,消除因地面不平造成的距离数据与实际距离产生的偏差,使扫地机器人在扫地工作中能够更准确地完成避障工作,大大降低了扫地机器人在工作中受损的几率,提高了扫地机器人的使用寿命。
附图说明
图1是本发明实施例中分布式超声波避障系统的结构示意图;
图2是本发明实施例中测距超声波传感器在扫地机器人内部的布置位置示意图;
图3是图2中A部的局部放大示意图;
图4是本发明实施例中校正超声波传感器在扫地机器人内部下端的布置位置示意图;
图5是本发明实施例中求取倾角Z1的示意图。
具体实施方式
下面对本发明的实施例作详细说明,本实施例在以本发明技术方案为前提下进行实施,给出了详细的实施方式和具体的操作过程,但本发明的保护范围不限于下述的实施例。
如图1所示,本实施例提供一种技术方案:一种分布式超声波避障系统,包括传感器位置检测模块、距离获取模块、距离修正模块、避障模块;
所述传感器位置检测模块,用于在进行扫地工作前对各个测距超声波传感器以及校正超声波传感器的位置进行检测,获取各超声波传感器的位置准确度评分,根据位置准确评分判断当前扫地机器人是否能够在扫地工作过程中完成避障工作;通过设置的传感器位置检测模块,能够在进行扫地工作前对各个超声波传感器的位置进行检测,保证扫地机器人能够在满足避障要求的情况下进行扫地工作,避免扫地机器人的超声波传感器出现位置偏移后仍进行扫地工作而造成的二次损坏。在本实施例中,位置偏移一般由于人为踩踏或异常碰撞造成,超声波传感器出现位置偏移后,不应再投入工作,非常容易在进行扫地工作无法完成避障工作而造成二次损坏,应及时送修。
在本实施例中,所述传感器位置检测模块包括检测组件、距离计算单元、位置准确度评分单元;所述检测组件包括可升降的挡板、驱动电机(见图2),所述挡板通过驱动电机带动,进而将各个测距超声波传感器以及校正超声波传感器遮挡起来或露出;所述距离计算单元用于计算遮挡后各超声波传感器与挡板内侧面之间的距离,记为L1n、L2n;所述位置准确度评分单元用于根据各测距超声波传感器与对应的挡板之间的距离L1n、各校正超声波传感与对应的挡板之间的距离L2n获取各个测距超声波传感器、校正超声波传感器的位置准确度评分P1n、P2n,根据位置准确评分判断当前扫地机器人是否能够在扫地工作过程中完成避障工作;其中下标中的1表示测距超声波传感器,下标中的2表示校正超声波传感器,下标中的n表示第n个测距超声波传感器/校正超声波传感器,在本实施例中n取1、2、3、4,位置准确度评分单元的处理过程的下标含义与上述下标含义相同。
在本实施例中,如图3所示,所述检测组件还包括传动齿轮311;所述传动齿轮311设置在所述驱动电机31输出端,所述挡板32的一侧面设置有齿槽321,所述齿槽321与所述传动齿轮311啮合传动,所述挡板32的另一侧面间隔布置有多个滚轮322,挡板32的两侧边缘、滚轮322均位于扫地机器人壳体上开设的预留槽4中,在驱动电机31驱动挡板32动作时,预留槽4用于起到限位导向作用。
在本实施例中,所述位置准确度评分单元的处理过程具体如下:
S11:将各测距超声波传感器与对应的挡板之间的距离L1n除以预设的第一设定距离阈值L1预设得到第一比值B1n;将各校正超声波传感器与对应的挡板之间的距离L2n除以预设的第二设定距离阈值L2预设得到第二比值B2n;在本实施例中,第一设定距离阈值L1预设大于等于各测距超声波传感器与对应的挡板之间的距离L1n,第二设定距离阈值L2预设大于等于各校正超声波传感器与对应的挡板之间的距离L2n;
S12:将第一比值B1n、第二比值B2n扩大100倍,即得到各个测距超声波传感器、校正超声波传感器的位置准确度评分P1n、P2n;
S13:将各个测距超声波传感器的位置准确度评分P1n、校正超声波传感器的位置准确度评分P1n,分别与预设的第一位置准确度评分阈值P1预设、第二位置准确度评分阈值P2预设进行比较;
S14:当任一个测距超声波传感器的位置准确度评分小于预设的第一位置准确度评分阈值P1预设或任一个校正超声波传感器的位置准确度评分小于预设的第一位置准确度评分阈值P2预设时,表示存在测距超声波传感器/校正超声波传感器的位置准确度无法满足避障要求,判断得到当前扫地机器人不能够在扫地工作过程中完成避障工作,当所有的测距超声波传感器的位置准确度评分、校正超声波传感器的位置准确度评分均大于等于对应的位置准确度评分阈值时,表示所有的测距超声波传感器/校正超声波传感器的位置准确度均满足避障要求,判断得到当前扫地机器人能够在扫地工作过程中完成避障工作。
需要说明的是,在距离计算单元中,在计算遮挡后各超声波传感器与挡板内侧面之间的距离时,根据各超声波传感器发出的超声波探测信号与接收到回波信号的时间差并通过超声波在空气中速度参数计算出各超声波传感器到挡板内侧面之间的距离数据,其中超声波在空气中速度参数用340m/s近似代替。
需要说明的是,测距超声波传感器外侧的挡板为竖直挡板,校正超声波传感器外侧的挡板为水平挡板。
在本实施例中,在步骤S14中,当判断得到当前扫地机器人不能够在扫地工作过程中完成避障工作时,扫地机器人通过无线网络向用户控制终端(安装有管控软件的用户手机或平板电脑)发出报警提示,提示当前测距超声波传感器/校正超声波传感器的位置准确度无法满足避障要求,请及时送修,无法进行后续扫地工作。
在本实施例中,当判断当前扫地机器人能够在扫地工作过程中完成避障工作后,通过驱动电机带动挡板使对应的测距超声波传感器/校正超声波传感器露出,从而进行后续的扫地工作。
所述距离获取模块,用于在判断当前扫地机器人能够在扫地工作过程中完成避障工作后,在扫地工作过程中实时获取各个测距超声波传感器检测到的对应预设方向上与障碍物之间的距离数据。
在本实施例中,所述距离获取模块包括多个预设方向上的超声波测距单元(见图2),所述超声波测距单元为测距超声波传感器,分布式布置在扫地机器人上,用于根据发射的超声波探测信号、接收回波信号之间的时间差与超声波传播速度的乘积得到各个测距超声波传感器在对应预设方向上与障碍物之间的距离数据,记为Jn,其中,n表示第n个测距超声波传感器,在本实施例中,n取1、2、3、4。
在本实施例中,如图2所示,测距超声波传感器1分别布置在扫地机器人内部的前侧、后侧、左侧、右侧;其中,位于前侧、后侧的测距超声波传感器1的预设方向(即测距方向)在同一直水平线上,记为第一水平线,位于左侧、右侧的测距超声波传感器1的预设方向在同一直水平线上,记为第二水平线,第一水平线与第二水平线相交且垂直。
所述距离修正模块,用于对距离获取模块获取的距离数据进行修正,获取修正后的距离数据;通过设置的距离修正模块,能够对距离获取模块获取的距离数据进行修正,消除因地面不平(致使扫地机器人与水平面存在倾角)造成的距离数据与实际距离产生的偏差,使扫地机器人在扫地工作中能够更准确地完成避障工作,大大降低了扫地机器人在工作中受损的几率,提高了扫地机器人的使用寿命。
在本实施例中,所述距离修正模块包括多个超声波校正单元、修正计算单元;所述超声波校正单元为校正超声波传感器,布置在扫地机器人的下端(见图3),与测距超声波传感器的位置相对应,用于根据发射的超声波探测信号、接收回波信号之间的时间差与超声波传播速度的乘积得到各个校正超声波传感器在对应预设方向上与地面之间的距离数据,记为Dn,其中,n表示第n个校正超声波传感器,在本实施例中,n取1、2、3、4;所述修正计算单元用于根据各个校正超声波传感器在对应预设方向上与地面之间的距离数据Dn,对距离获取模块获取的距离数据进行修正,获取修正后的距离数据Xn,其中,n表示第n个校正超声波传感器,在本实施例中,n取1、2、3、4。
需要说明的是,如图3所示,本实施例中各校正超声波传感器2的下端面位于同一水平面上,校正超声波传感器2分别布置扫地机器人内部下端的前侧、后侧、左侧、右侧,两个校正超声波传感器2为一组,共两组,其中一组中两个校正超声波传感器2的预设方向在两条平行的竖直线上,记为第一竖直线,两条第一竖直线均与第一水平线相交且垂直,另一组中两个校正超声波传感器2的预设方向在另外两条平行的竖直线上,记为第二竖直线,两条第二竖直线与第二水平线相交且垂直。
在本实施例中,所述修正计算单元的具体处理过程如下(见图5):
S21:获取第一水平线上的两个测距超声波传感器在对应预设方向上与障碍物之间的距离数据J1、J2,以及第二水平线上的两个测距超声波传感器在对应预设方向上与障碍物之间的距离数据J3、J4;
S22:获取两条第一竖直线上的两个校正超声波传感器在对应预设方向上与地面之间的距离数据D1、D2,以及两条第二竖直线上的两个校正超声波传感器在对应预设方向上与地面之间的距离数据D3、D4;
S23:根据两条第一竖直线之间的直线距离S1、距离数据D1、D2,利用三角函数计算得到扫地机器人在第一水平线上的倾角Z1,同理根据两条第二竖直线之间的直线距离S2、距离数据D3、D4,利用三角函数计算得到扫地机器人在第二水平线上的倾角Z2;(当判断当前扫地机器人能够在扫地工作过程中完成避障工作时,两条第一、第二竖直线之间的直线距离是确定的)
S24:根据得到的倾角Z1再次利用三角函数计算得到第一水平线上的两个测距超声波传感器在对应预设方向上与障碍物之间的修正后的距离数据X1、X2;根据得到的倾角Z2再次利用三角函数计算得到第二水平线上的两个测距超声波传感器在对应预设方向上与障碍物之间的修正后的距离数据X3、X4。
所述避障模块,用于根据修正后的距离数据在扫地工作过程中进行实时避障;
在本实施例中,所述避障模块的具体处理过程如下:
S31:实时获取各测距超声波传感器在对应预设方向上与障碍物之间的修正后的距离数据X1、X2、X3、X4;
S32:根据实时获取的距离数据X1、X2、X3、X4,通过扫地机器人中内置的上位机实时控制扫地机器人的行进方向和行进速度,使各测距超声波传感器在对应预设方向上与障碍物之间的修正后的距离数据X1、X2、X3、X4均大于预设距离阈值X预设,即可完成避障工作。
在本实施例中,在步骤S32中,当某一预设方向的距离数据减小至与预设距离阈值X预设的差值达到设定差值阈值后,增大扫地机器人的行进方向与该预设方向之间的夹角,并降低行进速度。
需要说明的是,在本实施例中,测距超声波传感器、校正超声波传感器均为收发一体超声波传感器。
本实施例还提供了一种分布式超声波避障系统的避障方法,利用上述的分布式超声波避障系统完成避障工作,包括以下步骤:
S1:在进行扫地工作前对各个测距超声波传感器以及校正超声波传感器的位置进行检测,获取各超声波传感器的位置准确度评分,根据位置准确评分判断当前扫地机器人是否能够在扫地工作过程中完成避障工作;
S2:在判断当前扫地机器人能够在扫地工作过程中完成避障工作后,在扫地工作过程中实时获取各个测距超声波传感器检测到的对应预设方向上与障碍物之间的距离数据;
S3:对步骤S3中获取的距离数据进行修正,获取修正后的距离数据;
S4:根据步骤S4中修正后的距离数据在扫地工作过程中进行实时避障。
综上所述,上述实施例的分布式超声波避障系统,通过设置的传感器位置检测模块,能够在进行扫地工作前对各个超声波传感器的位置进行检测,保证扫地机器人能够在满足避障要求的情况下进行扫地工作,避免扫地机器人的超声波传感器出现位置偏移后仍进行扫地工作而造成的二次损坏;通过设置的距离修正模块,能够对距离获取模块获取的距离数据进行修正,消除因地面不平造成的距离数据与实际距离产生的偏差,使扫地机器人在扫地工作中能够更准确地完成避障工作,大大降低了扫地机器人在工作中受损的几率,提高了扫地机器人的使用寿命。
此外,术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。在本发明的描述中,“多个”的含义是至少两个,例如两个,三个等,除非另有明确具体的限定。
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不必须针对的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任一个或多个实施例或示例中以合适的方式结合。此外,在不相互矛盾的情况下,本领域的技术人员可以将本说明书中描述的不同实施例或示例以及不同实施例或示例的特征进行结合和组合。
尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。
Claims (10)
1.一种分布式超声波避障系统,其特征在于,包括:传感器位置检测模块、距离获取模块、距离修正模块、避障模块;
所述传感器位置检测模块,用于在进行扫地工作前对各个测距超声波传感器以及校正超声波传感器的位置进行检测,获取各超声波传感器的位置准确度评分,根据位置准确评分判断当前扫地机器人是否能够在扫地工作过程中完成避障工作;
所述距离获取模块,用于在判断当前扫地机器人能够在扫地工作过程中完成避障工作后,在扫地工作过程中实时获取各个测距超声波传感器检测到的对应预设方向上与障碍物之间的距离数据;
所述距离修正模块,用于对距离获取模块获取的距离数据进行修正,获取修正后的距离数据;
所述避障模块,用于根据修正后的距离数据在扫地工作过程中进行实时避障。
2.根据权利要求1所述的一种分布式超声波避障系统,其特征在于:所述传感器位置检测模块包括检测组件、距离计算单元、位置准确度评分单元;所述检测组件包括可升降的挡板、驱动电机,所述挡板通过驱动电机带动,进而将各个测距超声波传感器以及校正超声波传感器遮挡起来或露出;所述距离计算单元用于计算遮挡后各超声波传感器与挡板内侧面之间的距离,记为L1n、L2n;所述位置准确度评分单元用于根据各测距超声波传感器与对应的挡板之间的距离L1n、各校正超声波传感与对应的挡板之间的距离L2n获取各个测距超声波传感器、校正超声波传感器的位置准确度评分P1n、P2n,根据位置准确评分判断当前扫地机器人是否能够在扫地工作过程中完成避障工作;其中下标中的1表示测距超声波传感器,下标中的2表示校正超声波传感器,下标中的n表示第n个测距超声波传感器/校正超声波传感器;所述检测组件还包括传动齿轮;所述传动齿轮设置在所述驱动电机输出端,所述挡板的一侧面设置有齿槽,所述齿槽与所述传动齿轮啮合传动,所述挡板的另一侧面间隔布置有多个滚轮,挡板的两侧边缘、滚轮均位于扫地机器人壳体上开设的预留槽中。
3.根据权利要求2所述的一种分布式超声波避障系统,其特征在于:所述位置准确度评分单元的处理过程具体如下:
S11:将各测距超声波传感器与对应的挡板之间的距离L1n除以预设的第一设定距离阈值L1预设得到第一比值B1n;将各校正超声波传感器与对应的挡板之间的距离L2n除以预设的第二设定距离阈值L2预设得到第二比值B2n;
S12:将第一比值B1n、第二比值B2n扩大100倍,即得到各个测距超声波传感器、校正超声波传感器的位置准确度评分P1n、P2n;
S13:将各个测距超声波传感器的位置准确度评分P1n、校正超声波传感器的位置准确度评分P1n,分别与预设的第一位置准确度评分阈值P1预设、第二位置准确度评分阈值P2预设进行比较;
S14:当任一个测距超声波传感器的位置准确度评分小于预设的第一位置准确度评分阈值P1预设或任一个校正超声波传感器的位置准确度评分小于预设的第一位置准确度评分阈值P2预设时,表示存在测距超声波传感器/校正超声波传感器的位置准确度无法满足避障要求,判断得到当前扫地机器人不能够在扫地工作过程中完成避障工作,当所有的测距超声波传感器的位置准确度评分、校正超声波传感器的位置准确度评分均大于等于对应的位置准确度评分阈值时,表示所有的测距超声波传感器/校正超声波传感器的位置准确度均满足避障要求,判断得到当前扫地机器人能够在扫地工作过程中完成避障工作。
4.根据权利要求1所述的一种分布式超声波避障系统,其特征在于:所述距离获取模块包括多个预设方向上的超声波测距单元,所述超声波测距单元为测距超声波传感器,分布式布置在扫地机器人上,用于根据发射的超声波探测信号、接收回波信号之间的时间差与超声波传播速度的乘积得到各个测距超声波传感器在对应预设方向上与障碍物之间的距离数据,记为Jn,其中,n表示第n个测距超声波传感器。
5.根据权利要求4所述的一种分布式超声波避障系统,其特征在于:所述测距超声波传感器分别布置在扫地机器人内部的前侧、后侧、左侧、右侧;其中,位于前侧、后侧的测距超声波传感器的预设方向在同一直水平线上,记为第一水平线,位于左侧、右侧的测距超声波传感器的预设方向在同一直水平线上,记为第二水平线,第一水平线与第二水平线相交且垂直。
6.根据权利要求5所述的一种分布式超声波避障系统,其特征在于:所述距离修正模块包括多个超声波校正单元、修正计算单元;所述超声波校正单元为校正超声波传感器,分布式布置在扫地机器人的下端,与测距超声波传感器的位置相对应,用于根据发射的超声波探测信号、接收回波信号之间的时间差与超声波传播速度的乘积得到各个校正超声波传感器在对应预设方向上与地面之间的距离数据,记为Dn,其中,n表示第n个校正超声波传感器;所述修正计算单元用于根据各个校正超声波传感器在对应预设方向上与地面之间的距离数据Dn,对距离获取模块获取的距离数据进行修正,获取修正后的距离数据Xn,其中,n表示第n个校正超声波传感器。
7.根据权利要求6所述的一种分布式超声波避障系统,其特征在于:各校正超声波传感器的下端面位于同一水平面上,校正超声波传感器分别布置扫地机器人内部下端的前侧、后侧、左侧、右侧,两个校正超声波传感器为一组,共两组,其中一组中两个校正超声波传感器的预设方向在两条平行的竖直线上,记为第一竖直线,两条第一竖直线均与第一水平线相交且垂直,另一组中两个校正超声波传感器的预设方向在另外两条平行的竖直线上,记为第二竖直线,两条第二竖直线与第二水平线相交且垂直。
8.根据权利要求7所述的一种分布式超声波避障系统,其特征在于:所述修正计算单元的具体处理过程如下:
S21:获取第一水平线上的两个测距超声波传感器在对应预设方向上与障碍物之间的距离数据J1、J2,以及第二水平线上的两个测距超声波传感器在对应预设方向上与障碍物之间的距离数据J3、J4;
S22:获取两条第一竖直线上的两个校正超声波传感器在对应预设方向上与地面之间的距离数据D1、D2,以及两条第二竖直线上的两个校正超声波传感器在对应预设方向上与地面之间的距离数据D3、D4;
S23:根据两条第一竖直线之间的直线距离S1、距离数据D1、D2,利用三角函数计算得到扫地机器人在第一水平线上的倾角Z1,同理根据两条第二竖直线之间的直线距离S2、距离数据D3、D4,利用三角函数计算得到扫地机器人在第二水平线上的倾角Z2;
S24:根据得到的倾角Z1再次利用三角函数计算得到第一水平线上的两个测距超声波传感器在对应预设方向上与障碍物之间的修正后的距离数据X1、X2;同理根据得到的倾角Z2再次利用三角函数计算得到第二水平线上的两个测距超声波传感器在对应预设方向上与障碍物之间的修正后的距离数据X3、X4。
9.根据权利要求8所述的一种分布式超声波避障系统,其特征在于:所述避障模块的具体处理过程如下:
S31:实时获取各测距超声波传感器在对应预设方向上与障碍物之间的修正后的距离数据X1、X2、X3、X4;
S32:根据实时获取的距离数据X1、X2、X3、X4,通过扫地机器人中内置的上位机实时控制扫地机器人的行进方向和行进速度,使各测距超声波传感器在对应预设方向上与障碍物之间的修正后的距离数据X1、X2、X3、X4均大于预设距离阈值X预设,即可完成避障工作。
10.一种分布式超声波避障系统的避障方法,其特征在于,利用如权利要求1~9任一项所述的分布式超声波避障系统完成扫地机器人的避障工作,包括以下步骤:
S1:在进行扫地工作前对各个测距超声波传感器以及校正超声波传感器的位置进行检测,获取各超声波传感器的位置准确度评分,根据位置准确评分判断当前扫地机器人是否能够在扫地工作过程中完成避障工作;
S2:在判断当前扫地机器人能够在扫地工作过程中完成避障工作后,在扫地工作过程中实时获取各个测距超声波传感器检测到的对应预设方向上与障碍物之间的距离数据;
S3:对步骤S3中获取的距离数据进行修正,获取修正后的距离数据;
S4:根据步骤S4中修正后的距离数据在扫地工作过程中进行实时避障。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311401976.5A CN117130376B (zh) | 2023-10-27 | 2023-10-27 | 一种分布式超声波避障系统及其避障方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311401976.5A CN117130376B (zh) | 2023-10-27 | 2023-10-27 | 一种分布式超声波避障系统及其避障方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN117130376A true CN117130376A (zh) | 2023-11-28 |
CN117130376B CN117130376B (zh) | 2024-02-02 |
Family
ID=88863216
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202311401976.5A Active CN117130376B (zh) | 2023-10-27 | 2023-10-27 | 一种分布式超声波避障系统及其避障方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN117130376B (zh) |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20150144729A (ko) * | 2014-06-17 | 2015-12-28 | 주식회사 유진로봇 | 그래디언트 기반 특징점을 이용한 이동 로봇의 위치를 인식하기 위한 장치 및 그 방법 |
CN108814423A (zh) * | 2018-06-27 | 2018-11-16 | 杨扬 | 自行走吸尘器及建立栅格地图的方法 |
CN109460024A (zh) * | 2018-11-13 | 2019-03-12 | 深圳市杉川机器人有限公司 | 一种扫地机器人 |
CN208840142U (zh) * | 2018-08-23 | 2019-05-10 | 上海峰霸工程技术有限公司 | 一种方便操作的中央空调风管清洗机器人 |
JP2019109772A (ja) * | 2017-12-19 | 2019-07-04 | 株式会社ダイヘン | 移動体 |
US20200114509A1 (en) * | 2017-06-15 | 2020-04-16 | Lg Electronics Inc. | Method for identifying moving object in three-dimensional space and robot for implementing same |
CN210924278U (zh) * | 2019-09-30 | 2020-07-03 | 同业君创科技(深圳)有限公司 | 基于嵌入式系统的故障诊断系统 |
US20200225673A1 (en) * | 2016-02-29 | 2020-07-16 | AI Incorporated | Obstacle recognition method for autonomous robots |
CN113558536A (zh) * | 2021-09-24 | 2021-10-29 | 莱克电气绿能科技(苏州)有限公司 | 智能扫地机器人的智能校准方法、装置及系统 |
CN114200480A (zh) * | 2020-09-01 | 2022-03-18 | 珊口(深圳)智能科技有限公司 | 应用于移动机器人的传感器误差测量方法及系统 |
CN116269059A (zh) * | 2023-05-19 | 2023-06-23 | 杭州涂鸦信息技术有限公司 | 扫地机器人标定系统及方法 |
-
2023
- 2023-10-27 CN CN202311401976.5A patent/CN117130376B/zh active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20150144729A (ko) * | 2014-06-17 | 2015-12-28 | 주식회사 유진로봇 | 그래디언트 기반 특징점을 이용한 이동 로봇의 위치를 인식하기 위한 장치 및 그 방법 |
US20170153646A1 (en) * | 2014-06-17 | 2017-06-01 | Yujin Robot Co., Ltd. | Apparatus of controlling movement of mobile robot mounted with wide angle camera and method thereof |
US20200225673A1 (en) * | 2016-02-29 | 2020-07-16 | AI Incorporated | Obstacle recognition method for autonomous robots |
US20200114509A1 (en) * | 2017-06-15 | 2020-04-16 | Lg Electronics Inc. | Method for identifying moving object in three-dimensional space and robot for implementing same |
JP2019109772A (ja) * | 2017-12-19 | 2019-07-04 | 株式会社ダイヘン | 移動体 |
CN108814423A (zh) * | 2018-06-27 | 2018-11-16 | 杨扬 | 自行走吸尘器及建立栅格地图的方法 |
CN208840142U (zh) * | 2018-08-23 | 2019-05-10 | 上海峰霸工程技术有限公司 | 一种方便操作的中央空调风管清洗机器人 |
CN109460024A (zh) * | 2018-11-13 | 2019-03-12 | 深圳市杉川机器人有限公司 | 一种扫地机器人 |
CN210924278U (zh) * | 2019-09-30 | 2020-07-03 | 同业君创科技(深圳)有限公司 | 基于嵌入式系统的故障诊断系统 |
CN114200480A (zh) * | 2020-09-01 | 2022-03-18 | 珊口(深圳)智能科技有限公司 | 应用于移动机器人的传感器误差测量方法及系统 |
CN113558536A (zh) * | 2021-09-24 | 2021-10-29 | 莱克电气绿能科技(苏州)有限公司 | 智能扫地机器人的智能校准方法、装置及系统 |
CN116269059A (zh) * | 2023-05-19 | 2023-06-23 | 杭州涂鸦信息技术有限公司 | 扫地机器人标定系统及方法 |
Non-Patent Citations (1)
Title |
---|
贾卫东;颜杰;欧鸣雄;沈跃;王浩宇;董祥;: "基于遥控的温室喷雾机自适应控制系统设计与试验", 农机化研究, no. 04 * |
Also Published As
Publication number | Publication date |
---|---|
CN117130376B (zh) | 2024-02-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108143364B (zh) | 一种自移动清洁机器人清洁地图区域划分的方法 | |
CN105425801B (zh) | 基于先进路径规划技术的智能清洁机器人及其清洁方法 | |
CN110051289B (zh) | 扫地机器人语音控制方法、装置、机器人和介质 | |
US7630792B2 (en) | Apparatus and method for detecting position of mobile robot | |
CN103645733B (zh) | 自寻充电机器人及其自寻充电系统和方法 | |
EP3518065A1 (en) | Determining method and control method for straight running of robot on slope plane | |
CN110623606A (zh) | 一种清洁机器人及其控制方法 | |
JP2002325708A (ja) | ロボット掃除機とそのシステム及び制御方法 | |
CN1954974A (zh) | 移动机器人和移动机器人充电站返回系统 | |
CN108733041B (zh) | 自动移动设备及其超声避障方法 | |
TW201832710A (zh) | 自走式清潔裝置分區清潔方法及使用該方法的自走式清潔裝置 | |
CN113565567B (zh) | 一种液压支架顶梁与采煤机滚筒防碰撞预警方法及装置 | |
CN105938195B (zh) | 一种基于超声波旋转扫描的避障方法 | |
WO2018053984A1 (zh) | 机器人在矩形斜坡上行驶的路径导航方法 | |
CN117130376B (zh) | 一种分布式超声波避障系统及其避障方法 | |
CN110849882A (zh) | 一种用于识别、定位、检测管道焊缝的设备及方法 | |
JPH03500098A (ja) | 自走式の車輌を制御するための方法、並びに自走式の車輌 | |
US20070118288A1 (en) | Travel device | |
CN112386177A (zh) | 清洁设备运动控制方法、存储介质及清洁设备 | |
WO2022166341A1 (zh) | 基站及清洁机器人系统 | |
CN108345308A (zh) | 一种自动吸尘机器人的最佳随机路径选择方法 | |
CN209770256U (zh) | 一种扫地机器人 | |
CN112234665A (zh) | 一种充电座避让方法、装置、充电装置及存储介质 | |
KR101193685B1 (ko) | 자동청소시스템 및 자동청소시스템의 제어방법 | |
CN110329382A (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 |