CN208110389U - 一种无人机智能避障装置及无人机 - Google Patents
一种无人机智能避障装置及无人机 Download PDFInfo
- Publication number
- CN208110389U CN208110389U CN201820566587.6U CN201820566587U CN208110389U CN 208110389 U CN208110389 U CN 208110389U CN 201820566587 U CN201820566587 U CN 201820566587U CN 208110389 U CN208110389 U CN 208110389U
- Authority
- CN
- China
- Prior art keywords
- avoidance
- pwm
- unmanned plane
- chip microcontroller
- distance
- 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.)
- Expired - Fee Related
Links
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本实用新型提供了一种无人机智能避障装置及无人机。该自动避障装置包括:测距传感器,接收机,pwm转ppm模块,单片机和飞控。该装置可以根据飞行速度自动调节避障范围,提高无人机的飞行速度,其避障范围也相应增大;降低无人机的飞行速度,其避障范围也相应减小,使得无人机对飞行环境有着更高的适应性,能在狭窄的环境中正常工作。该装置还可以实现改变无人机的飞行速度,不仅可以使得四个方向的避障范围都能同比例地自动增大或减小,而且可以只是改变飞行方向上的避障距离,却让其他三个方向保持着最小避障距离,使得避障无人机在通过巷道环境时,能很好地提高飞行速度,而不会对两侧的墙体产生非正常的避障效应。
Description
技术领域
本实用新型涉及无人机领域,更具体地,涉及一种无人机智能避障装置及无人机。
背景技术
无人机作为一种新工具,能很好代替人去执行任务,如送快递、侦查监测等,人们希望无人机在执行任务时能够自我保护,因此自动避障技术成为了无人机领域发展的热点。然而,现有的无人机的避障范围是固定的,而且该固定的避障距离一般在3米以上,包括大疆无人机、intel无人机等品牌,避障距离被设定为固定值,对飞行器的使用环境有着局限性,例如不能在小于避障范围的环境中正常工作,否则在这些环境中飞行器的某两个相对方向的避障效应会造成飞行不稳定,存在因避障距离固定且较大而不能在狭窄的环境中正常工作的问题。
因此,提供一种可以灵活自动调整避障范围的无人机智能避障装置对于无人机的实际应用具有非常重要的作用,对于改善无人机的应用效果具有很好的促进作用。
实用新型内容
本实用新型要解决的技术问题是克服现有技术中无人机避障范围固定,且避障范围较大的不足,提供一种无人机智能避障装置。
本实用新型的目的是提供一种无人机。
本实用新型上述目的通过以下技术方案实现:
一种无人机智能避障装置,包括:
包括测距传感器、接收机、pwm转ppm模块、单片机和飞控,
其中所述测距传感器用于探测无人机四个方向与障碍物之间的距离;所述接收机用于接收无人机的飞行速度pwm信号数值;所述pwm转ppm模块用于根据飞行速度确定避障距离,所述单片机用于数据处理;
其连接结构为所述测距传感器连接所述单片机、所述单片机和接收机分别连接所述pwm转ppm模块,所述pwm转ppm模块连接所述飞控。
上述无人机智能避障装置的工作方法如下:
S1. 无人机飞行过程中,单片机采集测距传感器实时探测前方障碍物的距离,传输给pwm转ppm模块;
S2. 接收机接收影响飞行速度的pwm信号数值,传输给pwm转ppm模块;
S3. pwm转ppm模块读取的影响飞行速度的pwm信号数值,并根据比例算法运算得到避障距离;
S4. pwm转ppm模块根据避障距离和和来自单片机的障碍物的距离,进行比较运算,判断是否对飞行安全构成了威胁,并输出智能避障飞行信息;
S5. 飞控接收pwm转ppm模块的智能避障飞行信息,输出电信号控制电机转动,调整无人机智能避障飞行。
其中,S3中所述比例算法的计算公式为BZ=(|MC - 1400|max)/6,其中BZ为避障距离,MC为影响飞行速度的pwm信号数值,包括pwm_end0和pwm_end1,所述pwm_end0为接收机第一通道的飞行速度pwm信号数值,为左右方向的飞行速度;所述pwm_end1为接收机第二通道的飞行速度pwm信号数值,为前后方向的飞行信息;1400为pwm信号数值变化的基准值;|MC - 1400|max为四个方向中的pwm最大变化值;6为比例因子,是|MC - 1400|max与BZ的比值。
|MC-1400|max代表某一时刻脉冲量最大差值,用最大绝对值表示,该值越大,说明飞行器在某一方向的飞行速度越大;当飞行器往某个方向飞行时,脉冲量会相对基准值1400变化,考虑其它方向存在脉冲量的波动情况,因此要选择脉冲量最大差值。例如先计算pwm_end0–1400和pwm_end1–1400的绝对值,即| pwm_end0–1400|和| pwm_end0–1400|,然后对两者进行比较,择取其中最大值,并初步选定了方向,若| pwm_end0–1400| > | pwm_end1–1400|,说明飞行方向为左右方向中的其一;若| pwm_end0–1400| < | pwm_end1–1400|,说明飞行方向为前后方向中的其一。
上述第一种避障模式运算可实现飞行器根据飞行速度自动调节避障距离;提高飞行速度,避障距离自动增大,以保证足够的避障距离,避免高速飞行时发生避障距离不足的现象;降低飞行速度,避障距离自动减小,使得飞行器可以缓慢通过一些狭窄的环境。
上述避障模式还可以为第二种模式,具体为:所述运算为在执行比例算法前根据|MC-1400|max初步选定避障方向,再根据MC与1400之间的大小确定需要调节避障范围的具体方向,通过比例运算计算出具体方向的避障距离,其他3个方向的避障距离设置最小避障距离。
在第一种避障模式的基础上,进一步的,判断MC与1400之间的大小,即可确定需要调节避障范围的具体方向;例如,某一时刻通过程序运算获知| pwm_end0–1400| > | pwm_end1–1400|,并且pwm_end0 < 1400,说明飞行器正在以某一速度向左飞行;加设BZ1(左方向的避障距离)、BZ2(右方向的避障距离)、BZ3(前方向的避障距离))和BZ4(后方向的避障距离)四个变量,当飞行器往某一方向飞行时,在该飞行方向上需要与之飞行速度匹配的避障距离,然而对于其它三个方向上可不需要该匹配性,直接保持最小避障距离即可,因此,在程序中的运算方法为(假定飞行器正在向前飞):BZ3= BZ(与飞行速度匹配的避障距离),BZ1=BZ2=BZ4=30(最小避障距离)。
模式二可实现当飞行器往某一方向飞行时,在该飞行方向上需要与之飞行速度匹配的避障距离,然而对于其它三个方向上可不需要该匹配性,直接保持最小避障距离即可,有利于在狭窄环境中作业。
上述两种避障模式的切换通过地面站的二位开关切换。两种模式之间的切换可通过地面站的二位开关切换,该二位开关通过无线连接接收机的第七通道,事先设定好外部中断触发对应的中断处理程序,每隔一段时间读取开关对应第七通道的状态值,从而判断开关的切换情况,进而通过中断处理程序切换两种避障模式。
本实用新型的pwm转ppm模块对无人机飞行时地面给出的飞行速度信息进行比例算法计算出与飞行速度相匹配的避障距离,并通过与实际障碍物距离比较输出电信号控制无人机飞行,可以很好的根据无人机作业时的实际飞行速度和实际环境条件情况自动调节其避障范围,提高无人机的飞行速度,其避障范围也相应增大,以保证足够的避障距离,避免高速飞行时发生避障距离不足的现象;降低无人机的飞行速度,其避障范围也相应减小,使得无人机对飞行环境有着更高的适应性,解决了某些无人机因避障距离固定且较大而不能在狭窄的环境中正常工作的问题。
优选地,所述测距传感器为激光测距传感器。
优选地,所述单片机为具有五个串口的ARM单片机。
其中,避障装置各部件的连接方法优选为:所述接收机的通道一CH1至通道八CH8的信号线分别与pwm转ppm模块的PA4、PA5、PB10~14和PA8电连接;所述测距传感器的接口为TX和RX接口,4个测距传感器的TX接口分别与单片机的USART_RX2~5接口电连接、RX接口分别与单片机的USART_TX2~5接口电连接,进行串口通信;所述pwm转ppm模块的USART_TX2和USART_RX2接口分别与单片机的USART_RX1和USART_TX1接口电连接,进行串口通信;所述pwm转ppm模块的ppm信号输出引脚与飞控的ppm信号输入引脚电连接 。
一种无人机,包括机架和上述无人机智能避障装置。
优选地,所述机架包括由下而上的第一层平台、第二层平台和第三层平台、脚架、电机和螺旋桨。
优选地,所述机架以十字样式设置;所述电机和螺旋桨设置在四个机臂轴的末端,构成四旋翼飞行器;所述飞控设置在第二层平台的上表面中心;所述pwm转ppm模块、接收机、单片机设置在第三层平台的上表面;所述激光测距传感器设置在第一层平台的前后左右四个方向。
以四旋翼飞行器为运动平台,多个stm32处理器作为控制与运算中心,采用比例算法实现根据飞行速度自动调节避障距离,通过布置在前后左右四个方向的激光测距传感器实现检测障碍物的距离,再通过单片机中的stm32处理器比较避障距离与障碍物距离,从而输出电信号控制电机转速,实现智能避障:提高无人机的飞行速度,其避障范围也相应增大;降低无人机的飞行速度,其避障范围也相应减小。
与现有技术相比,本实用新型的有益效果是:
本实用新型提供了一种无人机智能避障装置,该装置可以根据飞行速度自动调节避障范围,提高无人机的飞行速度,其避障范围也相应增大;降低无人机的飞行速度,其避障范围也相应减小,使得无人机对飞行环境有着更高的适应性,解决了某些无人机因避障距离固定且较大而不能在狭窄的环境中正常工作的问题。该装置还可以实现改变无人机的飞行速度,不仅可以使得四个方向的避障范围都能同比例地自动增大或减小,而且可以只是改变飞行方向上的避障距离,却让其他三个方向保持着最小避障距离,使得避障无人机在通过巷道环境时,能很好地提高飞行速度,而不会对两侧的墙体产生非正常的避障效应。
附图说明
图1为无人机智能避障装置结构示意图。
图2为无人机结构示意图。
图3为避障装置电性连接示意图。
具体实施方式
附图仅用于示例性说明,不能理解为对本专利的限制;为了更好说明本实施例,附图某些部件会有省略、放大或缩小,并不代表实际产品的尺寸;对于本领域技术人员来说,附图中某些公知结构及其说明可能省略是可以理解的。附图中描述位置关系仅用于示例性说明,不能理解为对本专利的限制。
实施例1
一种无人机智能避障装置,如图1所示,包括:测距传感器11、接收机9、pwm转ppm模块8、ARM单片机10、PIX4飞控7和程序模块,
其中测距传感器用于探测无人机四个方向与障碍物之间的距离;接收机用于接收无人机的飞行速度pwm信号数值; pwm转ppm模块用于根据飞行速度确定避障距离,单片机用于数据处理;
其连接结构为测距传感器和pwm转ppm模块和飞控分别连接单片机,接收机连接pwm转ppm模块。
程序模块包括步骤:
S1. 无人机飞行过程中,单片机采集测距传感器实时探测前方障碍物的距离,传输给pwm转ppm模块;
S2. 接收机接收影响飞行速度的pwm信号数值,传输给pwm转ppm模块;
S3. pwm转ppm模块读取的影响飞行速度的pwm信号数值,并根据比例算法运算得到避障距离;
S4. pwm转ppm模块根据避障距离和和来自单片机的障碍物的距离,进行比较运算,判断是否对飞行安全构成了威胁,并输出智能避障飞行信息;
S5. 飞控接收pwm转ppm模块的智能避障飞行信息,输出电信号控制电机转动,调整无人机智能避障飞行。
其中各部件的电性连接示意图如图3所示。
实施例2
一种无人机,如图2所示,包括机架和无人机智能避障装置,机架包括第一层平台1、第二层平台2、第三层平台3、脚架4、电机5和螺旋桨6,自动避障装置包括PIX4飞控7、pwm转ppm模块8、接收机9、ARM单片机10、激光测距传感器11。
机架以十字样式设置,电机5、螺旋桨6设置在四个机臂轴的末端,构成四旋翼飞行器。PIX4飞控7设置在第二层平台2的上表面中心,pwm转ppm模块8、接收机9、ARM单片机10设置在第三层平台3的上表面,激光测距传感器11设置在第一层平台的前后左右四个方向。接收机9的通道一(CH1)至通道八(CH8)的信号线分别与pwm转ppm模块8的PA4、PA5、PB10至PB14、PA8电连接;ARM单片机10特指具有五个串口的ARM单片机;4个激光测距传感器11的TX、RX接口分别与ARM单片机10的USART_RX2 - USART_RX5、USART_TX2 - USART_TX5接口电连接,进行串口通信,ARM单片机10采集四个方向的测距信息;pwm转ppm模块8的USART_TX2、USART_RX2分别与ARM单片机10的USART_RX1、USART_TX1接口电连接,进行串口通信,ARM单片机10将四个方向的测距信息整理为数组comdata形式发送给pwm转ppm模块8;pwm转ppm模块8的ppm信号输出引脚与PIX4飞控7的ppm信号输入引脚电连接,进行模拟信号的传输。
避障方法的具体步骤为:
基于pwm转ppm模块,读取来自接收机的第一通道和第二通道的pwm值,第一通道记为pwm_end0(其影响左右方向)、第二通道记为pwm_end1(其影响前后方向),并与相应的通道的基准值(1400)比较,基准值是指飞行器在定点悬停时,某一通道的稳定值,如果飞行器往某一方向飞行时,飞行器在该方向上的脉冲值会相对基准值发生偏差变化,变大或变小就是发生于飞行方向的相对性之间。
比例算法,原理式是BZ=(|MC - 1400|max)/6,其中BZ代表避障距离;MC代表脉冲值,即MC= pwm_end0或pwm_end1,与飞行速度有关;|MC - 1400|max代表某一时刻脉冲量最大差值,用最大绝对值表示,该值越大,说明飞行器在某一方向的飞行速度越大;当飞行器往某个方向飞行时,脉冲量会相对基准值1400变化,考虑其它方向存在脉冲量的波动情况,因此要选择脉冲量最大差值。
避障模式一:
(1)先计算pwm_end0–1400和pwm_end1–1400的绝对值,即| pwm_end0– 1400|和|pwm_end0–1400|,然后对两者进行比较,择取其中最大值,并初步选定了方向,若| pwm_end0–1400| > | pwm_end1–1400|,说明飞行方向为左右方向中的其一;若| pwm_end0–1400| < | pwm_end1–1400|,说明飞行方向为前后方向中的其一;
(2)通过比例运算BZ=(|MC - 1400|max)/6,即可实现飞行器根据飞行速度自动调节避障距离;提高飞行速度,避障距离自动增大,以保证足够的避障距离,避免高速飞行时发生避障距离不足的现象;降低飞行速度,避障距离自动减小,使得飞行器可以缓慢通过一些狭窄的环境。
避障模式二:
(1)在(1)的基础上,进一步的,判断MC与1400之间的大小,即可确定需要调节避障范围的具体方向;例如,某一时刻通过程序运算获知| pwm_end0– 1400| > | pwm_end1–1400|,并且pwm_end0< 1400,说明飞行器正在以某一速度向左飞行,该飞行速度的大小由脉冲量与基准值之间的差值决定;
(2)加设BZ1(左方向的避障距离)、BZ2(右方向的避障距离)、BZ3(前方向的避障距离))和BZ4(后方向的避障距离)四个变量,当飞行器往某一方向飞行时,在该飞行方向上需要与之飞行速度匹配的避障距离,然而对于其它三个方向上可不需要该匹配性,直接保持最小避障距离即可,因此,在程序中的运算方法为(假定飞行器正在向前飞):BZ3= BZ(与飞行速度匹配的避障距离),BZ1=BZ2=BZ4=30(最小避障距离)。
避障模式一可以使得四个方向的避障范围都能同比例地自动增大或减小,避障模式二可以只是改变飞行方向上的避障距离,却让其他三个方向保持着最小避障距离。两种模式之间的切换可通过地面站的二位开关切换,该二位开关通过无线连接接收机的第七通道,事先设定好外部中断触发对应的中断处理程序,每隔一段时间读取开关对应第七通道的状态值,从而判断开关的切换情况,进而通过中断处理程序切换两种避障模式。
显然,本实用新型的上述实施例仅仅是为清楚地说明本实用新型所作的举例,而并非是对本实用新型的实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷举。凡在本实用新型的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本实用新型权利要求的保护范围之内。
Claims (7)
1.一种无人机智能避障装置,其特征在于,包括测距传感器、接收机、pwm转ppm模块、单片机和飞控,
其中所述测距传感器用于探测无人机四个方向与障碍物之间的距离;所述接收机用于接收无人机的飞行速度pwm信号数值;所述pwm转ppm模块用于根据飞行速度确定避障距离,所述单片机用于数据处理;
其连接结构为所述测距传感器连接所述单片机、所述单片机和接收机分别连接所述pwm转ppm模块,所述pwm转ppm模块连接所述飞控。
2.如权利要求1所述无人机智能避障装置,其特征在于,所述测距传感器为激光测距传感器。
3.如权利要求1所述无人机智能避障装置,其特征在于,单片机为具有五个串口的ARM单片机。
4.如权利要求1所述无人机智能避障装置,其特征在于,所述接收机的通道一CH1至通道八CH8的信号线分别与pwm转ppm模块的PA4、PA5、PB10~14和PA8电连接;所述测距传感器的接口为TX和RX接口,4个测距传感器的TX接口分别与单片机的USART_RX2~5接口电连接、RX接口分别与单片机的的USART_TX2~5接口电连接,进行串口通信;所述pwm转ppm模块的USART_TX2和USART_RX2接口分别与单片机的USART_RX1和USART_TX1接口电连接,进行串口通信;所述pwm转ppm模块的PA12引脚引脚与飞控的ppm信号输入引脚电连接。
5.一种无人机,其特征在于,包括机架和权利要求1至4任一项所述无人机智能避障装置。
6.如权利要求5所述无人机,其特征在于,所述机架包括由下而上的第一层平台、第二层平台和第三层平台、脚架、电机和螺旋桨。
7.如权利要求6所述无人机,其特征在于,所述机架以十字样式设置;所述电机和螺旋桨设置在四个机臂轴的末端,构成四旋翼飞行器;所述飞控设置在第二层平台的上表面中心;所述pwm转ppm模块、接收机、单片机设置在第三层平台的上表面;所述激光测距传感器设置在第一层平台的前后左右四个方向。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201820566587.6U CN208110389U (zh) | 2018-04-20 | 2018-04-20 | 一种无人机智能避障装置及无人机 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201820566587.6U CN208110389U (zh) | 2018-04-20 | 2018-04-20 | 一种无人机智能避障装置及无人机 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN208110389U true CN208110389U (zh) | 2018-11-16 |
Family
ID=64119328
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201820566587.6U Expired - Fee Related CN208110389U (zh) | 2018-04-20 | 2018-04-20 | 一种无人机智能避障装置及无人机 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN208110389U (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111240352A (zh) * | 2018-11-28 | 2020-06-05 | 苏州慧德仿真技术有限公司 | 一种用于无人机飞行模式控制的系统及方法 |
CN112068597A (zh) * | 2020-09-25 | 2020-12-11 | 中国直升机设计研究所 | 一种基于前驱无人机的直升机避障系统 |
WO2022021214A1 (zh) * | 2020-07-30 | 2022-02-03 | 深圳市大疆创新科技有限公司 | 无人飞行器的控制方法、装置、无人飞行器及存储介质 |
-
2018
- 2018-04-20 CN CN201820566587.6U patent/CN208110389U/zh not_active Expired - Fee Related
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111240352A (zh) * | 2018-11-28 | 2020-06-05 | 苏州慧德仿真技术有限公司 | 一种用于无人机飞行模式控制的系统及方法 |
WO2022021214A1 (zh) * | 2020-07-30 | 2022-02-03 | 深圳市大疆创新科技有限公司 | 无人飞行器的控制方法、装置、无人飞行器及存储介质 |
CN112068597A (zh) * | 2020-09-25 | 2020-12-11 | 中国直升机设计研究所 | 一种基于前驱无人机的直升机避障系统 |
CN112068597B (zh) * | 2020-09-25 | 2022-09-13 | 中国直升机设计研究所 | 一种基于前驱无人机的直升机避障系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN208110389U (zh) | 一种无人机智能避障装置及无人机 | |
CN108427435A (zh) | 一种智能避障装置及其应用的无人机 | |
CN102662377B (zh) | 基于无线传感器网络的多移动机器人编队系统和编队方法 | |
CN107278282B (zh) | 路径规划的方法、装置、飞行控制系统、全方位避障系统与无人机 | |
CN104991560B (zh) | 自主移动式智能机器人 | |
CN110901895A (zh) | 一种无人机舵机控制驱动系统 | |
CN106970651A (zh) | 一种基于视觉导航的四旋翼无人机的自主飞行系统及控制方法 | |
EP3707574A1 (en) | Distributed light detection and ranging (lidar) management system | |
CN106787986A (zh) | 电机加减速控制方法和三维移液装置 | |
KR102340694B1 (ko) | 무인기의 장애물 충돌 관리장치 | |
US20200103923A1 (en) | Obstacle detection method and apparatus, and unmanned aerial vehicle | |
CN105359046A (zh) | 遥控装置 | |
CN107005129A (zh) | 一种磁编舵机 | |
CN105137988A (zh) | 单核低速两轮微微鼠全数字导航伺服控制器及控制方法 | |
CN107909820A (zh) | 一种集成汽车轮轴识别功能的激光扫描分车器及实现方法 | |
CN108241317A (zh) | 一种贴片机8轴运动控制系统 | |
CN206788588U (zh) | 一种贴片机8轴运动控制系统 | |
CN103713334B (zh) | 一种用于隧道掘进机地质超前预报的时分复用联用装置 | |
CN203909615U (zh) | 基于arm9四轮快速微电脑鼠连转冲刺伺服系统 | |
CN105824270A (zh) | 多轴运动控制器及其闭环pwm脉冲的控制方法 | |
CN208358860U (zh) | 机器人的障碍探测装置及机器人 | |
CN104950888A (zh) | 十七自由度人形机器人及其控制方法 | |
CN212623752U (zh) | 一种基于51单片机的小车避障装置 | |
CN113156982B (zh) | 一种水下机器人控制系统及其控制方法 | |
CN211281440U (zh) | 一种无人机舵机控制模块 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20181116 Termination date: 20210420 |