CN105137994A - 机器人障碍物检测系统及方法 - Google Patents

机器人障碍物检测系统及方法 Download PDF

Info

Publication number
CN105137994A
CN105137994A CN201510575493.6A CN201510575493A CN105137994A CN 105137994 A CN105137994 A CN 105137994A CN 201510575493 A CN201510575493 A CN 201510575493A CN 105137994 A CN105137994 A CN 105137994A
Authority
CN
China
Prior art keywords
robot
drive motor
barrier
rom drive
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.)
Pending
Application number
CN201510575493.6A
Other languages
English (en)
Inventor
戴剑锋
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhuhai Amicro Semiconductor Co Ltd
Original Assignee
Zhuhai Amicro Semiconductor Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Zhuhai Amicro Semiconductor Co Ltd filed Critical Zhuhai Amicro Semiconductor Co Ltd
Priority to CN201510575493.6A priority Critical patent/CN105137994A/zh
Publication of CN105137994A publication Critical patent/CN105137994A/zh
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0227Control of position or course in two dimensions specially adapted to land vehicles using mechanical sensing means, e.g. for sensing treated area

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开一种机器人障碍物检测系统及方法,采用电容感应的原理实现碰撞检测,可以保证机器人结构设计简化、装配简化、模具成本降低、使用寿命长,还可以识别到多个细化方向的撞击,而且对于机器人运动空间内电容感应无法识别的障碍物,结合马达电流的检测法进行分析就可以判断到电容识别法无法判断到的障碍物。

Description

机器人障碍物检测系统及方法
技术领域
本发明涉及智能机器人领域,具体涉及应用于智能机器人上的障碍物检测系统及方法。
背景技术
随着生活水平的提高,越来越多人渴望得到更多的个人时间,以便享受生活。然而,快节奏的工作,繁重的家务,占用了人们大量的个人时间。随着科学技术的发展,移动机器人可以逐步代替人类承担简单重复的体力劳动。这些机器人很多都必须具备自主行走运动能力,而这类机器人的运动空间往往具有各种各样的障碍物(墙壁、家具等),机器人不可避免地与这些障碍物发生碰撞,那么机器人就必须能识别出来发生了碰撞,以及发生碰撞的具体方向,以便指导机器人进行下一步的运动规划。
目前的机器人应对碰撞的策略分两种:第一种策略是机器人前面部分的外壳做成可以移动的,不同方向发生碰撞时,可移动的外壳就可以触发各个不同方向的开关按键(光电开关或者物理开关),机器人就可以识别到不同方向的碰撞;但是由于将机器人的前面外壳做成可移动的,就导致整个机器人的外观不够美观,结构设计复杂,开发模具费用过高,而且只能够识别到左右两个方向的碰撞,并且使用的物理按键寿命比较短,使用久了,碰撞检测模块就容易发生检测故障。第二种策略是机器人的外壳跟底座是固定在一起,不可移动的,机器人通过红外光电等方式,提前检测到障碍物,从而避免与障碍物发生碰撞,但是由于不同物体反射的红外光强度不同,会导致机器人无法判断到前方的障碍物而与之发生碰撞,而且由于机器人运动空间里存在一些小的障碍物,红外检测装置是无法检测到的,如果没有碰撞检测机构,机器人就会撞击障碍物并一直顶着障碍物跑,由于这个策略无法判断障碍物的位置,就可能无法进行正常的运动规划,而且这种策略会导致机器人的运动无法覆盖到靠近障碍物的空间,存在明显的死角。
发明内容
本发明目的是提供一种机器人障碍物检测系统及方法,能够精确检测障碍物,并且具有结构简化、装配简化、模具成本降低、使用寿命长的优点。本发明的目的由以下技术方案实现:
一种机器人障碍物检测系统,其特征在于:包括机器人壳体、机器人底座、控制主板、两个行动轮、两个驱动马达、马达电流检测模块、障碍物检测传感器、至少两个碰撞检测机构;壳体为圆盘盒状,底座固定连接于壳体底部,两个行动轮并排设置于底座上,两个驱动马达分别驱动一个行动轮,两个驱动马达的控制端连接控制主板的行动控制信号输出端;马达电流检测模块的检测端检测两个驱动马达的电流,输出端连接控制主板的电流检测输入端;障碍物检测传感器设置于壳体的前进方向侧,与控制主板的相应信号采集端连接;至少两个碰撞检测机构的两个设置于壳体的前进方向侧;所述碰撞检测机构包括导电金属片层、PCB铜片及导线,导电金属片层紧贴机器人的壳体内壁设置,PCB铜片设置于机器人控制主板上,导电金属片层通过导线与PCB铜片相连,组成一个寄生电容。
作为具体的技术方案,所述至少两个碰撞检测机构具体为四个或八个,分别呈弧形片状,贴设于壳体内壁并围成一周。
作为进一步的技术方案,所述碰撞检测机构还包括内保护层,该内保护层贴设于所述导电金属片层内侧。
作为进一步的技术方案,所述壳体为绝缘的塑料材料制成,其外周设置有用于碰撞缓冲的软胶保护层。
作为具体的技术方案,所述障碍物检测传感器由光电对管传感器或者超声波传感器实现。
一种基于上述机器人障碍物检测系统的检测方法,其特征在于,包括:
(1)控制主板控制两个驱动马达驱动两个行动轮动作时,控制障碍物检测传感器、马达电流检测模块及碰撞检测机构进入检测模式;
(2)当障碍物检测传感器检测到障碍物时,控制主板控制行动轮减速前进或调整新的前进路线;
(3)当碰撞检测机构的检测信号有异常时,控制主板确认检测信号有异常的具体碰撞检测机构,并调整新的前进路线;当马达电流检测模块检测到驱动马达的电流变大,通过比较两个驱动马达电流大小确定机器人的左边,右边还是正前碰到障碍物,并调整新的前进路线。
作为具体的技术方案,步骤(3)中所述通过比较两个驱动马达电流大小确定机器人的左边,右边还是正前碰到障碍物,具体方法为:如果左边行动轮的驱动马达的电流变化比右边的大过一定阈值,那么就确定左边碰到了障碍物,反之亦然,如果两个驱动马达的电流变化相差在一定范围,就认为机器人的正前方碰到了障碍物。
本发明采用电容感应的原理实现碰撞检测,可以保证机器人结构设计简化、装配简化、模具成本降低、使用寿命长,还可以识别到多个细化方向的撞击,而且对于机器人运动空间内电容感应无法识别的障碍物,结合马达电流的检测法进行分析就可以判断到电容识别法无法判断到的障碍物。
附图说明
图1为本发明实施例提供的机器人障碍物检测系统的构成示意图。
图2为本发明实施例提供的机器人障碍物检测系统的碰撞感测区域划分图。
图3为本发明实施例提供的机器人障碍物检测系统中碰撞检测机构及壳体的构造图。
具体实施方式
如图1所示,本实施例提供的机器人障碍物检测系统包括壳体10、底座11控制主板12、两个行动轮13、一个万向轮、两个驱动马达(图中未示)、马达电流检测模块14、五个障碍物检测传感器(图中分别标号为161-165)及八个碰撞检测机构(图中分别标号为171-178)。
壳体10为圆盘盒状,底座11固定连接于壳体10底部。控制主板12及马达电流检测模块14设置于壳体10内。两个行动轮13并排设置于底座11上,两个驱动马达分别驱动一个行动轮,两个驱动马达的控制端连接控制主板12的行动控制信号输出端。马达电流检测模块14的检测端检测两个驱动马达的电流,输出端连接控制主板12的电流检测输入端。五个障碍物检测传感器161-165设置于壳体10前进方向的半圆周的侧壁上,且等角度间隔设置,五个障碍物检测传感器161-165均与控制主板12的相应信号采集端连接。五个障碍物检测传感器161-165可以是光电对管传感器或者超声波传感器,可以提前探测到障碍物并反馈探测信号给控制主板12,由控制主板12规划新的前进路线。
如图2所示,八个碰撞检测机构171-178分别呈弧形片状,贴设于壳体10内壁并围成一周,图2中的区域1~8分别表示各个碰撞检测机构碰撞检测的范围。
如图3所示,壳体10为绝缘的塑料材料制成,其外周设置有软胶保护层150,用于碰撞缓冲。以第一碰撞检测机构171为例进行说明,碰撞检测机构包括导电金属片层1701、内保护层1702、PCB铜片及导线(图中未示),导电金属片层1701紧贴机器人的壳体10内壁设置,内保护层1702贴设于导电金属片层1701内侧,PCB铜片设置于机器人控制主板12上,导电金属片层1701通过导线与PCB铜片相连,从而形成一个面积比较大的寄生电容。这个寄生电容值是固定的,在机器人运动的过程中,如果没有碰撞到障碍物时,对这个寄生电容进行充放电,检测其充放电的周期时间,其应该为一个恒定的值。当发生碰撞时,该寄生电容的寄生电容值就会发生变化,相应的充放电的时间就会有相应的变化,通过检测各碰撞检测机构的变化,就知道机器人在那个方位发生了碰撞,接下来就由控制主板12规划新的前进路线。
结合图2所示,基于上述机器人障碍物检测系统的检测方法详述如下:
(1)控制主板控制两个驱动马达驱动两个行动轮动作时,控制障碍物检测传感器、马达电流检测模块及碰撞检测机构进入检测模式;
(2)当障碍物检测传感器检测到障碍物时,控制主板控制行动轮减速前进或调整新的前进路线;
(3)当碰撞检测机构的检测信号有异常时,控制主板确认检测信号有异常的具体碰撞检测机构,并调整新的前进路线;当马达电流检测模块检测到驱动马达的电流变大,通过比较两个驱动马达电流大小确定机器人的左边,右边还是正前碰到障碍物,并调整新的前进路线。
由上可知,除了障碍物检测传感器的检测,本发明对机器人运动空间内的障碍物碰撞检测分两种策略:
1、机器人碰撞的障碍物是导电体或者带有微弱的电信号或者跟地面相接触时,就会导致碰撞检测机构的电容产生变化,这时候通过分布在机器人不同位置的碰撞检测机构就可以判断到障碍物的位置并做出相应的运动姿态调整。
2、碰撞到的物体(有时)不会导致电容碰撞检测机构1的电容变化,这时候机器人由于没有及时判断到碰撞,就会导致机器人一直顶着障碍物运动,导致驱动马达的电流变大,马达电流检测模块通过检测驱动马达的电流变化就可以知道机器人碰到了障碍物,同时通过比较左右两个行动轮的驱动马达的电流大小就可以知道机器人是左边,右边还是正前碰到障碍物,如果左边的驱动马达的电流变化比右边的大得多,那么就是左边碰到了障碍物,反之亦然,如果两个驱动马达的电流变化相差不大,那么就认为机器人的正前方碰到了障碍物。
机器人开始向前方行走,一般情况下障碍物检测传感器及碰撞检测机构安装在机器人前进的方向,但是为了判断机器人后退时是否碰到障碍物,本实施例还在机器人的后面增加一些碰撞检测机构,前后左右两边的碰撞检测机构的个数可以根据机器人的行走算法规划合理增加或者减少。
以上实施例仅为充分公开而非限制本发明,凡是基于本发明主旨且未经创造性劳动即可获得的等效技术特征的替换,应当属于发明所涵盖的范围。

Claims (7)

1.一种机器人障碍物检测系统,其特征在于:包括机器人壳体、机器人底座、控制主板、两个行动轮、两个驱动马达、马达电流检测模块、障碍物检测传感器、至少两个碰撞检测机构;壳体为圆盘盒状,底座固定连接于壳体底部,两个行动轮并排设置于底座上,两个驱动马达分别驱动一个行动轮,两个驱动马达的控制端连接控制主板的行动控制信号输出端;马达电流检测模块的检测端检测两个驱动马达的电流,输出端连接控制主板的电流检测输入端;障碍物检测传感器设置于壳体的前进方向侧,与控制主板的相应信号采集端连接;至少两个碰撞检测机构的两个设置于壳体的前进方向侧;所述碰撞检测机构包括导电金属片层、PCB铜片及导线,导电金属片层紧贴机器人的壳体内壁设置,PCB铜片设置于机器人控制主板上,导电金属片层通过导线与PCB铜片相连,组成一个寄生电容。
2.根据权利要求1所述的机器人障碍物检测系统,其特征在于:所述至少两个碰撞检测机构具体为四个或八个,分别呈弧形片状,贴设于壳体内壁并围成一周。
3.根据权利要求1或2所述的机器人障碍物检测系统,其特征在于:所述碰撞检测机构还包括内保护层,该内保护层贴设于所述导电金属片层内侧。
4.根据权利要求1或2所述的机器人障碍物检测系统,其特征在于:所述壳体为绝缘的塑料材料制成,其外周设置有用于碰撞缓冲的软胶保护层。
5.根据权利要求1或2所述的机器人障碍物检测系统,其特征在于:所述障碍物检测传感器由光电对管传感器或者超声波传感器实现。
6.一种基于权利要求1所述机器人障碍物检测系统的检测方法,其特征在于,包括:
(1)控制主板控制两个驱动马达驱动两个行动轮动作时,控制障碍物检测传感器、马达电流检测模块及碰撞检测机构进入检测模式;
(2)当障碍物检测传感器检测到障碍物时,控制主板控制行动轮减速前进或调整新的前进路线;
(3)当碰撞检测机构的检测信号有异常时,控制主板确认检测信号有异常的具体碰撞检测机构,并调整新的前进路线;当马达电流检测模块检测到驱动马达的电流变大,通过比较两个驱动马达电流大小确定机器人的左边,右边还是正前碰到障碍物,并调整新的前进路线。
7.根据权利要求6所述的检测方法,其特征在于,步骤(3)中所述通过比较两个驱动马达电流大小确定机器人的左边,右边还是正前碰到障碍物,具体方法为:如果左边行动轮的驱动马达的电流变化比右边的大过一定阈值,那么就确定左边碰到了障碍物,反之亦然,如果两个驱动马达的电流变化相差在一定范围,就认为机器人的正前方碰到了障碍物。
CN201510575493.6A 2015-09-10 2015-09-10 机器人障碍物检测系统及方法 Pending CN105137994A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510575493.6A CN105137994A (zh) 2015-09-10 2015-09-10 机器人障碍物检测系统及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510575493.6A CN105137994A (zh) 2015-09-10 2015-09-10 机器人障碍物检测系统及方法

Publications (1)

Publication Number Publication Date
CN105137994A true CN105137994A (zh) 2015-12-09

Family

ID=54723369

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510575493.6A Pending CN105137994A (zh) 2015-09-10 2015-09-10 机器人障碍物检测系统及方法

Country Status (1)

Country Link
CN (1) CN105137994A (zh)

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106404072A (zh) * 2016-11-09 2017-02-15 上海允登信息科技有限公司 机房环境检测装置
CN106524886A (zh) * 2016-11-25 2017-03-22 张强 碰撞位置检测装置、系统和检测方法
CN106568440A (zh) * 2016-11-03 2017-04-19 珠海市微半导体有限公司 基于加速度传感器的机器人行为检测系统及方法
CN107336266A (zh) * 2017-08-23 2017-11-10 江苏木盟智能科技有限公司 机器人及其碰撞检测机构
CN107515428A (zh) * 2016-06-15 2017-12-26 上海思依暄机器人科技股份有限公司 一种检测障碍物的方法及装置
CN108972577A (zh) * 2018-06-29 2018-12-11 张家港市泰克软件有限公司 具有报警功能的陪伴机器人
CN108972576A (zh) * 2018-06-29 2018-12-11 张家港市泰克软件有限公司 智能陪伴机器人
CN109074082A (zh) * 2016-06-09 2018-12-21 X开发有限责任公司 用于交通工具的传感器轨迹规划
CN110000815A (zh) * 2019-04-09 2019-07-12 深圳前海达闼云端智能科技有限公司 一种碰撞检测方法、装置、电子设备及存储介质
CN110977972A (zh) * 2019-12-03 2020-04-10 珠海格力电器股份有限公司 一种多关节机器人碰撞检测方法、计算机可读存储介质及机器人
CN112162551A (zh) * 2020-09-10 2021-01-01 珠海格力电器股份有限公司 障碍物探测方法、装置、设备及计算机可读介质
CN114217608A (zh) * 2021-11-24 2022-03-22 深圳市优必选科技股份有限公司 障碍物位置确定方法、装置、电子设备及存储介质

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE10357636A1 (de) * 2003-12-10 2005-07-14 Vorwerk & Co. Interholding Gmbh Selbsttätig verfahrbares Bodenstaub-Aufsammelgerät
US20070237027A1 (en) * 2006-04-11 2007-10-11 Denso Corporation Collision detection device
CN101756677A (zh) * 2009-11-24 2010-06-30 宁波波朗电器有限公司 全自动保洁机器人控制电路
CN101862166A (zh) * 2010-06-02 2010-10-20 刘瑜 自动吸尘器定位充电座的电子控制装置
CN104000543A (zh) * 2014-06-16 2014-08-27 成都北斗群星智能科技有限公司 扫地机器人新型碰撞避障结构
CN204925797U (zh) * 2015-09-10 2015-12-30 珠海市一微半导体有限公司 机器人障碍物检测系统

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE10357636A1 (de) * 2003-12-10 2005-07-14 Vorwerk & Co. Interholding Gmbh Selbsttätig verfahrbares Bodenstaub-Aufsammelgerät
US20070237027A1 (en) * 2006-04-11 2007-10-11 Denso Corporation Collision detection device
CN101756677A (zh) * 2009-11-24 2010-06-30 宁波波朗电器有限公司 全自动保洁机器人控制电路
CN101862166A (zh) * 2010-06-02 2010-10-20 刘瑜 自动吸尘器定位充电座的电子控制装置
CN104000543A (zh) * 2014-06-16 2014-08-27 成都北斗群星智能科技有限公司 扫地机器人新型碰撞避障结构
CN204925797U (zh) * 2015-09-10 2015-12-30 珠海市一微半导体有限公司 机器人障碍物检测系统

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
廖义奎 等: "《Cortex-A9多核嵌入式系统设计》", 30 September 2014 *
王兆滨 等: "《MSP430系列单片机原理与工程设计实践》", 31 October 2014, 清华大学出版社 *
王振成 等: "《工程测试技术及应用》", 31 August 2014, 重庆大学出版社 *

Cited By (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109074082A (zh) * 2016-06-09 2018-12-21 X开发有限责任公司 用于交通工具的传感器轨迹规划
CN109074082B (zh) * 2016-06-09 2022-01-04 因思创新有限责任公司 用于机器人设备的传感器轨迹规划系统及方法
CN107515428A (zh) * 2016-06-15 2017-12-26 上海思依暄机器人科技股份有限公司 一种检测障碍物的方法及装置
CN106568440A (zh) * 2016-11-03 2017-04-19 珠海市微半导体有限公司 基于加速度传感器的机器人行为检测系统及方法
CN106404072A (zh) * 2016-11-09 2017-02-15 上海允登信息科技有限公司 机房环境检测装置
CN106524886A (zh) * 2016-11-25 2017-03-22 张强 碰撞位置检测装置、系统和检测方法
CN107336266A (zh) * 2017-08-23 2017-11-10 江苏木盟智能科技有限公司 机器人及其碰撞检测机构
CN108972576A (zh) * 2018-06-29 2018-12-11 张家港市泰克软件有限公司 智能陪伴机器人
CN108972577A (zh) * 2018-06-29 2018-12-11 张家港市泰克软件有限公司 具有报警功能的陪伴机器人
CN110000815A (zh) * 2019-04-09 2019-07-12 深圳前海达闼云端智能科技有限公司 一种碰撞检测方法、装置、电子设备及存储介质
CN110977972A (zh) * 2019-12-03 2020-04-10 珠海格力电器股份有限公司 一种多关节机器人碰撞检测方法、计算机可读存储介质及机器人
CN112162551A (zh) * 2020-09-10 2021-01-01 珠海格力电器股份有限公司 障碍物探测方法、装置、设备及计算机可读介质
CN112162551B (zh) * 2020-09-10 2021-11-16 珠海格力电器股份有限公司 障碍物探测方法、装置、设备及计算机可读介质
CN114217608A (zh) * 2021-11-24 2022-03-22 深圳市优必选科技股份有限公司 障碍物位置确定方法、装置、电子设备及存储介质
CN114217608B (zh) * 2021-11-24 2024-04-19 深圳市优必选科技股份有限公司 障碍物位置确定方法、装置、电子设备及存储介质

Similar Documents

Publication Publication Date Title
CN105137994A (zh) 机器人障碍物检测系统及方法
CN204925797U (zh) 机器人障碍物检测系统
CN109407675B (zh) 机器人回座的避障方法和芯片以及自主移动机器人
CN107041718B (zh) 清洁机器人及其控制方法
US7397213B2 (en) Mobile robot and mobile robot charge station return system
CN112415998B (zh) 一种基于tof摄像头的障碍物分类避障控制系统
CN107072457B (zh) 清洁机器人及其控制方法
KR101752190B1 (ko) 로봇청소기 및 그 제어방법
CN205651378U (zh) 一种机器人碰撞检测系统
KR20210151113A (ko) 감지 방법, 장치, 이동 로봇 및 저장 매체
CN112327878B (zh) 一种基于tof摄像头的障碍物分类避障控制方法
EP2595024A1 (en) Autonomous locomotion body
CN106843239B (zh) 基于地图预测的机器人运动控制方法
KR20180096058A (ko) 돌발 장애물을 식별하는 방법 및 이를 구현하는 로봇
US20180177361A1 (en) Cleaning robot
CN108873900B (zh) 一种机器人行走时越过障碍物的方法
CN111067440A (zh) 一种清洁机器人控制方法以及清洁机器人
CN105320137A (zh) 面向家庭服务的室内轮式机器人
CN104081667A (zh) 用来在机动车及其所属装置上驱动电容式传感装置的方法
EP3738495B1 (en) Robotic vacuum cleaner and control method therefor
CN112363513A (zh) 一种基于深度信息的障碍物分类避障控制方法
CN106774295B (zh) 一种分布式引导机器人自主充电系统
US10765284B2 (en) Cleaning robot
CN112347876A (zh) 一种基于tof摄像头的障碍物识别方法、清洁机器人
JP2006236098A (ja) 移動体の障害物回避方法及び該移動体

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20151209