CN113050668A - 一种使用事件相机位置反馈的无人机自抗扰控制装置 - Google Patents
一种使用事件相机位置反馈的无人机自抗扰控制装置 Download PDFInfo
- Publication number
- CN113050668A CN113050668A CN202110216263.6A CN202110216263A CN113050668A CN 113050668 A CN113050668 A CN 113050668A CN 202110216263 A CN202110216263 A CN 202110216263A CN 113050668 A CN113050668 A CN 113050668A
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- data
- control
- module
- 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
- 230000000007 visual effect Effects 0.000 claims abstract description 41
- 238000006243 chemical reaction Methods 0.000 claims abstract description 31
- 238000000034 method Methods 0.000 claims abstract description 29
- 238000004364 calculation method Methods 0.000 claims abstract description 19
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims description 39
- 238000012545 processing Methods 0.000 claims description 24
- 238000005259 measurement Methods 0.000 claims description 20
- 230000008447 perception Effects 0.000 claims description 15
- 230000033001 locomotion Effects 0.000 claims description 11
- 230000008859 change Effects 0.000 claims description 8
- 238000004891 communication Methods 0.000 claims description 4
- 230000004888 barrier function Effects 0.000 claims description 3
- 238000007689 inspection Methods 0.000 abstract description 4
- 230000006870 function Effects 0.000 description 10
- 238000001914 filtration Methods 0.000 description 6
- 238000010586 diagram Methods 0.000 description 4
- 230000005540 biological transmission Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 238000007405 data analysis Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 238000013507 mapping Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- PXFBZOLANLWPMH-UHFFFAOYSA-N 16-Epiaffinine Natural products C1C(C2=CC=CC=C2N2)=C2C(=O)CC2C(=CC)CN(C)C1C2CO PXFBZOLANLWPMH-UHFFFAOYSA-N 0.000 description 1
- ATJFFYVFTNAWJD-UHFFFAOYSA-N Tin Chemical compound [Sn] ATJFFYVFTNAWJD-UHFFFAOYSA-N 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种使用事件相机位置反馈的无人机自抗扰控制装置,根据改进后的无人机控制方法,获取改进遥控系统产生的摇杆偏移数据,并利用所述视觉位置估计系统采集当前无人机的环境图像数据,通过无人机控制系统对所述摇杆偏移数据和获取的感知距离进行控制量转换,并将转换结果进行位置环和姿态环的数据计算,根据计算结果,对当前所述无人机进行位置和姿态的控制,增强无人机飞行的安全性,并且有效解决无人机在室内巡检时由于光线较暗而导致传统相机无法工作的问题,扩大无人机在实际应用中的使用范围。
Description
技术领域
本发明涉及无人机技术领域,尤其涉及一种使用事件相机位置反馈的无人机自抗扰控制装置。
背景技术
目前在利用微型无人机巡检电力及能源系统线路等方面已经有了很多的应用,但是在矿井、管道、隧道等室内复杂环境的情况,无人机的飞行常常存在问题;传统的无人机控制方法主要是通过无人机上面携带的惯性测量单元来获得无人机的姿态数据,然后输入到控制器去对无人机进行控制,但是由于缺少位置测量单元,单纯依靠惯性导航系统来对位置进行估计误差较大,所以无人机难以保持在一个点稳定飞行;要使无人机保持在一个点稳定飞行通常需要靠飞行操作员通过操纵遥控器来进行精确的控制,这对飞行操作员的操作能力要求较高,且抗干扰性不强,在实际应用中具有局限性。
发明内容
本发明的目的在于提供一种使用事件相机位置反馈的无人机自抗扰控制装置,扩大无人机在实际应用中的使用范围。
为实现上述目的,本发明提供了一种使用事件相机位置反馈的无人机自抗扰控制装置,所述使用事件相机位置反馈的无人机自抗扰控制装置包括改进遥控系统、视觉位置估计系统和无人机控制系统,所述改进遥控系统与所述无人机控制系统通过无线通信链路连接,所述视觉位置估计系统与所述无人机控制系统通过UART总线连接;
所述改进遥控系统,用于根据改进后的无人机控制方法,利用SBUS协议将遥控器的摇杆偏移数据进行传输;
所述视觉位置估计系统,用于获取当前无人机的图像数据,并使用半密集深度图重建环境,同时估计双目事件摄像机平台的姿态,并将估计的得到的位置和姿态数据传输至所述无人机控制系统;
所述无人机控制系统,用于接收所述摇杆偏移数据和所述视觉位置估计系统处理后的数据,并根据对所有的数据进行转换和计算结果,对当前所述无人机的位置和姿态进行控制。
其中,所述无人机控制系统包括飞行控制模块和多个距离感知模块,所述飞行控制模块与所述飞行控制模块和多个所述距离感知模块连接,多个所述距离感知模块还与所述飞行控制模块连接;
所述飞行控制模块,用于使用地址轮询法获取所述距离感知模块获取的感知距离,并接收所述改进遥控系统和所述视觉位置估计系统传输的数据;然后根据接收的所有数据,对当前所述无人机飞行进行调整;
多个所述距离感知模块,用于获取当前时点无人机的前、后、左、右、上、下六个方向与墙壁或者障碍物之间的所述感知距离。
其中,所述无人机控制系统还包括惯性测量模块,所述惯性测量模块与所述飞行控制模块连接;
所述惯性测量模块,用于获取当前所述无人机的惯性数据,并传输至所述飞行控制模块中。
其中,所述飞行控制模块包括位置控制单元、姿态控制单元和控制量转换单元,所述位置控制单元与所述视觉位置估计系统连接,所述姿态控制单元与所述惯性测量模块和所述位置控制单元连接,所述控制量转换单元与多个所述距离感知模块、所述改进遥控系统和所述位置控制单元连接;
所述控制量转换单元,用于对接收到的所述感知距离和所述摇杆偏移数据进行控制量的转换处理;
所述位置控制单元,用于结合所述视觉位置估计系统的数据,对转换后的数据进行位置环计算,得到对应的姿态数据;
所述姿态控制单元,用于根据所述姿态数据和所述惯性测量模块的所述惯性数据进行倾斜角度的计算。
其中,所述视觉位置估计系统包括双目相机模块和视觉数据处理模块,所述视觉处理模块与所述双目相机模块通过USB接口连接;
所述双目相机模块,用于采集当前所述无人机的环境图像,并通过USB接口向所述视觉数据处理模块传输对应的像素亮度变化数据;
所述视觉数据处理模块,用于根据所述像素亮度变化数据,使用半密集深度图重建环境,并估计所述双目相机模块的姿态。
其中,对所述摇杆偏移数据的转换方法为:
根据所述改进遥控系统的遥控周期,分别对所述改进遥控系统产生的高度控制量、左右移动控制量、前后移动控制量、偏航角控制量进行积分,完成控制量的转换,其中,所述遥控周期为遥控器的摇杆从零位,到非零位,再到零位的时间。
其中,所述改进后的无人机控制方法为:
利用左手的摇杆的Y轴对无人机高度的控制,其中高度控制的依据为无人机对地和对天的高度的比值;利用左手的摇杆的X轴对偏航角进行控制,摇杆偏移量是多少,则偏航角偏移的角度值就是多少;利用右手的摇杆的X轴、Y轴用来对无人机前进和后退、左移和右移的控制,其中前进后退、左移右移的依据为无人机前后、左右与墙壁或者障碍物距离的比例。
本发明的一种使用事件相机位置反馈的无人机自抗扰控制装置,根据改进后的无人机控制方法,获取改进遥控系统产生的摇杆偏移数据,并利用所述视觉位置估计系统采集当前无人机的环境图像数据,通过无人机控制系统对所述摇杆偏移数据和获取的感知距离进行控制量转换,并将转换结果进行位置环和姿态环的数据计算,根据计算结果,对当前所述无人机进行位置和姿态的控制,增强无人机飞行的安全性,并且有效解决无人机在室内巡检时由于光线较暗而导致传统相机无法工作的问题,扩大无人机在实际应用中的使用范围。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明提供的一种使用事件相机位置反馈的无人机自抗扰控制装置的结构示意图。
图2是本发明提供的无人机控制系统的结构示意图。
图3是本发明提供的飞行控制模块的结构示意图。
图4是本发明提供的视觉位置估计系统的结构示意图。
1-改进遥控系统、2-视觉位置估计系统、3-无人机控制系统、31-飞行控制模块、32-距离感知模块、33-惯性测量模块、311-位置控制单元、312-姿态控制单元、313-控制量转换单元、314-混控单元、21-双目相机模块、22-视觉数据处理模块、211-双目事件相机、212-红外主动发光单元、213-红外滤光单元。
具体实施方式
下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,旨在用于解释本发明,而不能理解为对本发明的限制。
在本发明的描述中,需要理解的是,术语“长度”、“宽度”、“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,在本发明的描述中,“多个”的含义是两个或两个以上,除非另有明确具体的限定。
请参阅图1至图4,本发明提供一种使用事件相机位置反馈的无人机自抗扰控制装置,所述使用事件相机位置反馈的无人机自抗扰控制装置包括改进遥控系统1、视觉位置估计系统2和无人机控制系统3,所述改进遥控系统1与所述无人机控制系统3通过无线通信链路连接,所述视觉位置估计系统2与所述无人机控制系统3通过UART总线连接;
所述改进遥控系统1,用于根据改进后的无人机控制方法,利用SBUS协议将遥控器的摇杆偏移数据进行传输;其中,传输的数据为从遥控器获得到的摇杆数据的PWM量,通过遥控器配套的接收机进行数据的通信;
所述视觉位置估计系统2,用于获取当前无人机的图像数据,并使用半密集深度图重建环境,同时估计双目事件摄像机平台的姿态,并将估计的得到的位置和姿态数据传输至所述无人机控制系统3;
所述无人机控制系统3,用于接收所述摇杆偏移数据和所述视觉位置估计系统2处理后的数据,并根据对所有的数据进行转换和计算结果,对当前所述无人机的位置和姿态进行控制。
在本实施方式中,当操作者在室内狭窄的环境下使用无人机时,基于所述改进遥控系统1上的遥感的操作,会产生所述摇杆偏移数据,根据改进后的无人机控制方法,利用SBUS协议将遥控器的摇杆偏移数据进行传输;由于无人机在飞行时会产生震动,传统的相机需要通过一定的曝光时间才能获取到完整的图像,使用传统相机的方案会由于无人机的震动而产生图像模糊的问题;而且,传统的相机动态范围较低,在光线不均匀的环境下获取的图像效果不佳,故传统的相机无法满足无人机视觉位置估计的要求;而在所述无人机上搭载了所述视觉位置估计系统2,利用所述视觉位置估计系统2来实现无人机的位置估计并输入到所述无人机控制系统3的位置环;并且能够在光线较暗的环境下也能够正常工作。
所述无人机控制系统3能在无人机的前、后、左、右、上、下六个方向,测量无人机的这六个方向与墙壁或者障碍物的距离,然后根据这些距离执行相应的无人机飞行策略,并且对所述摇杆偏移数据和所述视觉位置估计系统2处理后的数据进行转换和计算,根据计算结果对当前所述无人机的位置和姿态进行控制。而所述无人机控制系统3与所述视觉位置估计系统2之间通过自定义的数据协议,通过UART总线进行数据传输,数据传输速率为115200bps;数据解析部分通过C或者C++语言编写自定义的数据解析程序,然后编译烧录到无人机的飞控上面实现。所述的自定义的数据协议的格式为:
帧头 | X | Y | Z | θ | φ | ψ | 校验位 |
其中,帧头为8位的char型数据,X,Y,Z,θ,φ,ψ分别为32位float型的数据,校验位为8位的char型数据,其中校验位的获取方法为奇偶校验或者CRC校验。
当无人机飞行控制系统3接收到视觉位置估计系统2估计出来的位置和姿态数据之后,分别输入到飞行控制模块的位置控制单元311和姿态控制单元312,然后通过自抗扰控制器对输入量(期望值)以及反馈量(视觉位置估计系统的估计值和IMU的测量值)的计算,得到电机的输出量,从而控制电机的转速,达到稳定飞行的效果。
其中,所述的改良后的无人机控制方法是通过C或者C++语言编写上述的控制策略程序,然后编译烧录到无人机控制系统3上面实现,所述的无人机遥控器可使用普通的遥控器就可以达到要求,具体步骤如下:左手的摇杆的Y轴用来对无人机高度的控制,其中高度控制的依据为无人机对地和对天的高度的比值;左手的摇杆的X轴用来对偏航角进行控制,摇杆偏移量是多少,则偏航角偏移的角度值就是多少;右手的摇杆的X轴、Y轴用来对无人机前进和后退、左移和右移的控制,其中前进后退、左移右移的依据为无人机前后、左右与墙壁或者障碍物距离的比例。具体如下:定义无人机的机身与上面的墙壁的距离为x1,无人机与下面的地板的距离为x2,左手遥控器的满度值为H,Y轴的偏移值为A,则对应的计算公式为:
进一步的,所述无人机控制系统3包括飞行控制模块31和多个距离感知模块32,所述飞行控制模块31与所述飞行控制模块31和多个所述距离感知模块32连接,多个所述距离感知模块32还与所述飞行控制模块31连接;
所述飞行控制模块31,用于使用地址轮询法获取所述距离感知模块32获取的感知距离,并接收所述改进遥控系统1和所述视觉位置估计系统2传输的数据;然后根据接收的所有数据,对当前所述无人机飞行进行调整;
多个所述距离感知模块32,用于获取当前时点无人机的前、后、左、右、上、下六个方向与墙壁或者障碍物之间的所述感知距离。
在本实施方式中,多个所述距离感知模块32分别放在无人机的前、后、左、右、上、下六个方向,用来测量无人机的这六个方向与墙壁或者障碍物的感知距离,然后根据这些感知距离执行相应的无人机飞行策略;机身距离感知单元可以使用超声波测距单元和激光测距单元来实现;多个所述距离感知模块32通过串口总线与所述飞行控制模块31连接,所述飞行控制模块31使用地址轮询法对多个所述距离感知模块32进行轮询而获得到距离数据,所述飞行控制模块31使用一款基于ARM的嵌入式芯片作为主控芯片,主要用来运行无人机自抗扰控制算法的程序以及一些飞行策略,然后对无人机进行飞行控制。
其中,所述的根据无人机机身所述距离感知模块32获取到的感知距离数据执行相应的无人机飞行策略具体的实现方法为:当无人机的某个方向与障碍物的距离或墙壁的距离小于或等于无人机设定的安全距离时,无人机无法继续往那个方向飞行。
本发明设计的基于“X”字型的四旋翼无人机,该无人机前、后、左、右、上、下都装有(距离感知模块32以高精度超声波测距传感器为例)高精度的超声波传感器,分别用来检测前、后、左、右、上、下六个方向与障碍物或者墙壁的距离,然后将获得的数据发送给飞行控制模块31,飞行控制模块31根据这些数值来判断是否允许继续往某个方向飞行。定义的无人机飞行方向为Y轴正方向为无人机的前方向,Y轴负方向为无人机的后方向;X轴正方向为无人机的右方向,X轴负方向为无人机的左方向;Z轴的正方向为无人机的上方向,Z轴的负方向为无人机的下方向。无人机的飞行控制模块31采用基于AMR核的可编程的嵌入式芯片,板载的IMU单元用来采集无人机的姿态数据,然后输入到无人机的控制器,来对无人机进行姿态控制。六个超声波传感器通过串口总线与飞行控制模块31连接,飞行控制模块31通过使用程序来对六个超声波传感器使用地址轮询法来获得到距离数据。
在无人机飞行时,通过超声波测距传感器来检测六个方向的距离书,当某个方向与障碍物的距离或墙壁的距离小于或等于无人机设定的安全距离时,无人机无法继续往那个方向飞行;其中,安全距离应该根据不同的无人机机型的尺寸来进行测量然后确定。
进一步的,所述无人机控制系统3还包括惯性测量模块33,所述惯性测量模块33与所述飞行控制模块31连接;
所述惯性测量模块33,用于获取当前所述无人机的惯性数据,并传输至所述飞行控制模块31中。
在本实施方式中,利用所述惯性测量模块33获取当前所述无人机的惯性数据,并传输至所述飞行控制模块31中进行对应的数据计算和处理。
进一步的,所述飞行控制模块31包括位置控制单元311、姿态控制单元312和控制量转换单元313,所述位置控制单元311与所述视觉位置估计系统2连接,所述姿态控制单元312与所述惯性测量模块33和所述位置控制单元311连接,所述控制量转换单元313与多个所述距离感知模块32、所述改进遥控系统1和所述位置控制单元311连接;
所述控制量转换单元313,用于对接收到的所述感知距离和所述摇杆偏移数据进行控制量的转换处理;
所述位置控制单元311,用于结合所述视觉位置估计系统2的数据,对转换后的数据进行位置环计算,得到对应的姿态数据;
所述姿态控制单元312,用于根据所述姿态数据和所述惯性测量模块33的所述惯性数据进行倾斜角度的计算。
在本实施方式中,视觉位置估计线条估计得到的位置数据作为位置环的反馈输入数据;使用惯性测量模块33测量得到的惯性数据作为姿态环的反馈输入数据。其中,改良后的遥控器的控制方法和根据无人机机身距离感知模块32获取到的感知距离执行相应的无人机飞行策略在控制量转换模块实现。
所述的控制量转换模块实现的遥控器控制量转换的方法为:在使用无线遥控器来对无人机进行控制的这段时间里,对遥控器发送过来的这四个控制量分别进行积分,分别为高度控制量、左右移动控制量、前后移动控制量、偏航角控制量;积分结果也就是转换结果输入到所述位置控制单元311,然后所述姿态控制单元312进行计算,计算结果输出给电机,实现对无人机进行相应飞行的控制;当遥控器的摇杆从开始控制到控制结束控制,即遥控器的摇杆从零位,到非零位,再到零位这段时间作为一个积分时间,遥控结束或者遥控器的摇杆归回零位时,无人机在当前点悬停。这四个控制量通过所述控制量转换单元313,然后输出转换后的值。所述位置控制单元311的位置环进行计算之后输出无人机的姿态数据;无人机通过姿态也就是X轴、Y轴的倾斜角度来控制无人机的移动,这部分的计算在所述姿态控制单元312来完成,当无人机达到期望的位置的时候就停止下来,在当前的点悬停,也就是稳定在这个点不动。
进一步的,所述飞行控制模块31还包括混控单元314,所述混控单元314与所述姿态控制单元312连接;
所述混控单元314,用于根据所述姿态数据控制当前所述无人机上的多个电机的升力。
在本实施方式中,所述混控单元314实现了虚拟控制量到四个电机控制量的转换,也就是通过控制四个电机的升力来控制无人机的总力矩来实现无人机的角度倾斜。无人机倾斜之后会由于重力的作用产生横向的力,从而使无人机运动。其中,由于角度倾斜,在四个方向由于合力的作用产生的力会产生加速度,其计算公式如下:
其中,自抗扰控制器的实现包括跟踪微分器(TD)、扩张状态观测器(ESO)和非线性状态误差反馈(NLSEF)组成,自抗扰控制器的实现方法与传统的自抗扰控制器一致,需要将控制器离散化然后以程序代码来实现。其中,自抗扰控制器实现方法如下:
跟踪微分器:
扩展状态观测器:
非线性状态误差反馈:
进一步的,所述视觉位置估计系统2包括双目相机模块21和视觉数据处理模块22,所述视觉处理模块与所述双目相机模块21通过USB接口连接;
所述双目相机模块21,用于采集当前所述无人机的环境图像,并通过USB接口向所述视觉数据处理模块22传输对应的像素亮度变化数据;
所述视觉数据处理模块22,用于根据所述像素亮度变化数据,使用半密集深度图重建环境,并估计所述双目相机模块21的姿态。
在本实施方式中,所述视觉位置估计系统2采用一种基于双目事件相机211的位置估计方法,用来实现无人机的位置估计并输入到所述位置控制单元311。其中,所述双目相机模块21是一种新型的传感器,输出的是像素亮度变化的情况,能具有很高的帧率。所述的基于视觉的无人机位置估计单元包含一个所述双目相机模块21和一个基于ARM核的视觉数据处理模块22。其中,基于ARM核的视觉数据处理模块22用来处理摄像头的图像数据,然后通过算法来对无人机的位置进行估计;基于ARM核的视觉数据处理模块22带有多个GPU单元,用于图像数据的加速处理,其中CPU最好是四核心的,以满足计算要求,推荐的配置可以参考NVIDIA-TX2开发板的配置或者直接用此款开发板;除此之外,该计算单元还有USB接口,其中USB2.0或者USB3.0都可以满足要求,该USB接口用来连接事件相机进行驱动以及数据传输的功能。
其中,所述的视觉位置估计系统2包含主要包括三个重要模块:数据处理、Tracking和Mapping;双目相机模块21位置估计方法如下:
从校准后的相机获取到的数据输入到视觉里程计系统,并在使用半密集深度图重建环境的同时估计双目事件摄像机平台的姿态。其中,Tracking部分使用TS negative(Time surfaces negative,简称TSn),定义为其值越小意味着距离真实边缘越接近。在Tracking时,需要根据已有的Mapping结果(Local Map),将已知逆深度的边界点投影到图像帧上,计算对应的TSn的数值,进行相加,越小这意味着投影的参数越正确。定义的目标函数为:
其中x为图像的像素点,S为参考帧中具有有效逆深度的像素集合,W(...)为仿射变换函数,ρ为已知的逆深度,θ为运动参数,θ*为θ的估计值,函数的意义为寻找一个最佳的θ,使TSn尽可能小。
其中,t表示时刻,x为图像的像素点,函数C(...)为求两个对应像素之间的时间差异函数,ρ为已知的逆深度,ρ*为估计值,δ为时间参数,Tleft、Tright为该像素点在这段时间内的TS对应的值,T为摄像机的轨迹,函数的意义为经过当前假设逆深度投影后,经过对应时间戳投影到指定时刻的Frame。
进一步的,所述双目相机模块21包括双目事件相机211、红外主动发光单元212、红外滤光单元213,所述红外主动发光单元212和所述红外滤光单元213均与所述双目事件相机211连接,所述双目事件相机211与所述视觉数据处理模块22连接;
所述双目事件相机211,用于获取当前所述无人机的环境图像数据;
所述红外主动发光单元212,用于在所述双目事件相机211工作过程中,发出红外光;
所述红外滤光单元213,用于对所述双目事件相机211获取图像数据时,滤除红外光。
在本实施方式中,所述双目相机模块21包括双目事件相机211、红外主动发光单元212、红外滤光单元213,所述双目事件相机211是一种新型的传感器,输出的是像素亮度变化的情况,能具有很高的帧率。红外滤光单元213和红外主动发光单元212,以使事件相机能够在光线较暗的环境下也能够正常工作。
本发明的一种使用事件相机位置反馈的无人机自抗扰控制装置,根据改进后的无人机控制方法,获取改进遥控系统1产生的摇杆偏移数据,并利用所述视觉位置估计系统2采集当前无人机的环境图像数据,通过无人机控制系统3对所述摇杆偏移数据和获取的感知距离进行控制量转换,并将转换结果进行位置环和姿态环的数据计算,根据计算结果,对当前所述无人机进行位置和姿态的控制,增强无人机飞行的安全性,并且有效解决无人机在室内巡检时由于光线较暗而导致传统相机无法工作的问题,扩大无人机在实际应用中的使用范围。
以上所揭露的仅为本发明一种较佳实施例而已,当然不能以此来限定本发明之权利范围,本领域普通技术人员可以理解实现上述实施例的全部或部分流程,并依本发明权利要求所作的等同变化,仍属于发明所涵盖的范围。
Claims (7)
1.一种使用事件相机位置反馈的无人机自抗扰控制装置,其特征在于,
所述使用事件相机位置反馈的无人机自抗扰控制装置包括改进遥控系统、视觉位置估计系统和无人机控制系统,所述改进遥控系统与所述无人机控制系统通过无线通信链路连接,所述视觉位置估计系统与所述无人机控制系统通过UART总线连接;
所述改进遥控系统,用于根据改进后的无人机控制方法,利用SBUS协议将遥控器的摇杆偏移数据进行传输;
所述视觉位置估计系统,用于获取当前无人机的图像数据,并使用半密集深度图重建环境,同时估计双目事件摄像机平台的姿态,并将估计的得到的位置和姿态数据传输至所述无人机控制系统;
所述无人机控制系统,用于接收所述摇杆偏移数据和所述视觉位置估计系统处理后的数据,并根据对所有的数据进行转换和计算结果,对当前所述无人机的位置和姿态进行控制。
2.如权利要求1所述的使用事件相机位置反馈的无人机自抗扰控制装置,其特征在于,
所述无人机控制系统包括飞行控制模块和多个距离感知模块,所述飞行控制模块与所述飞行控制模块和多个所述距离感知模块连接,多个所述距离感知模块还与所述飞行控制模块连接;
所述飞行控制模块,用于使用地址轮询法获取所述距离感知模块获取的感知距离,并接收所述改进遥控系统和所述视觉位置估计系统传输的数据;然后根据接收的所有数据,对当前所述无人机飞行进行调整;
多个所述距离感知模块,用于获取当前时点无人机的前、后、左、右、上、下六个方向与墙壁或者障碍物之间的所述感知距离。
3.如权利要求2所述的使用事件相机位置反馈的无人机自抗扰控制装置,其特征在于,
所述无人机控制系统还包括惯性测量模块,所述惯性测量模块与所述飞行控制模块连接;
所述惯性测量模块,用于获取当前所述无人机的惯性数据,并传输至所述飞行控制模块中。
4.如权利要求3所述的使用事件相机位置反馈的无人机自抗扰控制装置,其特征在于,
所述飞行控制模块包括位置控制单元、姿态控制单元和控制量转换单元,所述位置控制单元与所述视觉位置估计系统连接,所述姿态控制单元与所述惯性测量模块和所述位置控制单元连接,所述控制量转换单元与多个所述距离感知模块、所述改进遥控系统和所述位置控制单元连接;
所述控制量转换单元,用于对接收到的所述感知距离和所述摇杆偏移数据进行控制量的转换处理;
所述位置控制单元,用于结合所述视觉位置估计系统的数据,对转换后的数据进行位置环计算,得到对应的姿态数据;
所述姿态控制单元,用于根据所述姿态数据和所述惯性测量模块的所述惯性数据进行倾斜角度的计算。
5.如权利要求1所述的使用事件相机位置反馈的无人机自抗扰控制装置,其特征在于,
所述视觉位置估计系统包括双目相机模块和视觉数据处理模块,所述视觉处理模块与所述双目相机模块通过USB接口连接;
所述双目相机模块,用于采集当前所述无人机的环境图像,并通过USB接口向所述视觉数据处理模块传输对应的像素亮度变化数据;
所述视觉数据处理模块,用于根据所述像素亮度变化数据,使用半密集深度图重建环境,并估计所述双目相机模块的姿态。
6.如权利要求1所述的使用事件相机位置反馈的无人机自抗扰控制装置,其特征在于,
对所述摇杆偏移数据的转换方法为:
根据所述改进遥控系统的遥控周期,分别对所述改进遥控系统产生的高度控制量、左右移动控制量、前后移动控制量、偏航角控制量进行积分,完成控制量的转换,其中,所述遥控周期为遥控器的摇杆从零位,到非零位,再到零位的时间。
7.如权利要求1所述的使用事件相机位置反馈的无人机自抗扰控制装置,其特征在于,
所述改进后的无人机控制方法为:
利用左手的摇杆的Y轴对无人机高度的控制,其中高度控制的依据为无人机对地和对天的高度的比值;利用左手的摇杆的X轴对偏航角进行控制,摇杆偏移量是多少,则偏航角偏移的角度值就是多少;利用右手的摇杆的X轴、Y轴用来对无人机前进和后退、左移和右移的控制,其中前进后退、左移右移的依据为无人机前后、左右与墙壁或者障碍物距离的比例。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110216263.6A CN113050668A (zh) | 2021-02-26 | 2021-02-26 | 一种使用事件相机位置反馈的无人机自抗扰控制装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110216263.6A CN113050668A (zh) | 2021-02-26 | 2021-02-26 | 一种使用事件相机位置反馈的无人机自抗扰控制装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113050668A true CN113050668A (zh) | 2021-06-29 |
Family
ID=76509181
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110216263.6A Pending CN113050668A (zh) | 2021-02-26 | 2021-02-26 | 一种使用事件相机位置反馈的无人机自抗扰控制装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113050668A (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102514700A (zh) * | 2011-12-19 | 2012-06-27 | 深圳市海斯比船艇科技股份有限公司 | 智能泊船多站多机电子遥控系统及遥控方法 |
CN102830622A (zh) * | 2012-09-05 | 2012-12-19 | 北京理工大学 | 一种四旋翼飞行器自抗扰自动飞行控制方法 |
CN106826837A (zh) * | 2017-03-30 | 2017-06-13 | 欧舶智能科技(上海)有限公司 | 一种水下机器人非视距控制系统 |
CN109917800A (zh) * | 2019-03-19 | 2019-06-21 | 中国科学院深圳先进技术研究院 | 无人机控制方法、装置、计算机设备及存储介质 |
US20190197715A1 (en) * | 2016-08-24 | 2019-06-27 | Universitat Zurich | Simultaneous localization and mapping with an event camera |
US20200011668A1 (en) * | 2018-07-09 | 2020-01-09 | Samsung Electronics Co., Ltd. | Simultaneous location and mapping (slam) using dual event cameras |
CN111158240A (zh) * | 2020-01-15 | 2020-05-15 | 西北工业大学 | 一种空中快速偏航抓捕器的位姿滑模控制方法 |
-
2021
- 2021-02-26 CN CN202110216263.6A patent/CN113050668A/zh active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102514700A (zh) * | 2011-12-19 | 2012-06-27 | 深圳市海斯比船艇科技股份有限公司 | 智能泊船多站多机电子遥控系统及遥控方法 |
CN102830622A (zh) * | 2012-09-05 | 2012-12-19 | 北京理工大学 | 一种四旋翼飞行器自抗扰自动飞行控制方法 |
US20190197715A1 (en) * | 2016-08-24 | 2019-06-27 | Universitat Zurich | Simultaneous localization and mapping with an event camera |
CN106826837A (zh) * | 2017-03-30 | 2017-06-13 | 欧舶智能科技(上海)有限公司 | 一种水下机器人非视距控制系统 |
US20200011668A1 (en) * | 2018-07-09 | 2020-01-09 | Samsung Electronics Co., Ltd. | Simultaneous location and mapping (slam) using dual event cameras |
CN109917800A (zh) * | 2019-03-19 | 2019-06-21 | 中国科学院深圳先进技术研究院 | 无人机控制方法、装置、计算机设备及存储介质 |
CN111158240A (zh) * | 2020-01-15 | 2020-05-15 | 西北工业大学 | 一种空中快速偏航抓捕器的位姿滑模控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109885080B (zh) | 自主控制系统及自主控制方法 | |
CN112083726B (zh) | 一种面向园区自动驾驶的双滤波器融合定位系统 | |
EP3388786A1 (en) | Autonomous positioning and navigation device, positioning and navigation method and autonomous positioning and navigation system | |
US20170023937A1 (en) | Systems, devices, and methods for on-board sensing and control of micro aerial vehicles | |
CN109079799B (zh) | 一种基于仿生的机器人感知控制系统及控制方法 | |
CN112683281B (zh) | 一种基于车辆运动学的自动驾驶车辆联合定位方法 | |
CN110001840B (zh) | 一种基于视觉传感器的多种路况下的两轮自平衡车运动控制方法 | |
Lange et al. | Autonomous corridor flight of a UAV using a low-cost and light-weight RGB-D camera | |
CN111982114B (zh) | 一种采用imu数据融合估计三维位姿的救援机器人 | |
CN109141410B (zh) | Agv组合导航的多传感器融合定位方法 | |
CN110775288B (zh) | 一种基于仿生的飞行机械颈眼系统及控制方法 | |
Lim et al. | Onboard flight control of a micro quadrotor using single strapdown optical flow sensor | |
WO2022016754A1 (zh) | 基于无人洗车设备的多机器协同洗车系统及方法 | |
Carrillo et al. | Three-dimensional position and velocity regulation of a quad-rotorcraft using optical flow | |
CN112720476A (zh) | 机械臂控制方法、装置、介质及电子设备 | |
López et al. | Indoor SLAM for micro aerial vehicles using visual and laser sensor fusion | |
Hinzmann et al. | Flexible stereo: constrained, non-rigid, wide-baseline stereo vision for fixed-wing aerial platforms | |
CN109308074A (zh) | 一种无人机重心偏移的补偿方法及系统 | |
CN112318507A (zh) | 一种基于slam技术的机器人智能控制系统 | |
CN113050668A (zh) | 一种使用事件相机位置反馈的无人机自抗扰控制装置 | |
Chu et al. | Autonomous Landing System of a VTOL UAV on an Upward Docking Station Using Visual Servoing | |
CN115993089B (zh) | 基于pl-icp的在线四舵轮agv内外参标定方法 | |
CN116652958A (zh) | 一种主从同构的机器人遥操作安全控制方法及系统 | |
CN214409706U (zh) | 一种基于机器视觉的室内无人机定位系统 | |
CN115648221A (zh) | 基于ros系统的教育机器人 |
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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20210629 |