CN113109836A - 一种多方向障碍物检测装置 - Google Patents
一种多方向障碍物检测装置 Download PDFInfo
- Publication number
- CN113109836A CN113109836A CN202011037942.9A CN202011037942A CN113109836A CN 113109836 A CN113109836 A CN 113109836A CN 202011037942 A CN202011037942 A CN 202011037942A CN 113109836 A CN113109836 A CN 113109836A
- Authority
- CN
- China
- Prior art keywords
- infrared
- infrared receiving
- value
- main control
- control chip
- 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
Links
- 238000001514 detection method Methods 0.000 title claims abstract description 35
- 230000004888 barrier function Effects 0.000 title description 4
- 238000005259 measurement Methods 0.000 claims abstract description 15
- 229920005994 diacetyl cellulose Polymers 0.000 claims description 40
- 230000008859 change Effects 0.000 claims description 10
- 238000000034 method Methods 0.000 claims description 8
- 230000000737 periodic effect Effects 0.000 claims description 7
- 230000002441 reversible effect Effects 0.000 claims description 4
- 101100015484 Saccharomyces cerevisiae (strain ATCC 204508 / S288c) GPA1 gene Proteins 0.000 claims description 3
- 230000003321 amplification Effects 0.000 claims description 2
- 238000005034 decoration Methods 0.000 claims description 2
- 238000005286 illumination Methods 0.000 claims description 2
- 238000012544 monitoring process Methods 0.000 claims description 2
- 238000003199 nucleic acid amplification method Methods 0.000 claims description 2
- 238000009966 trimming Methods 0.000 claims description 2
- 238000006243 chemical reaction Methods 0.000 claims 1
- 230000001360 synchronised effect Effects 0.000 claims 1
- 238000002955 isolation Methods 0.000 abstract description 2
- 230000003287 optical effect Effects 0.000 abstract description 2
- 239000003990 capacitor Substances 0.000 description 9
- 239000000919 ceramic Substances 0.000 description 5
- 238000010586 diagram Methods 0.000 description 5
- 230000006641 stabilisation Effects 0.000 description 4
- 238000011105 stabilization Methods 0.000 description 4
- 238000013461 design Methods 0.000 description 3
- 102100039435 C-X-C motif chemokine 17 Human genes 0.000 description 2
- 101000889048 Homo sapiens C-X-C motif chemokine 17 Proteins 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 101100067427 Saccharomyces cerevisiae (strain ATCC 204508 / S288c) FUS3 gene Proteins 0.000 description 1
- 230000004075 alteration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000033228 biological regulation Effects 0.000 description 1
- 239000003985 ceramic capacitor Substances 0.000 description 1
- 230000005465 channeling Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000009191 jumping Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000004806 packaging method and process Methods 0.000 description 1
- 230000000087 stabilizing effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000010408 sweeping Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
Classifications
-
- 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
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/933—Lidar systems specially adapted for specific applications for anti-collision purposes of aircraft or spacecraft
-
- 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/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/08—Systems determining position data of a target for measuring distance only
- G01S17/10—Systems determining position data of a target for measuring distance only using transmission of interrupted, pulse-modulated waves
- G01S17/14—Systems determining position data of a target for measuring distance only using transmission of interrupted, pulse-modulated waves wherein a voltage or current pulse is initiated and terminated in accordance with the pulse transmission and echo reception respectively, e.g. using counters
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Geophysics And Detection Of Objects (AREA)
Abstract
本发明公开了一种多方向障碍物检测装置,包括线路板组件、遮光罩组件、底座。线路板组件包括沿水平面圆周呈等间距分布的红外发射管、红外接收头和向上方向排列的红外发射管、红外接收头以及主控芯片、电源模块和红外发射管功率调整模块、功率微调模块、载波驱动模块和输出模块。遮光罩组件套装于线路板组件上部,将所有红外接收头进行遮光罩组件内部的光学隔离。遮光罩组件、线路板组件和底座通过螺钉固定连接。该多方向障碍物检测装置可以同时实现前、后、左、右、左前、左后、右前、右后及上方的障碍物的距离值的测量,且测量速度快、体积小、重量轻且成本低廉,特别适用于需要快速运动且运动方向经常改变的飞行类运动设备使用。
Description
技术领域
本发明涉及传感器技术领域,具体为一种多方向障碍物检测装置。本发明也可以在包括移动设备和智能控制的其他电路中使用,诸如遥控接收电路,或者有障碍物检测需求的任何电路背景技术。
在现实生活中,越来越多的智能设备都需要检测设备与障碍物之间的距离以方便进行线路规划、避障等自动控制。在无人机、扫地机器人、无人驾驶汽车等方面,障碍物检测得到了广泛的应用。特别是在小型多轴飞行器上,需要重量轻,距离测量速度快、耗电小并且能同时检测前后左右等多个方向距离的装置。以保证四轴飞行器的自动避障飞行,提高多轴飞行器自身的安全性以及防止出现多轴飞行器伤人的安全事故。
市面上常见的障碍物检测方法有激光测距、超声波测距和图像识别(视觉)测距等。但常见的障碍物检测方法和设备往往存在着成本高、功耗大、距离测量速度慢、重量和体积大的缺点。同时也因为上述原因,常见的障碍物检测装置一般只能同时进行一个方向的障碍物检测,无法简单地通过增加检测装置的数量来同时完成前后左右等多方向的障碍物检测,不利于在多轴飞行器这种需要进行前后左右运动的飞行器上使用。
因此,我们提出一种多方向障碍物检测装置,以便于解决上述中提出的问题。
发明内容
本发明的目的在于提供一种多方向避障距离传感器,以解决上述背景技术中提出的成本高、功耗大、距离测量速度慢、重量和体积大,而且无法同时完成前后左右等多方向的障碍物检测的问题。
为了解决上述技术问题,本发明是通过以下技术方案实现的:一种多方向障碍物检测装置,包括线路板组件、遮光罩组件和底座。所述的线路板组件包括沿水平圆周等间距分布的红外发射管、沿水平圆周等间距分布的红外接收头、向上方向排列的红外发射管、向上方向排列的红外接收头、主控芯片、电源模块、红外发射管功率调整模块、功率微调模块、载波驱动模块和输出模块。所述的遮光罩组件套装于线路板组件上部,将所有红外接收头进行遮光罩组件内部的光学隔离,防止非障碍物反射的红外线信号传导到红外接收头。遮光罩主体沿水平圆周等间距向外方向设置有红外发射管的红外发射窗口和红外接收头的红外接收窗口。遮光罩组件包括遮光罩主体、上红外接收头安装座和上盖板,上红外接收头安装座位于遮光罩主体中央上部位置,与遮光罩主体粘贴连接,上盖板位于上红外接收头安装座上部中间位置,与上红外接收头安装座粘贴连接。所述的底座位于线路板组件的下方,遮光罩组件、线路板组件和底座通过螺钉固定连接。
优选的,所述沿水平圆周等间距分布的红外发射管、红外接收头的数量各为8只,呈前、后、左、右、左前、左后、右前、右后排列,结合红外发射管发射角度和红外接收头的接收角度可以完成前、后、左、右、左前、左后、右前、右后多方向的障碍物检测。
优选的,所述遮光罩主体下部开有形状与红外接收头外形相近的凹槽,该凹槽正好可以容纳红外接收头,使各个红外接收头彼此之间光学隔离,同时方便遮光罩主体套装在红外接收头外部。
优选的,所述遮光罩组件采用不透光深色塑料材质。
优选的,所述线路板组件呈圆形,直径为40—60毫米。
一种多方向障碍物检测装置,其测量距离的原理是:红外接收头是否能收到被障碍物反射的红外发射管发射的载波红外线信号,与障碍物的反射面与红外接收头的距离和红外发射管所发射的红外线信号的强度两者均有关系。当障碍物的反射面与红外接收头的距离为固定值时,通过所述的线路板组件的主控芯片和红外发射管功率调整模块由小到大阶梯状调整红外发射管发射的红外线信号的发射功率。开始时由于红外线信号的发射功率小,导致红外线信号的强度太小,红外接收头无法接收到反射面反射回来的红外线信号。随着红外线信号的发射功率的增加,当发射的红外线信号的强度增加到某个值时,红外接收头开始能够接收到反射面反射回来的红外线信号,此时的红外线信号的强度值就和反射面与红外接收头的距离值对应起来了。同样的,当红外发射管发射的载波红外线信号的强度为固定值时,反射面由远处靠近红外接收头。开始时由于反射面距离太远导致红外线信号的强度太小,红外接收头无法接收到反射面反射回来的红外线信号,当反射面由远处靠近红外接收头到某个距离值时,红外接收头开始能接收到反射面反射回来的红外线信号,此时的反射面与红外接收头的距离值就和红外线信号的强度值对应起来了。根据反射面与红外接收头的距离值和红外线信号的强度值的对应关系建立发射信号的强度值与距离值的对应关系表,就可以通过正好能接收到反射信号时所发射的红外线信号的强度值来推算距离值了。通常情况下,施加在红外发射管两端的电压越大,流过红外发射管的电流越大,红外发射管的发射功率和红外发射管发射的红外信号的强度也越大,所以也可以用红外发射管两端的电压大小来表示红外发射管的发射功率和红外发射管发射的红外信号的强度的大小。
虽然采用上述方法测量距离的精度不高,根据算法不同误差在5厘米—30厘米,但应用于障碍物的检测其精度已经足够。
所述的线路板组件的红外发射管功率调整模块在主控芯片的控制下,快速且不断地调整红外发射管的工作电压来改变发射的红外线信号的强度,同时主控芯片不断地同步地判断每个红外接收头是否收到反射回来的红外线,并且记录和分析每个红外接收头刚好收到反射信号时红外发射管的工作电压值,根据红外发射管的工作电压值与距离值的对应关系表来判断障碍物与每个红外接收头的距离。
优选的,红外发射管功率调整模块采用主控芯片的DAC输出模块和输出跟随器的模式,通过改变红外发射管的工作电压来调整红外发射信号的强度值,此时主控芯片的DAC模块的控制值与红外发射管的发射信号的强度值相对应。
优选的,红外发射管的发射信号采用38KHz的载波频率,以提高对周围环境的红外线杂波的抗干扰能力。
优选的,红外接收头采用市场上常用的中心频率为38KHz的通红外遥控器的一体化红外接收头,以提高抗干扰能力的同时,降低产品成本。
优选的,主控芯片同时测量9路红外信号的周期T为0.1秒,一秒钟可以获得10组9个方向的距离值。
术语“红外接收头”也称为红外接收模块或者红外线接收模组 (InfraredReceiver Module,简称IRM),是指把包括红外监测二极管、放大器、限幅器、带通滤波器、积分电路、比较器等电路集成在一个元件中,共同组合封装而成的一体化红外接收头,可简化及小型化应用商品的电路设计。一体化红外接收头在接收到足够强度的红外线载波信号且载波频率符合红外接收头的规定要求时会输出低电平信号,否则输出高电平信号。一体化红外接收头被广泛应用于空调、风扇、暖风机、加湿器、电视、DVD、机顶盒、遥控玩具、灯饰照明等红外线遥控领域。
术语“DAC”是指数模转换器,又称D/A转换器,简称DAC,它是把数字量转变成模拟量的器件。现在常用的单片机、信号处理器等主控芯片内部已集成了数模转换器。
术语“DAC的控制值”是指数模转换器工作时,把数字量转变成模拟量时的数字量的值。
术语“PWM”是指脉冲宽度调制(Pulse width modulation,PWM)技术,它是把每一脉冲宽度均相等的脉冲列作为PWM波形,通过改变脉冲列的周期可以调频,改变脉冲的宽度或占空比可以调压,采用适当控制方法即可使电压与频率协调变化。本实施例中通过改变脉冲列的周期产生间歇、频率为38KHz的方波电压信号。现在常用的单片机、信号处理器等主控芯片内部已集成了脉冲宽度调制器。
与现有技术相比,本发明的有益效果是:
1. 该多方向障碍物检测装置可以同时测量前、后、左、右、左前、左后、右前、右后及上方的障碍物的距离值,且测量速度快,特别适用于需要快速运动且运动方向经常改变的运动设备使用;
2.该多方向障碍物检测装置体积小、重量轻、功耗小,特别适用于飞行类对重量和耗电要求敏感的运动设备使用;
3. 该多方向障碍物检测装置采用常用的红外发射管、红外接收头等价格便宜的元器件结合专用算法进行距离测量,简化了电路、降低了成本,易于在销售价格相对便宜的玩具无人机市场上推广使用。
附图说明
在附图中,遍及不同的图,附图不需要按比例绘制,而是将重点放在说明本发明的结构和原理上。
图1为本发明正视剖面结构示意图。
图2为本发明三维结构示意图。
图3为本发明移除遮光罩组件后的三维结构示意图。
图4为本发明移除底座和部分线路板组件后的三维结构示意图。
图5为本发明的一个方向上的三维装配关系示意图。
图6为本发明的另一个方向上的三维装配关系示意图。
图7为本发明的电路原理图。图7中红外发射管LED1—LED8对应图1—6中的沿水平圆周等间距分布的红外发射管1,红外接收头WH1—WH8对应图1—6中的沿水平圆周等间距分布的红外接收头2,红外发射管LED9对应图1—6中的向上方向排列的红外发射管3,红外接收头WH9对应图1—6中的向上方向排列的红外接收头4。
图8为本发明的程序流程图。
图9为本发明的红外发射管发射强度变化的波形示意图。图9中的V_LED电压值和阶梯数量能够对理解V_LED电压的变化情况提供帮助,但在实际应用中,V_LED电压值和阶梯数量会根据使用需求、器件性能的不同而发生改变。
图10为本发明在障碍物与红外接收头距离为1.7米时的波形示意图。
图11为本发明在障碍物与红外接收头距离为0.7米时的波形示意图。
图12为本发明的一种主控芯片的DAC的控制值、V_LED电压、方向x寄存器的值和距离值的对应关系图。该主控芯片的DAC的控制值、V_LED电压、方向x寄存器的值和距离值的对应关系图能够对理解如何通过DAC的控制值、V_LED电压、方向x寄存器的值获得距离值提供帮助,但对应关系图中的DAC控制值、V_LED电压值、方向x寄存器的值和距离值在实际应用中,会根据使用需求、器件性能的不同而发生改变。
图中:1、沿水平圆周等间距分布的红外发射管;2、沿水平圆周等间距分布的红外接收头;3、向上发射的红外发射管;4、向上接收的红外接收头;5、线路板组件;6、遮光罩主体;7、上红外接收头安装座;8、上盖板;9、底座;10、螺钉;11、红外接收窗口;12、红外发射窗口;13、向上方向的红外接收窗口;14、向上方向的红外发射窗口;15红外接收头凹槽。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
请参阅图1—12,本发明提供一种技术方案:一种多方向障碍物检测装置,包括线路板组件5、遮光罩组件和底座9。所述的线路板组件5包括沿水平圆周等间距分布的红外发射管1、沿水平圆周等间距分布的红外接收头2、向上发射的红外发射管3、向上接收的红外接收头4、主控芯片、电源模块、红外发射管功率调整模块、功率微调模块、载波驱动模块和输出模块。所述的遮光罩组件包括遮光罩主体6、上红外接收头安装座7和上盖板8,上红外接收头安装座7位于遮光罩主体6中央上部位置,与遮光罩主体6粘贴连接,红外接收头安装座7和遮光罩主体6分离设计的目的是为了方便将沿水平圆周等间距分布的红外发射管1装入红外发射窗口12;上盖板8位于上红外接收头安装座7上部中间位置,与上红外接收头安装座7粘贴连接;上红外接收头安装座7上部开有向上方向的红外发射窗口14,上盖板8上部开有向上方向的红外接收窗口13。遮光罩组件套装于线路板组件5上部,将所有红外接收头进行遮光罩组件内部的光学隔离,防止非障碍物反射的红外线信号传导到红外接收头。底座9位于线路板组件的下方。遮光罩主体6、线路板组件5和底座9通过螺钉10固定连接。
如图3所述线路板组件5呈圆形,直径为40—60毫米。
如图3所述的沿水平圆周等间距分布的红外发射管1、沿水平圆周等间距分布的红外接收头2的数量各为8只,呈前、后、左、右、左前、左后、右前、右后排列,其红外线发射和红外线接收面向外,结合红外发射管发射角度和红外接收头的接收角度可以实现水平面360度范围的无死角障碍物检测。然而,这些红外发射管1和红外接收头2的数量是可以变化的,以便为任何特定情况提供独特益处,或者来满足各种实施方式的具体设计要求的应用。例如,在不需要水平面360度范围无死角障碍物的检测的应用可以只需要前、后、左、右方向排列的红外发射管1和红外接收头2;在不需要水平面后方障碍物的检测的应用可以省略后、左后、右后方向排列的红外发射管1和红外接收头2。此外,尽管本实施例的红外发射管1、红外接收头2的数量各为8只,但是应当理解,可以增加或者减少红外发射管1、红外接收头2的数量,以提供所需要的方向的障碍物检测,而不偏离本说明书的范围。
如图2所述遮光罩主体6沿水平圆周等间距设置有红外发射管1的红外发射窗口12和红外接收头2的红外接收窗口11,通过调整红外发射窗口12的窗口大小和深度来调整红外发射管1发射的红外线的发射角度以控制红外发射管1的照射范围,通过调整红外接收窗口11的窗口大小和深度来调整红外接收头2接收的红外线的接收角度以控制红外接收头2的红外线接收范围。
如图4所述遮光罩主体6下部开有形状与沿水平圆周等间距分布的红外接收头2外形相近的红外接收头凹槽15,该红外接收头凹槽15正好可以容纳沿水平圆周等间距分布的红外接收头2,使各个红外接收头彼此之间光学隔离,同时方便遮光罩主体6套装在线路板组件5的上面。
所述遮光罩组件采用不透光深色塑料材质。
如图7所述一种多方向障碍物检测装置的电路包括主控芯片IC1、运算放大器IC2、稳压芯片IC3、红外发射管LED1—LED9、红外接收头WH1—WH9、电阻R1—R18、瓷片电容C1—C17、电解电容E1—E3、电感L1—L3、发光二极管LED10、LED11和三极管Q1。
如图7主控芯片IC1的DAC输出和运算放大器IC2组成红外发射管功率调整模块,主控芯片IC1的DAC管脚14通过串接电阻R10连接运算放大器IC2的正向输入管脚3、运算放大器IC2的反向输入管脚2通过串接电阻R11接地,运算放大器IC2的反向输入管脚2通过串接电阻R12连接运算放大器IC2的输出端6。
如图7运算放大器IC2的输出端6连接V_LED并与红外发射管LED1—LED9的正向端连接在一起,红外发射管LED1—LED9的负向端分别通过串接功率微调电阻R1—R9与限流电阻R13连接在一起, 限流电阻R13的另一端连接三极管Q1的集电极,三极管Q1的发射极接地,三极管Q1的基极通过串接电阻R34连接主控芯片IC1的PWM管脚45。
如图7红外接收头WH1—WH9的电源端3分别与电源VCC2共同连接,红外接收头WH1—WH9的接地端2分别接地,红外接收头WH1—WH9的输出端YK1—YK9分别连接主控芯片IC1的输入管脚25—33。
如图7稳压芯片IC3的输入端1通过串接电感L1连接总电源输入端VCC_IN,稳压芯片IC3的接地端2接地,稳压芯片IC3的输出端3连接VCC, 电解电容E1、瓷片电容C11、C12、C13并联在VCC与地之间, 发光二极管LED11正向端连接VCC,发光二极管LED11负向端通过串接限流电阻R16接地;VCC通过串接电感L2连接VCC2,电解电容E2、瓷片电容C14、C15并联在VCC2和地之间;VCC通过串接电感L3连接VCC1,电解电容E3、瓷片电容C16、C17并联在VCC1和地之间,以上电路组成电源模块。
如图7主控芯片IC1的串口输出脚21通过电阻R17与输出端口J1的2脚连接,主控芯片IC1的串口输入脚22通过电阻R18与输出端口J1的1脚连接;发光二极管LED10正向端连接VCC,发光二极管LED10负向端通过串接限流电阻R15连接主控芯片IC1的输入脚2。
工作原理:本发明的测距的基本原理是红外接收头是否能收到红外发射管发射的红外线信号,不仅与障碍物与红外接收头的距离有关,而且与红外发射管发射的红外线信号的强度有关。通常情况下,施加在红外发射管两端的电压越大,流过红外发射管的电流越大,红外发射管的发射功率和红外发射管发射的红外信号的强度也越大,所以也可以用红外发射管两端的电压大小来表示红外发射管的发射功率和红外发射管发射的红外信号的强度的大小。
在使用该多方向障碍物检测装置时,在主控芯片程序的控制下,主控芯片IC1通过改变DAC的控制值来控制DAC输出管脚14周期性地输出阶梯状态变化的电压信号,通过运算放大器IC2构成的缓冲器进行电流和电压放大后提供红外发射管LED1—LED9周期性2.1V—3.0V变化的阶梯状态的V_LED电源电压,如图9中A波形所示,可以发现红外发射管LED1—LED9正向端电压V_LED呈周期性阶梯状态变化,周期为T。在主控芯片程序的控制下,主控芯片IC1的PWM输出管脚45间歇地输出频率为38KHz的方波电压信号,通过三极管Q1控制红外发射管LED1—LED9的通断,如图9中B波形。在主控芯片IC1的DAC输出管脚14和主控芯片IC1的PWM输出管脚45的共同控制下,红外发射管LED1—LED9分别向前、后、左、右、左前、左后、右前、右后和向上方向间歇地发射38KHz的红外线信号且红外线信号的强度呈周期性阶梯状态变化, 如图9中C波形所示,红外发射管LED1—LED9两端的电压呈周期性阶梯状态变化。
沿前、后、左、右、左前、左后、右前、右后和向上方向排布的红外接收头WH1—WH9分别接收各个方向的红外线信号,红外接收头在没有接收到中心频率为38KHz红外线信号时都会将红外接收头的输出端1置为高电平,任何一个红外接收头接收到障碍物反射回来的中心频率为38KHz红外线信号时都会将该红外接收头的输出端1置为低电平。
如图8—9所示,在主控芯片程序的控制下,主控芯片IC1周期性通过改变DAC的控制值来调整红外发射管LED1—LED9的V_LED电源电压,V_LED电压从2.1V阶梯状态调整到3.0V,DAC的控制值与V_LED电压一一对应。每次主控芯片IC1改变DAC输出管脚14的电压后,主控芯片程序都会判断和记录该V_LED电压下主控芯片IC1的输入端口YK1—YK9的电平状态,如果是高电平则认为没有收到反射信号,如果是低电平则认为收到了反射信号、表示该红外接收头的前方出现了障碍物并且修改主控芯片的方向寄存器的值。V_LED电压从2.1V阶梯状态调整到3.0V一个周期完成后,主控芯片程序会根据这一个周期T内记录的输入端口YK1—YK9的电平变化状态以及出现低电平时主控芯片IC1的DAC输出电压值,来判断是哪个方向出现了障碍物以及依据图12确定障碍物的距离范围。该次距离判断完成后则开始继续进行下一个周期T的距离测量。
参阅图8,主控芯片程序的障碍物检测的具体步骤是:
A.初始化,设置循环次数终止值N=10,设置10个DAC控制值的设定值DAC1=179、DAC2=187、DAC3=196……DAC10=255(这些DAC的设定值分别对应10个V_LED值,V_LED分别为2.1V、2.2V、2.3V……3.0V),设置PWM输出管脚45输出低电平信号;
B.测量循环开始,主控芯片IC1的内部寄存器的方向1寄存器—方向9寄存器清零,设置当前循环次数i=1,配置DAC的控制值=DAC1=179(使V_LED为2.1V),设置增量计数值K=2(i-1)=1(二进制=0000000001B);
C.DAC的控制值改变后,DAC的输出电压有一个跳变和逐渐稳定的过程。当DAC的输出电压稳定后,设置PWM输出管脚45输出38KHz的方波信号;
D.从设置PWM输出管脚45输出38KHz的方波信号到PWM输出管脚正常输出38KHz的方波信号有一个延时和稳定的过程。当输出的38KHz的方波信号稳定后,读取输入管脚25—33的电平信号,如果管脚25为高电平,则主控芯片IC1的内部寄存器的方向1寄存器的值不变,如果管脚25为低电平,则主控芯片IC1的内部寄存器的方向1寄存器的值为方向1寄存器的值加上增量计数值K;如果管脚26为高电平,则主控芯片IC1的内部寄存器的方向2寄存器的值不变,如果管脚26为低电平,则主控芯片IC1的内部寄存器的方向2寄存器的值等于方向2寄存器的值加上增量计数值K;以此类推,完成管脚25—33的检测和与管脚对应的方向1寄存器—方向9寄存器的设置;
E.设置PWM输出管脚45停止38KHz的方波信号且输出低电平信号;
F.设置当前循环次数值i= i+1,配置DAC的控制值= DACi,同时增量计数值K=2(i-1) ;
G.重复C步骤;
H.重复D步骤;
I.重复E步骤;
J.如果当前循环次数值i<N则重复F—I的步骤;
K.如果当前循环次数值i=N,配置DAC的控制值= DACN=255,使V_LED为3.0V,同时增量计数值K=2(N-1)=512(二进制=1000000000B);
L.重复C步骤;
M.重复D步骤;
N.重复E步骤;
O.如果当前循环次数值i>N时,主控芯片IC1参考图12将方向1寄存器—方向9寄存器的值换算成方向1寄存器—方向9寄存器对应的红外接收头WH1—WH9的对应方向的障碍物的距离值。例如:如果方向1寄存器的二进制值是1111111111B,则红外接收头WH1对应方向的障碍物的距离值小于0.2米;如果方向2寄存器的二进制值是1111111110B,则红外接收头WH2对应方向的障碍物的距离值为0.2—0.4米;如果方向3寄存器的二进制值是1111111100B,则红外接收头WH3对应方向的障碍物的距离值0.4—0.6米;如果方向5寄存器的二进制值是1111110000B,则红外接收头WH5对应方向的障碍物的距离值0.8—1.0米;如果方向7寄存器的二进制值是1110000000B,则红外接收头WH7对应方向的障碍物的距离值1.4—1.6米;如果方向8寄存器的二进制值是1000000000B,则红外接收头WH8对应方向的障碍物的距离值1.8—2.0米;如果方向9寄存器的二进制值是0000000000B,则红外接收头WH9对应方向的障碍物的距离值大于2.0米。距离判断完成后将红外接收头WH1—WH9对应方向的障碍物的距离值通过窜口进行发送;
P.回到B步骤再次开始新的测量循环。
如图10,例如前方的红外接收头WH1与障碍物的距离为1.7米时,在V_LED电压从2.1V调整到3.0V的一个变化周期T内前方的红外接收头只有在V_LED电压在2.9V和3.0V时能接收到障碍物反射的红外信号,且前方的红外接收头出现低电平信号的最小V_LED电压为2.9V,方向1寄存器的二进制值是1100000000B。根据图12的对应表可以发现2.9V对应的DAC值为247,对应的距离值为1.8米,所以可以确定障碍物与前方的红外接收头的距离在1.6米—1.8米之间。
如图11,例如右方的红外接收头WH4与障碍物的距离为0.7米时,右方的红外接收头只有在V_LED电压在2.4V、2.5V、2.6V、2.7V、2.8V、2.9V和3.0V时能接收到障碍物反射的红外信号,且右方的红外接收头出现低电平信号的最小V_LED电压为2.4V,方向4寄存器的二进制值是1111111000B。根据图12的对应表可以发现2.4V对应的DAC值为204,对应的距离值为0.8米,所以可以确定障碍物与右方的红外接收头的距离在0.6米—0.8米之间。
沿前、后、左、右、左前、左后、右前、右后和向上方向排布的红外发射管分别通过功率微调电阻R1—R9进行发射功率(强度)的微调,来保证前、后、左、右、左前、左后、右前、右后和上方在相同V_LED电压时红外信号发射功率(强度)基本一致。配合沿前、后、左、右、左前、左后、右前、右后和向上方向排布的红外接收头实现前、后、左、右、左前、左后、右前、右后和向上方向的距离测量。
距离测量结果通过串口输出端口J1和外部设备实现实时通讯。
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定。
Claims (8)
1.一种多方向障碍物检测装置,包括线路板组件(5)、遮光罩组件和底座(9),其特征在于:所述的线路板组件(5)包括沿水平圆周等间距分布的红外发射管(1)、沿水平圆周等间距分布的红外接收头(2)、向上发射的红外发射管(3)和向上接收的红外接收头(4)、主控芯片、电源模块、红外发射管功率调整模块、功率微调模块、载波驱动模块和输出模块;所述的遮光罩组件包括遮光罩主体(6)、上红外接收头安装座(7)和上盖板(8),所述的遮光罩主体(6)沿水平圆周等间距设置有红外发射管(1)的红外发射窗口(12)和红外接收头(2)的红外接收窗口(11),所述的上红外接收头安装座(7)位于遮光罩主体(6)中央上部位置,与遮光罩主体(6)粘贴连接,所述的上盖板(8)位于上红外接收头安装座(7)上部中间位置,与上红外接收头安装座(7)粘贴连接,所述的上红外接收头安装座(7)上部开有向上方向的红外发射窗口(14),所述的上盖板(8)上部开有向上方向的红外接收窗口(13);所述的遮光罩组件套装于线路板组件(5)上部,所述的底座(9)位于线路板组件的下方,所述的遮光罩主体(6)、线路板组件(5)和底座(9)通过螺钉(10)固定连接。
2.根据权利要求1所述的多方向障碍物检测装置,其特征在于:所述的遮光罩组件采用不透光深色塑料材质;所述的遮光罩主体(6)下部开有红外接收头凹槽(15),所述的红外接收头凹槽(15)正好可以容纳沿水平圆周等间距分布的红外接收头(2),使各个红外接收头在遮光罩主体(6)内部彼此之间光学隔离,同时方便遮光罩主体(6)套装在线路板组件(5)上面。
3.根据权利要求1所述的多方向障碍物检测装置,其特征在于:所述的沿水平圆周等间距分布的红外接收头(2)和向上接收的红外接收头(4),采用的是通用的红外线遥控接收设备中常用的一体化红外接收头,也称为红外接收模块或者红外线接收模组 (InfraredReceiver Module,简称IRM),是指把包括红外监测二极管、放大器、限幅器、带通滤波器、积分电路、比较器等电路集成在一个元件中,共同组合封装而成的一体化红外接收头,一体化红外接收头被广泛应用于空调、风扇、暖风机、加湿器、电视、DVD、机顶盒、遥控玩具、灯饰照明等红外线遥控领域。
4.根据权利要求1所述的多方向障碍物检测装置,其特征在于:所述的沿水平圆周等间距分布的红外发射管(1)和沿水平圆周等间距分布的红外接收头(2)的数量各是8个,呈前、后、左、右、左前、左后、右前、右后排列,其红外线发射和红外线接收面向外。
5.根据权利要求1所述的多方向障碍物检测装置,其特征在于:所述的线路板组件(5)的主控芯片IC1的DAC输出和运算放大器IC2组成红外发射管功率调整模块;主控芯片IC1的DAC输出管脚通过串接电阻R10连接运算放大器IC2的正向输入管脚、运算放大器IC2的反向输入管脚通过电阻R11接地,运算放大器IC2的反向输入管脚通过串接电阻R12连接运算放大器IC2的输出端。
6.根据权利要求1所述的多方向障碍物检测装置,其特征在于:所述的线路板组件(5)的运算放大器IC2的输出端与红外发射管LED1—LED9的正向端连接在一起,红外发射管LED1—LED9的负向端分别通过串接功率微调电阻R1—R9与限流电阻R13的一端连接在一起, 限流电阻R13的另一端连接三极管Q1的集电极,三极管Q1的发射极接地,三极管Q1的基极通过串接电阻R14连接主控芯片IC1的PWM输出管脚,红外接收头WH1—WH9的电源端分别与电源VCC2共同连接,红外接收头WH1—WH9的接地端分别接地,红外接收头WH1—WH9的输出端YK1—YK9分别连接主控芯片IC1的输入管脚25—33。
7.一种使用如权利要求1所述的多方向障碍物检测装置的距离测量方法,其特征在于:在主控芯片程序的控制下,主控芯片IC1通过改变DAC的控制值来控制DAC输出管脚周期性地输出阶梯状态变化的电压信号,通过运算放大器IC2构成的缓冲器进行电流和电压放大后提供红外发射管LED1—LED9周期性阶梯状态变化的电源电压V_LED,使得红外发射管LED1—LED9的红外线发射强度呈周期性阶梯状态变化;
在主控芯片程序的控制下,主控芯片IC1的PWM输出管脚间歇地输出频率为38KHz的方波电压信号,通过三极管Q1控制红外发射管LED1—LED9的通断;其工作循环周期与主控芯片IC1的DAC输出管脚输出阶梯状态的电压信号的变化周期同步;
在主控芯片IC1的DAC输出管脚和主控芯片IC1的PWM输出管脚的共同控制下,红外发射管LED1—LED9分别向前、后、左、右、左前、左后、右前、右后和向上方向间歇地发射38KHz的红外线信号且红外线信号的强度呈周期性阶梯状态变化。
8.根据权利要求7所述的多方向障碍物检测装置的距离测量方法,其特征在于,主控芯片IC1采用下列步骤:
A.初始化,设置循环次数终止值=N,设置N个DAC的控制值的设定值DAC1—DACN,设置PWM输出管脚输出低电平信号;
B.测量循环开始,主控芯片IC1的内部寄存器的方向1寄存器—方向9寄存器清零,设置当前循环次数i=1,配置DAC的控制值=DAC1,设置增量计数值K=2(i-1);
C.当DAC的输出电压稳定后,设置PWM输出管脚输出38KHz的方波信号;
D.当PWM输出的38KHz的方波信号稳定后,读取主控芯片IC1输入管脚25—33的电平信号;如果管脚25为高电平,则主控芯片IC1的内部寄存器的方向1寄存器的值不变,如果管脚25为低电平,则主控芯片IC1的内部寄存器的方向1寄存器的值为方向1寄存器的值加上增量计数值K;如果管脚26为高电平,则主控芯片IC1的内部寄存器的方向2寄存器的值不变,如果管脚26为低电平,则主控芯片IC1的内部寄存器的方向2寄存器的值等于方向2寄存器的值加上增量计数值K;以此类推,完成管脚25—33的检测和与管脚对应的方向1寄存器—方向9寄存器的值的设置;
E.设置PWM输出管脚停止38KHz的方波信号且输出低电平信号;
F.设置当前循环次数值i=当前循环次数值i+1,配置DAC的控制值= DACi,同时增量计数值K=2(i-1);
G.重复C步骤;
H.重复D步骤;
I.重复E步骤;
J.如果当前循环次数值i<N则重复F—I的步骤;
K.如果当前循环次数值i=N,配置DAC的控制值= DACN,同时增量计数值K=2(N-1);
L.重复C步骤;
M.重复D步骤;
N.重复E步骤;
O.如果当前循环次数值i>N时,主控芯片IC1将方向1寄存器—方向9寄存器的值换算成方向1寄存器—方向9寄存器对应的红外接收头WH1—WH9的对应方向的障碍物的距离值,换算完成后将红外接收头WH1—WH9的对应方向的障碍物的距离值通过输出模块进行发送;
P.回到B步骤再次开始新的测量循环。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011037942.9A CN113109836A (zh) | 2020-09-28 | 2020-09-28 | 一种多方向障碍物检测装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011037942.9A CN113109836A (zh) | 2020-09-28 | 2020-09-28 | 一种多方向障碍物检测装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113109836A true CN113109836A (zh) | 2021-07-13 |
Family
ID=76709116
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011037942.9A Pending CN113109836A (zh) | 2020-09-28 | 2020-09-28 | 一种多方向障碍物检测装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113109836A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113824440A (zh) * | 2021-08-16 | 2021-12-21 | Tcl通力电子(惠州)有限公司 | 控制结构、电子设备及其控制方法 |
CN114355470A (zh) * | 2021-12-21 | 2022-04-15 | 厦门阳光恩耐照明有限公司 | 一种抗干扰主动式红外感应电路 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103502841A (zh) * | 2011-05-11 | 2014-01-08 | 莱达科技股份有限公司 | 在高环境背景光中的多视场无扫描仪光学测距仪 |
CN107315181A (zh) * | 2016-04-26 | 2017-11-03 | 零度智控(北京)智能科技有限公司 | 一种避障方法及装置、飞行器 |
CN109031325A (zh) * | 2018-06-08 | 2018-12-18 | 珠海市微半导体有限公司 | 一种基于红外调制的障碍物检测装置、检测方法及机器人 |
WO2019056788A1 (zh) * | 2017-09-20 | 2019-03-28 | 歌尔股份有限公司 | 红外测障方法、装置及机器人 |
CN212932960U (zh) * | 2020-09-28 | 2021-04-09 | 黄海容 | 一种多方向障碍物检测装置 |
-
2020
- 2020-09-28 CN CN202011037942.9A patent/CN113109836A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103502841A (zh) * | 2011-05-11 | 2014-01-08 | 莱达科技股份有限公司 | 在高环境背景光中的多视场无扫描仪光学测距仪 |
CN107315181A (zh) * | 2016-04-26 | 2017-11-03 | 零度智控(北京)智能科技有限公司 | 一种避障方法及装置、飞行器 |
WO2019056788A1 (zh) * | 2017-09-20 | 2019-03-28 | 歌尔股份有限公司 | 红外测障方法、装置及机器人 |
CN109031325A (zh) * | 2018-06-08 | 2018-12-18 | 珠海市微半导体有限公司 | 一种基于红外调制的障碍物检测装置、检测方法及机器人 |
CN212932960U (zh) * | 2020-09-28 | 2021-04-09 | 黄海容 | 一种多方向障碍物检测装置 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113824440A (zh) * | 2021-08-16 | 2021-12-21 | Tcl通力电子(惠州)有限公司 | 控制结构、电子设备及其控制方法 |
CN114355470A (zh) * | 2021-12-21 | 2022-04-15 | 厦门阳光恩耐照明有限公司 | 一种抗干扰主动式红外感应电路 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113109836A (zh) | 一种多方向障碍物检测装置 | |
CA2755357C (en) | Dual voltage and current control feedback loop for an optical sensor system | |
WO2020142949A1 (zh) | 一种光发射装置及测距装置、移动平台 | |
CN212932960U (zh) | 一种多方向障碍物检测装置 | |
US20210368596A1 (en) | Dimming Signal Processing Circuit Having Multiple Functions | |
CN111316130B (zh) | 一种测距装置以及基于测距装置的时间测量方法 | |
US9855512B1 (en) | Horizontal control of an indoor flying toy | |
CN110018486A (zh) | 一种基于tof的多波束激光测距传感器 | |
US11754684B2 (en) | Optical light emitter device and method | |
CN210430414U (zh) | 多通道激光驱动装置及电子设备 | |
CN116368628A (zh) | 距离测量传感器和距离测量系统 | |
CN111885569A (zh) | 视觉刺激与响应采集控制系统 | |
CN106405565A (zh) | 一种无人机避障/定高系统 | |
CN219456506U (zh) | 激光雷达系统及其接收装置 | |
Rishabh | Design of autonomous line follower robot with obstacle avoidance | |
Abdullah Sani et al. | Cordless cart follower for wheelchair user | |
CN212623752U (zh) | 一种基于51单片机的小车避障装置 | |
Dang et al. | Designing a cost-effective autonomous vehicle control system kit (AVCS Kit) | |
CN218138079U (zh) | 一种宠物陪伴机器人驱动系统 | |
CN220913352U (zh) | 避障检测装置及水下机器人 | |
CN219105649U (zh) | 一种智能小车的可拆卸控制板 | |
CN221844579U (zh) | 显尘光控制电路、显尘光控制系统和吸尘器 | |
WO2023080152A1 (ja) | 方向検出器、被操縦物体、操縦器、及び距離検出器 | |
CN212933826U (zh) | 一种无人驾驶汽车教学实训装置 | |
CN112731427A (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 |