CN109634297A - 一种基于光流传感器定位导航的多旋翼无人机及控制方法 - Google Patents
一种基于光流传感器定位导航的多旋翼无人机及控制方法 Download PDFInfo
- Publication number
- CN109634297A CN109634297A CN201811547570.7A CN201811547570A CN109634297A CN 109634297 A CN109634297 A CN 109634297A CN 201811547570 A CN201811547570 A CN 201811547570A CN 109634297 A CN109634297 A CN 109634297A
- Authority
- CN
- China
- Prior art keywords
- control
- master controller
- light stream
- unmanned plane
- sent
- 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
- 238000000034 method Methods 0.000 title claims abstract description 16
- 238000012544 monitoring process Methods 0.000 claims description 47
- 230000005611 electricity Effects 0.000 claims description 28
- 238000013508 migration Methods 0.000 claims description 25
- 230000005012 migration Effects 0.000 claims description 25
- 230000005540 biological transmission Effects 0.000 claims description 15
- 230000009471 action Effects 0.000 claims description 12
- 230000033001 locomotion Effects 0.000 claims description 12
- 238000004891 communication Methods 0.000 claims description 4
- 239000011159 matrix material Substances 0.000 claims description 3
- 230000008569 process Effects 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 238000013519 translation Methods 0.000 claims description 3
- 238000004321 preservation Methods 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 5
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000009514 concussion Effects 0.000 description 1
- 238000000151 deposition Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000009510 drug design Methods 0.000 description 1
- 230000010006 flight Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
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
本发明具体涉及一种基于光流传感器定位导航的多旋翼无人机及控制方法,属于无人机控制领域。所述无人机包括:无人机主体、超声波传感器、气压传感器、GPS传感器、IMU传感器和光流传感器;所述方法包括位置控制、高度控制、姿态控制和悬停控制。本发明通过光流传感器反馈速度信息,且精度较高;主控制器利用USART串口读取光流传感器模块的数据,利用MAVLINK协议解析出速度信息,扩大了其应用范围;通过光流传感器的速度信息引入到悬停控制中,通过悬停控制和姿态控制协调作用,实现了四旋翼的室内悬停保持。
Description
技术领域
本发明属于无人机控制领域,具体涉及一种基于光流传感器定位导航的多旋翼无人机及控制方法。
背景技术
四轴飞行器在室内飞行,由于无法接收到GPS信号,很难做到准确定位。大量飞行的试验也表明,紧紧依靠惯性传感器组成的传感单元设计姿态控制回路,虽然可以实现四旋翼的室内无震荡飞行,但是会存在很严重的漂移现象。
发明内容
针对上述存在的技术问题,本发明提供一种基于光流传感器定位导航的多旋翼无人机,包括:无人机主体、超声波传感器、气压传感器、GPS传感器、IMU传感器和光流传感器;
所述无人机主体的控制系统包括:主控制器、辅控制器、存储器、数据收发模块、电调电机模块;
所述主控制器分别连接辅控制器和电调电机模块;
所述辅控制器分别连接存储器和数据收发模块;
所述数据收发模块分别与基站和遥控器建立无线连接;
所述超声波传感器、气压传感器、GPS传感器、IMU传感器和光流传感器分别与主控器连接;
所述光流传感器采用PX4FLOW光流传感器。
所述主控制器与辅控制器之间采用PWM信号进行数据传输。
所述无线连接采用蓝牙通讯方式。
所述主控制器和辅控制器均采用STM32F407单片机。
所述主控制器采用USART串口读取光流传感器的监测数据,并采用MAVLINK协议进行数据解析。
一种基于光流传感器定位导航的多旋翼无人机的控制方法,采用上述的基于光流传感器定位导航的多旋翼无人机,包括以下步骤:
步骤1,启动无人机和遥控器,建立无人机与遥控器间的无线连接;通过遥控器向无人机发送以下启动指令中的一个,包括:
启动指令1:启动GO模式,进入步骤4;
启动指令2:启动GO Back模式,进入步骤4;
启动指令3:启动手动模式,进入步骤2;
步骤2,通过遥控器向无人机发送动作控制指令;
步骤3,无人机数据收发模块接收到动作控制指令,并通过辅控制器发送至主控制器;主控制器根据动作控制指令,得出悬停控制指令,并发送至电调电机模块,从而控制无人机动作,直至控制结束。
步骤4,启动基站,建立无人机与基站间的无线连接;
步骤5,通过基站向无人机发送目标位置信息x,y,z,其中x,y表示在水平面上的X方向与Y方向的目标水平坐标,z表示在垂直于水平面的Z方向的目标高度坐标;
步骤6,无人机的数据收发模块接收到目标位置信息x,y,z,并发送至辅控制器;辅控制器将目标位置信息发送至存储器保存,并发送至主控制器;
步骤7,超声波传感器和气压传感器实时将各自的高度监测信息传送至主控制器,主控制器将高度监测信息转换为实际高度坐标z1,并与目标高度坐标z对比得出高度控制需求;
步骤8,GPS传感器将其位置监测信息实时传送至主控制器,主控制器将位置监测信息转换为实际水平坐标x1,y1,并与目标水平坐标x,y对比得出位置控制需求;
步骤9,IMU传感器将其姿态监测信息实时传送至主控制器,姿态监测信息即无人机的旋转角速度ω,主控制器据此计算得出实际姿态信息,包括滚转角φ、俯仰角θ、偏航角ψ;将位置控制需求转换为姿态需求;将实际姿态信息与姿态需求对比得出姿态控制需求;
步骤10,主控制器通过辅控制器将接受到的实际高度坐标z1、实际水平坐标x1,y1和实际姿态信息实时发送至存储器保存;主控制器根据高度控制需求和姿态控制需求,得出位置控制指令,并发送至电调电机模块,从而控制无人机动作;
步骤11,当实际水平坐标x1,y1与目标水平坐标x,y一致,且实际高度坐标z1与目标高度坐标z一致时,即无人机到达目标位置;
如果此时的实际高度坐标不大于20cm,则主控制器发送降落控制指令送至电调电机模块,从而控制无人机落地;如果步骤1中发送的是启动指令1,则控制结束;如果步骤1中发送的不是启动指令1,则发送的是启动指令2,进入步骤14;
如果此时的实际高度坐标大于20cm,则无人机进入悬停模式,进入步骤12;
步骤12,光流传感器将其图像监测信息实时传送至主控制器,主控制器根据图像监测信息得出偏移速度[vx vy],并根据姿态监测信息对偏移速度进行修正,得到实际偏移速度[Vx Vy];
步骤13,主控制器根据实际偏移速度[Vx Vy]得出悬停控制需求;主控制器根据悬停控制需求,得出悬停控制指令,并发送至电调电机模块,从而控制无人机动作;
如果步骤1中发送的是启动指令1,则返回步骤12;如果步骤1中发送的不是启动指令1,则发送的是启动指令2,进入步骤14;
步骤14,通过遥控器向无人机发送返航指令;
步骤15,无人机数据收发模块接收到返航指令,并发送至辅控制器;辅控制器从存储器中提取本次控制过程中最初的实际位置坐标,将其作为目标位置信息,进行步骤7-步骤10,然后进入步骤16;
步骤16,当实际位置坐标与目标位置坐标一致时,即无人机到达目标位置,返航完成;
如果此时的实际高度坐标不大于20cm,则主控制器发送降落控制指令送至电调电机模块,从而控制无人机落地,控制结束;
如果此时的实际高度坐标大于20cm,则无人机进入悬停模式,进入步骤17;
步骤17,光流传感器将其图像监测信息实时传送至主控制器,主控制器根据图像监测信息得出偏移速度[vx vy],并根据姿态监测信息对偏移速度[vx vy]进行修正,得到实际偏移速度[Vx Vy];
步骤18,悬停控制器根据实际偏移速度[Vx Vy]得出悬停控制需求并发送至主控制器;主控制器根据悬停控制需求,得出悬停控制指令,并发送至电调电机模块,从而控制无人机动作;返回步骤17。
所述步骤4-步骤18中,如果通过遥控器向无人机发送动作控制指令,则进入步骤2。
所述步骤12和步骤17中,主控制器根据图像监测信息得出偏移速度[vx vy],并根据姿态监测信息对偏移速度[vx vy]进行修正,得到实际偏移速度[Vx Vy],包括以下步骤:
步骤a,光流传感器实时送来的图像监测信息中,将如图2(a)所示的上一帧图像的特征点与如图2(b)所示的下一帧图像的特征点进行对比,即如图2(c)所示,得出水平像素偏移量x'和垂直像素偏移量y',进而计算得出偏移速度[vx vy];
步骤b,在无人机姿态的变化,光流传感器也随无人机发生旋转,所以通过以下公式对偏移速度[vx vy]进行修正:
其中,ω=[ωx ωy ωz]为无人机的旋转角速度,T=[Tx Ty Tz]为平移变换矩阵,z1为实际高度坐标,f为光流传感器的透镜焦距;
步骤c,计算实际偏移速度[Vx Vy]:
本发明的有益效果:
本发明提出一种基于光流传感器定位导航的多旋翼无人机及控制方法,通过光流传感器反馈速度信息,且精度较高;主控制器利用USART串口读取光流传感器模块的数据,利用MAVLINK协议解析出速度信息,扩大了其应用范围;通过光流传感器的速度信息引入到悬停控制中,通过悬停控制和姿态控制协调作用,实现了四旋翼的室内悬停保持;
本发明将遥控器和基站的PWM信号发射机替换为蓝牙通讯设备,无人机的PWM信号接收机替换为辅控制器,可以预先设定飞行指令,一键开启后,在无人操纵情况下,四旋翼可以按照预定指令自动飞行。
本发明设计合理,易于实现,具有很好的实用价值。
附图说明
图1为本发明具体实施方式中所述基于光流传感器定位导航的多旋翼无人机的结构示意图;
图2(a)为本发明具体实施方式中所述光流传感器的上一帧图像的特征点示意图;
图2(b)为本发明具体实施方式中所述光流传感器的下一帧图像的特征点示意图;
图2(c)为图2(a)和图2(b)中所述特征点的对比示意图;
图3为本发明具体实施方式中所述基于光流传感器定位导航的多旋翼无人机的控制方法流程图。
图中:1、超声波传感器;2、气压传感器;3、GPS传感器;4、IMU传感器;5、光流传感器;6、主控制器;7、辅控制器;8、存储器;9、数据收发模块;10、电调电机模块。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施实例,对本发明做出进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
本发明提出一种基于光流传感器定位导航的多旋翼无人机,如图1所示,包括:无人机主体、超声波传感器1、气压传感器2、GPS传感器3、IMU传感器4和光流传感器5;
所述无人机主体的控制系统包括:主控制器6、辅控制器7、存储器8、数据收发模块9、电调电机模块10;
所述主控制器6分别连接辅控制器7和电调电机模块10;
所述主控制器6与辅控制器7之间采用PWM信号进行数据传输;
所述辅控制器7分别连接存储器8和数据收发模块9;
所述主控制器6和辅控制器7均采用STM32F407单片机;
所述数据收发模块9分别与基站和遥控器建立无线连接;
所述无线连接采用蓝牙通讯方式;
所述超声波传感器1、气压传感器2、GPS传感器3、IMU传感器4和光流传感器5分别与主控器连接;
所述光流传感器5采用PX4FLOW光流传感器;所述主控制器6采用USART串口读取光流传感器5的监测数据,并采用MAVLINK协议进行数据解析,扩大了其应用范围。
本发明提出一种基于光流传感器定位导航的多旋翼无人机的控制方法,如图3所示,采用上述基于光流传感器定位导航的多旋翼无人机,包括以下步骤:
步骤1,启动无人机和遥控器,建立无人机与遥控器间的无线连接;通过遥控器向无人机发送以下启动指令中的一个,包括:
启动指令1:启动GO模式,进入步骤4;
启动指令2:启动GO Back模式,进入步骤4;
启动指令3:启动手动模式,进入步骤2;
步骤2,通过遥控器向无人机发送动作控制指令;
步骤3,无人机数据收发模块9接收到动作控制指令,并通过辅控制器7发送至主控制器6;主控制器6根据动作控制指令,得出悬停控制指令,并发送至电调电机模块10,从而控制无人机动作。
步骤4,启动基站,建立无人机与基站间的无线连接;
步骤5,通过基站向无人机发送目标位置信息x,y,z,其中x,y表示在水平面上的X方向与Y方向的目标水平坐标,z表示在垂直于水平面的Z方向的目标高度坐标;
步骤6,无人机的数据收发模块9接收到目标位置信息x,y,z,并发送至辅控制器7;辅控制器7将目标位置信息发送至存储器8保存,并发送至主控制器6;
步骤7,超声波传感器1和气压传感器2实时将各自的高度监测信息传送至主控制器6,主控制器6将高度监测信息转换为实际高度坐标z1,并与目标高度坐标z对比得出高度控制需求;
步骤8,GPS传感器3将其位置监测信息实时传送至主控制器6,主控制器6将位置监测信息转换为实际水平坐标x1,y1,并与目标水平坐标x,y对比得出位置控制需求;
步骤9,IMU传感器4将其姿态监测信息实时传送至主控制器6,姿态监测信息即无人机的旋转角速度ω,主控制器6据此计算得出实际姿态信息,包括滚转角φ、俯仰角θ、偏航角ψ;将位置控制需求转换为姿态需求;将实际姿态信息与姿态需求对比得出姿态控制需求;
步骤10,主控制器6通过辅控制器7将接受到的实际高度坐标z1、实际水平坐标x1,y1和实际姿态信息实时发送至存储器8保存;主控制器6根据高度控制需求和姿态控制需求,得出位置控制指令,并发送至电调电机模块10,从而控制无人机动作;
步骤11,当实际水平坐标x1,y1与目标水平坐标x,y一致,且实际高度坐标z1与目标高度坐标z一致时,即无人机到达目标位置;
如果此时的实际高度坐标不大于20cm,则主控制器6发送降落控制指令送至电调电机模块10,从而控制无人机落地;如果步骤1中发送的是启动指令1,则控制结束;如果步骤1中发送的不是启动指令1,则发送的是启动指令2,进入步骤14;
如果此时的实际高度坐标大于20cm,则无人机进入悬停模式,进入步骤12;
步骤12,光流传感器5将其图像监测信息实时传送至主控制器6,主控制器6根据图像监测信息得出偏移速度[vx vy],并根据姿态监测信息对偏移速度进行修正,得到实际偏移速度[Vx Vy];
步骤13,主控制器6根据实际偏移速度[Vx Vy]得出悬停控制需求;主控制器6根据悬停控制需求,得出悬停控制指令,并发送至电调电机模块10,从而控制无人机动作;
如果步骤2中发送的是启动指令1,则返回步骤12;如果步骤2中发送的不是启动指令1,则发送的是启动指令2,进入步骤14;
步骤14,通过遥控器向无人机发送返航指令;
步骤15,无人机数据收发模块9接收到返航指令,并发送至辅控制器7;辅控制器7从存储器8中提取本次控制过程中最初的实际位置坐标,将其作为目标位置信息,进行步骤7-步骤10,然后进入步骤16;
步骤16,当实际位置坐标与目标位置坐标一致时,即无人机到达目标位置,返航完成;
如果此时的实际高度坐标不大于20cm,则主控制器6发送降落控制指令送至电调电机模块10,从而控制无人机落地,控制结束;
如果此时的实际高度坐标大于20cm,则无人机进入悬停模式,进入步骤17;
步骤17,光流传感器5将其图像监测信息实时传送至主控制器6,主控制器6根据图像监测信息得出偏移速度[vx vy],并根据姿态监测信息对偏移速度[vx vy]进行修正,得到实际偏移速度[Vx Vy];
步骤18,悬停控制器根据实际偏移速度[Vx Vy]得出悬停控制需求并发送至主控制器6;主控制器6根据悬停控制需求,得出悬停控制指令,并发送至电调电机模块10,从而控制无人机动作;返回步骤17;
所述步骤4-步骤18中,如果通过遥控器向无人机发送动作控制指令,则进入步骤3。
所述步骤12和步骤17中,主控制器6根据图像监测信息得出偏移速度[vx vy],并根据姿态监测信息对偏移速度[vx vy]进行修正,得到实际偏移速度[Vx Vy],包括以下步骤:
步骤a,光流传感器5实时送来的图像监测信息中,将如图2(a)所示的上一帧图像的特征点与如图2(b)所示的下一帧图像的特征点进行对比,即如图2(c)所示,得出水平像素偏移量x'和垂直像素偏移量y',进而计算得出偏移速度[vx vy];
步骤b,在无人机姿态的变化,光流传感器5也随无人机发生旋转,所以通过以下公式对偏移速度[vx vy]进行修正:
其中,ω=[ωx ωy ωz]为无人机的旋转角速度,T=[Tx Ty Tz]为平移变换矩阵,z1为实际高度坐标,f为光流传感器5的透镜焦距;
步骤c,计算实际偏移速度[Vx Vy]:
Claims (8)
1.一种基于光流传感器定位导航的多旋翼无人机,其特征在于,包括:无人机主体、超声波传感器、气压传感器、GPS传感器、IMU传感器和光流传感器;
所述无人机主体的控制系统包括:主控制器、辅控制器、存储器、数据收发模块、电调电机模块;
所述主控制器分别连接辅控制器和电调电机模块;
所述辅控制器分别连接存储器和数据收发模块;
所述数据收发模块分别与基站和遥控器建立无线连接;
所述超声波传感器、气压传感器、GPS传感器、IMU传感器和光流传感器分别与主控器连接;
所述光流传感器采用PX4FLOW光流传感器。
2.根据权利要求1所述的基于光流传感器定位导航的多旋翼无人机,其特征在于,所述主控制器与辅控制器之间采用PWM信号进行数据传输。
3.根据权利要求1所述的基于光流传感器定位导航的多旋翼无人机,其特征在于,所述无线连接采用蓝牙通讯方式。
4.根据权利要求1所述的基于光流传感器定位导航的多旋翼无人机,其特征在于,所述主控制器和辅控制器均采用STM32F407单片机。
5.根据权利要求1所述的基于光流传感器定位导航的多旋翼无人机,其特征在于,所述主控制器采用USART串口读取光流传感器的监测数据,并采用MAVLINK协议进行数据解析。
6.一种基于光流传感器定位导航的多旋翼无人机的控制方法,采用权利要求1所述的基于光流传感器定位导航的多旋翼无人机,其特征在于,包括以下步骤:
步骤1,启动无人机和遥控器,建立无人机与遥控器间的无线连接;通过遥控器向无人机发送以下启动指令中的一个,包括:
启动指令1:启动GO模式,进入步骤4;
启动指令2:启动GO Back模式,进入步骤4;
启动指令3:启动手动模式,进入步骤2;
步骤2,通过遥控器向无人机发送动作控制指令;
步骤3,无人机数据收发模块接收到动作控制指令,并通过辅控制器发送至主控制器;主控制器根据动作控制指令,得出悬停控制指令,并发送至电调电机模块,从而控制无人机动作,直至控制结束;
步骤4,启动基站,建立无人机与基站间的无线连接;
步骤5,通过基站向无人机发送目标位置信息x,y,z,其中x,y表示在水平面上的X方向与Y方向的目标水平坐标,z表示在垂直于水平面的Z方向的目标高度坐标;
步骤6,无人机的数据收发模块接收到目标位置信息x,y,z,并发送至辅控制器;辅控制器将目标位置信息发送至存储器保存,并发送至主控制器;
步骤7,超声波传感器和气压传感器实时将各自的高度监测信息传送至主控制器,主控制器将高度监测信息转换为实际高度坐标z1,并与目标高度坐标z对比得出高度控制需求;
步骤8,GPS传感器将其位置监测信息实时传送至主控制器,主控制器将位置监测信息转换为实际水平坐标x1,y1,并与目标水平坐标x,y对比得出位置控制需求;
步骤9,IMU传感器将其姿态监测信息实时传送至主控制器,姿态监测信息即无人机的旋转角速度ω,主控制器据此计算得出实际姿态信息,包括滚转角φ、俯仰角θ、偏航角ψ;将位置控制需求转换为姿态需求;将实际姿态信息与姿态需求对比得出姿态控制需求;
步骤10,主控制器通过辅控制器将接受到的实际高度坐标z1、实际水平坐标x1,y1和实际姿态信息实时发送至存储器保存;主控制器根据高度控制需求和姿态控制需求,得出位置控制指令,并发送至电调电机模块,从而控制无人机动作;
步骤11,当实际水平坐标x1,y1与目标水平坐标x,y一致,且实际高度坐标z1与目标高度坐标z一致时,即无人机到达目标位置;
如果此时的实际高度坐标不大于20cm,则主控制器发送降落控制指令送至电调电机模块,从而控制无人机落地;如果步骤1中发送的是启动指令1,则控制结束;如果步骤1中发送的不是启动指令1,则发送的是启动指令2,进入步骤14;
如果此时的实际高度坐标大于20cm,则无人机进入悬停模式,进入步骤12;
步骤12,光流传感器将其图像监测信息实时传送至主控制器,主控制器根据图像监测信息得出偏移速度[vx vy],并根据姿态监测信息对偏移速度进行修正,得到实际偏移速度[Vx Vy];
步骤13,主控制器根据实际偏移速度[Vx Vy]得出悬停控制需求;主控制器根据悬停控制需求,得出悬停控制指令,并发送至电调电机模块,从而控制无人机动作;
如果步骤1中发送的是启动指令1,则返回步骤12;如果步骤1中发送的不是启动指令1,则发送的是启动指令2,进入步骤14;
步骤14,通过遥控器向无人机发送返航指令;
步骤15,无人机数据收发模块接收到返航指令,并发送至辅控制器;辅控制器从存储器中提取本次控制过程中最初的实际位置坐标,将其作为目标位置信息,进行步骤7-步骤10,然后进入步骤16;
步骤16,当实际位置坐标与目标位置坐标一致时,即无人机到达目标位置,返航完成;
如果此时的实际高度坐标不大于20cm,则主控制器发送降落控制指令送至电调电机模块,从而控制无人机落地,控制结束;
如果此时的实际高度坐标大于20cm,则无人机进入悬停模式,进入步骤17;
步骤17,光流传感器将其图像监测信息实时传送至主控制器,主控制器根据图像监测信息得出偏移速度[vx vy],并根据姿态监测信息对偏移速度[vx vy]进行修正,得到实际偏移速度[Vx Vy];
步骤18,悬停控制器根据实际偏移速度[Vx Vy]得出悬停控制需求并发送至主控制器;主控制器根据悬停控制需求,得出悬停控制指令,并发送至电调电机模块,从而控制无人机动作;返回步骤17。
7.根据权利要求6所述的基于光流传感器定位导航的多旋翼无人机的控制方法,其特征在于,所述步骤4-步骤18中,如果通过遥控器向无人机发送动作控制指令,则进入步骤2。
8.根据权利要求6所述的基于光流传感器定位导航的多旋翼无人机的控制方法,其特征在于,所述步骤12和步骤17中,主控制器根据图像监测信息得出偏移速度[vx vy],并根据姿态监测信息对偏移速度[vx vy]进行修正,得到实际偏移速度[Vx Vy],包括以下步骤:
步骤a,光流传感器实时送来的图像监测信息中,将如图2(a)所示的上一帧图像的特征点与如图2(b)所示的下一帧图像的特征点进行对比,即如图2(c)所示,得出水平像素偏移量x'和垂直像素偏移量y',进而计算得出偏移速度[vx vy];
步骤b,在无人机姿态的变化,光流传感器也随无人机发生旋转,所以通过以下公式对偏移速度[vx vy]进行修正:
其中,ω=[ωx ωy ωz]为无人机的旋转角速度,T=[Tx Ty Tz]为平移变换矩阵,z1为实际高度坐标,f为光流传感器的透镜焦距;
步骤c,计算实际偏移速度[Vx Vy]:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811547570.7A CN109634297A (zh) | 2018-12-18 | 2018-12-18 | 一种基于光流传感器定位导航的多旋翼无人机及控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811547570.7A CN109634297A (zh) | 2018-12-18 | 2018-12-18 | 一种基于光流传感器定位导航的多旋翼无人机及控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109634297A true CN109634297A (zh) | 2019-04-16 |
Family
ID=66074996
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811547570.7A Pending CN109634297A (zh) | 2018-12-18 | 2018-12-18 | 一种基于光流传感器定位导航的多旋翼无人机及控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109634297A (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110456822A (zh) * | 2019-08-23 | 2019-11-15 | 西安爱生技术集团公司 | 一种中小型无人机双余度自主测量飞控系统 |
CN111077908A (zh) * | 2019-12-26 | 2020-04-28 | 深圳慧源创新科技有限公司 | 自动调节无人机悬停的方法、装置,光流模块及无人机 |
CN111361740A (zh) * | 2020-03-30 | 2020-07-03 | 华南农业大学 | 基于系留无人机平台的水流增压式清洁系统及清洁方法 |
CN113232859A (zh) * | 2021-05-06 | 2021-08-10 | 浙江极客桥智能装备股份有限公司 | 基于系留无人机的像素空间显示系统、控制方法及终端 |
CN113325864A (zh) * | 2021-06-16 | 2021-08-31 | 深圳慧源创新科技有限公司 | 一种无人机的控制方法、装置、无人机以及存储介质 |
Citations (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE10258545A1 (de) * | 2002-09-23 | 2004-04-01 | Stefan Reich | Stabilisierungssystem für Flugkörper |
US20050165517A1 (en) * | 2002-09-23 | 2005-07-28 | Stefan Reich | Optical sensing system and system for stabilizing machine-controllable vehicles |
CN103365297A (zh) * | 2013-06-29 | 2013-10-23 | 天津大学 | 基于光流的四旋翼无人机飞行控制方法 |
CN103853156A (zh) * | 2014-02-07 | 2014-06-11 | 中山大学 | 一种基于机载传感器的小型四旋翼飞行器控制系统及方法 |
CN105157708A (zh) * | 2015-10-10 | 2015-12-16 | 南京理工大学 | 基于图像处理与雷达的无人机自主导航系统及方法 |
CN204989980U (zh) * | 2015-09-21 | 2016-01-20 | 北京浩恒征途航空科技有限公司 | 一种变桨距多旋翼飞行器控制器 |
CN205540289U (zh) * | 2016-04-07 | 2016-08-31 | 北京博鹰通航科技有限公司 | 一种具有光流传感器的多旋翼无人机 |
CN106054929A (zh) * | 2016-06-27 | 2016-10-26 | 西北工业大学 | 一种基于光流的无人机自动降落引导方法 |
CN107346142A (zh) * | 2016-09-30 | 2017-11-14 | 广州亿航智能技术有限公司 | 飞行器控制方法、光流模块及飞行器 |
CN107389968A (zh) * | 2017-07-04 | 2017-11-24 | 武汉视览科技有限公司 | 一种基于光流传感器和加速度传感器的无人机定点实现方法和装置 |
CN107450575A (zh) * | 2017-03-13 | 2017-12-08 | 亿航智能设备(广州)有限公司 | 飞行控制系统及具有其的飞行器 |
CN107450591A (zh) * | 2017-08-23 | 2017-12-08 | 浙江工业大学 | 基于英伟达tx2处理器的无人机运动跟踪系统 |
CN107689063A (zh) * | 2017-07-27 | 2018-02-13 | 南京理工大学北方研究院 | 一种基于天花板图像的机器人室内定位方法 |
CN107807668A (zh) * | 2017-11-30 | 2018-03-16 | 广州市华科尔科技股份有限公司 | 一种多旋翼无人机自动控制方法 |
CN107885227A (zh) * | 2017-11-30 | 2018-04-06 | 广州市华科尔科技股份有限公司 | 一种无人机自动避障方法 |
CN107943064A (zh) * | 2017-11-15 | 2018-04-20 | 北京工业大学 | 一种无人机定点悬停系统和方法 |
CN108132673A (zh) * | 2017-11-15 | 2018-06-08 | 安徽工程大学 | 一种基于stm32的四旋翼飞行器控制系统 |
CN209055851U (zh) * | 2018-12-18 | 2019-07-02 | 辽宁壮龙无人机科技有限公司 | 一种基于光流传感器定位导航的多旋翼无人机 |
-
2018
- 2018-12-18 CN CN201811547570.7A patent/CN109634297A/zh active Pending
Patent Citations (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE10258545A1 (de) * | 2002-09-23 | 2004-04-01 | Stefan Reich | Stabilisierungssystem für Flugkörper |
US20050165517A1 (en) * | 2002-09-23 | 2005-07-28 | Stefan Reich | Optical sensing system and system for stabilizing machine-controllable vehicles |
EP1563312A1 (de) * | 2002-09-23 | 2005-08-17 | Captron Electronic GmbH | Mess- und stabilisierungsystem f r maschinell steuerbare veh ikel |
CN103365297A (zh) * | 2013-06-29 | 2013-10-23 | 天津大学 | 基于光流的四旋翼无人机飞行控制方法 |
CN103853156A (zh) * | 2014-02-07 | 2014-06-11 | 中山大学 | 一种基于机载传感器的小型四旋翼飞行器控制系统及方法 |
CN204989980U (zh) * | 2015-09-21 | 2016-01-20 | 北京浩恒征途航空科技有限公司 | 一种变桨距多旋翼飞行器控制器 |
CN105157708A (zh) * | 2015-10-10 | 2015-12-16 | 南京理工大学 | 基于图像处理与雷达的无人机自主导航系统及方法 |
CN205540289U (zh) * | 2016-04-07 | 2016-08-31 | 北京博鹰通航科技有限公司 | 一种具有光流传感器的多旋翼无人机 |
CN106054929A (zh) * | 2016-06-27 | 2016-10-26 | 西北工业大学 | 一种基于光流的无人机自动降落引导方法 |
CN107346142A (zh) * | 2016-09-30 | 2017-11-14 | 广州亿航智能技术有限公司 | 飞行器控制方法、光流模块及飞行器 |
CN107450575A (zh) * | 2017-03-13 | 2017-12-08 | 亿航智能设备(广州)有限公司 | 飞行控制系统及具有其的飞行器 |
CN107389968A (zh) * | 2017-07-04 | 2017-11-24 | 武汉视览科技有限公司 | 一种基于光流传感器和加速度传感器的无人机定点实现方法和装置 |
CN107689063A (zh) * | 2017-07-27 | 2018-02-13 | 南京理工大学北方研究院 | 一种基于天花板图像的机器人室内定位方法 |
CN107450591A (zh) * | 2017-08-23 | 2017-12-08 | 浙江工业大学 | 基于英伟达tx2处理器的无人机运动跟踪系统 |
CN107943064A (zh) * | 2017-11-15 | 2018-04-20 | 北京工业大学 | 一种无人机定点悬停系统和方法 |
CN108132673A (zh) * | 2017-11-15 | 2018-06-08 | 安徽工程大学 | 一种基于stm32的四旋翼飞行器控制系统 |
CN107807668A (zh) * | 2017-11-30 | 2018-03-16 | 广州市华科尔科技股份有限公司 | 一种多旋翼无人机自动控制方法 |
CN107885227A (zh) * | 2017-11-30 | 2018-04-06 | 广州市华科尔科技股份有限公司 | 一种无人机自动避障方法 |
CN209055851U (zh) * | 2018-12-18 | 2019-07-02 | 辽宁壮龙无人机科技有限公司 | 一种基于光流传感器定位导航的多旋翼无人机 |
Non-Patent Citations (1)
Title |
---|
刘涵等: "一种基于光流传感器的四旋翼室内位置控制方法", 《电子设计工程》, 31 May 2015 (2015-05-31), pages 8 - 12 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110456822A (zh) * | 2019-08-23 | 2019-11-15 | 西安爱生技术集团公司 | 一种中小型无人机双余度自主测量飞控系统 |
CN111077908A (zh) * | 2019-12-26 | 2020-04-28 | 深圳慧源创新科技有限公司 | 自动调节无人机悬停的方法、装置,光流模块及无人机 |
CN111077908B (zh) * | 2019-12-26 | 2023-02-03 | 深圳慧源创新科技有限公司 | 自动调节无人机悬停的方法、装置,光流模块及无人机 |
CN111361740A (zh) * | 2020-03-30 | 2020-07-03 | 华南农业大学 | 基于系留无人机平台的水流增压式清洁系统及清洁方法 |
CN113232859A (zh) * | 2021-05-06 | 2021-08-10 | 浙江极客桥智能装备股份有限公司 | 基于系留无人机的像素空间显示系统、控制方法及终端 |
CN113325864A (zh) * | 2021-06-16 | 2021-08-31 | 深圳慧源创新科技有限公司 | 一种无人机的控制方法、装置、无人机以及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109634297A (zh) | 一种基于光流传感器定位导航的多旋翼无人机及控制方法 | |
CN110347171B (zh) | 一种飞行器控制方法及飞行器 | |
CN107807661B (zh) | 轨迹控制室内四旋翼无人机编队演示验证平台及方法 | |
CN208110387U (zh) | 一种室内视觉导航无人机集群飞行控制系统 | |
CN103853156B (zh) | 一种基于机载传感器的小型四旋翼飞行器控制系统及方法 | |
CN107272740B (zh) | 一种新型四旋翼无人机控制系统 | |
CN108196582A (zh) | 一种室内视觉导航无人机集群飞行控制系统及方法 | |
WO2016138687A1 (zh) | 多旋翼飞行器的控制系统、终端及机载飞控系统 | |
WO2017065103A1 (ja) | 小型無人飛行機の制御方法 | |
CN106094877B (zh) | 一种无人机着陆导航系统及控制方法 | |
CN105182992A (zh) | 无人机的控制方法、装置 | |
CN203825466U (zh) | 一种基于机载传感器的小型四旋翼飞行器控制系统 | |
CN105468014B (zh) | 一种单自驾仪一体化的飞行器系统及其二维云台控制方法 | |
CN110488850A (zh) | 一种基于树莓派的四旋翼无人机视觉导航系统及方法 | |
CN206804018U (zh) | 环境数据服务器、无人飞行器及定位系统 | |
CN105629995A (zh) | 一种系留跟随系统和方法 | |
WO2020133909A1 (zh) | 飞控与导航一体机 | |
CN107145159A (zh) | 一种车载系留多旋翼控制系统架构及控制方法 | |
CN109254587A (zh) | 可在无线充电条件下稳定悬停的小型无人机及其控制方法 | |
CN108153327A (zh) | 一种四旋翼飞行器室外编队灯光表演系统及控制方法 | |
CN106527484A (zh) | 一种基于机电一体化的无人机飞行航线管理系统 | |
CN107340780A (zh) | 多旋翼飞行器的控制方法、装置和系统 | |
CN104897159A (zh) | 基于序列图像匹配的飞行器全程导航方法 | |
CN109521785A (zh) | 一种随身拍智能旋翼飞行器系统 | |
CN115981355A (zh) | 一种可快速精准降落的无人机自动巡航方法及系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
TA01 | Transfer of patent application right | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20191216 Address after: 332000 Jiangxi Jiujiang Jiujiang economic and Technological Development Zone, the first floor of the automobile industrial park management office. Applicant after: Jiangxi Zhuang long UAV Technology Co., Ltd. Address before: 110136 Shenbei Road, Shenbei New Area, Shenyang, Shenyang, Liaoning province (A gate) Applicant before: LIAONING ZHUANGLONG UAV TECHNOLOGY CO., LTD. |
|
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |