CN111290424A - 用于医院血液样本运输的无人机姿态控制方法及无人机 - Google Patents

用于医院血液样本运输的无人机姿态控制方法及无人机 Download PDF

Info

Publication number
CN111290424A
CN111290424A CN202010223640.4A CN202010223640A CN111290424A CN 111290424 A CN111290424 A CN 111290424A CN 202010223640 A CN202010223640 A CN 202010223640A CN 111290424 A CN111290424 A CN 111290424A
Authority
CN
China
Prior art keywords
unmanned aerial
aerial vehicle
attitude
gain
current
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.)
Granted
Application number
CN202010223640.4A
Other languages
English (en)
Other versions
CN111290424B (zh
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.)
Southern Hospital Southern Medical University
Original Assignee
Southern Hospital Southern Medical University
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 Southern Hospital Southern Medical University filed Critical Southern Hospital Southern Medical University
Priority to CN202010223640.4A priority Critical patent/CN111290424B/zh
Publication of CN111290424A publication Critical patent/CN111290424A/zh
Application granted granted Critical
Publication of CN111290424B publication Critical patent/CN111290424B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64CAEROPLANES; HELICOPTERS
    • B64C39/00Aircraft not otherwise provided for
    • B64C39/02Aircraft not otherwise provided for characterised by special use
    • 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/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • G05D1/0816Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64UUNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
    • B64U2101/00UAVs specially adapted for particular uses or applications

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

本发明公开了用于医院血液样本运输的无人机姿态控制方法及无人机,其中,方法包括:接收无人机目标姿态的控制指令;获取无人机当前姿态,并计算出当前姿态与目标姿态之间的姿态角控制误差状态量;获取无人机当前的飞行速度;基于增益调度算法和无人机当前的飞行速度,对初始P增益进行更新,得到更新后的P增益;根据更新后的P增益和姿态角控制误差状态量,计算出控制输出;基于控制输出,控制无人机的姿态。该方法通过获取无人机的飞行速度并结合增益调度算法,得到更新后的P增益,再根据更新后的P增益和姿态角控制误差状态量计算出控制输出,提高了控制精度,确保了无人机飞行的稳定性。

Description

用于医院血液样本运输的无人机姿态控制方法及无人机
技术领域
本发明涉及无人机技术领域,尤其涉及用于医院血液样本运输的无人机姿态控制方法及无人机。
背景技术
目前,医院中血液样本的运送,大多由护士或护工先依据样本送出清单对血液样本进行核对,然后在预定的某一时间段内运送至指定地点与交接人员共同核对,确认无误后完成交接。
现有的血液样本运送过程非常繁琐,耗费大量人力,并且效率低下,难以应对突发紧急情况;另外,现在许多医院采用社会化的后勤人员运送,很难保证运送的安全性。
此外,人工运送血液样本还会产生疾病传播的风险,例如对于当前正处于大流行时期的新型冠状病毒,其传播的方式主要就是接触传播和飞沫传播。疫情期间医院需要检测大量血液样本,运送交接过程中不可避免人员接触,而且目前的运送方式是:每天需要由工作人员做好防护措施后,再从采样处运送到检验科,其中的每一次运送都有接触,导致工作人员存在着极大的暴露风险。
发明内容
本发明的目的是提供用于医院血液样本运输的无人机姿态控制方法及无人机,旨在解决现有无人机控制精度较差,稳定性不够,难以满足运送血液样本的飞行要求的问题。
第一方面,本发明实施例提供一种用于医院血液样本运输的无人机姿态控制方法,该方法包括:
接收无人机目标姿态的控制指令;
获取无人机当前姿态,并计算出当前姿态与目标姿态之间的姿态角控制误差状态量;
获取无人机当前的飞行速度;
基于增益调度算法和无人机当前的飞行速度,对初始P增益进行更新,得到更新后的P增益;
根据所述更新后的P增益以及姿态角控制误差状态量,计算出控制输出;
基于所述控制输出,控制无人机的姿态。
第二方面,本发明实施例还提供一种无人机,其包括:
接收单元,接收无人机目标姿态的控制指令;
第一计算单元,获取无人机当前姿态,并计算出当前姿态与目标姿态之间的姿态角控制误差状态量;
获取单元,获取无人机当前的飞行速度;
更新单元,基于增益调度算法和无人机当前的飞行速度,对初始P增益进行更新,得到更新后的P增益;
第二计算单元,根据所述更新后的P增益以及姿态角控制误差状态量,计算出控制输出;
控制单元,基于所述控制输出,控制无人机的姿态。
第三方面,本发明实施例又提供了一种无人机,其包括:存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现上述第一方面所述的用于医院血液样本运输的无人机姿态控制方法。
本发明实施例提供用于医院血液样本运输的无人机姿态控制方法及无人机,该方法包括:接收无人机目标姿态的控制指令;获取无人机当前姿态,并计算出当前姿态与目标姿态之间的姿态角控制误差状态量;获取无人机当前的飞行速度;基于增益调度算法和无人机当前的飞行速度,对初始P增益进行更新,得到更新后的P增益;根据所述更新后的P增益以及姿态角控制误差状态量,计算出控制输出;基于所述控制输出,控制无人机的姿态。该方法通过获取无人机的飞行速度并结合增益调度算法,得到更新后的P增益,再根据更新后的P增益和姿态角控制误差状态量计算出控制输出,提高了控制精度,确保了无人机飞行的稳定性,此外采用无人机运输血液样本,可以减少人员接触,在疫情防控中的作用尤为明显,通过无人机运输的方式切断了传播途径,降低了感染风险。
附图说明
为了更清楚地说明本发明实施例技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
为了更清楚地说明本发明实施例技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明实施例提供的用于医院血液样本运输的无人机姿态控制方法的流程示意图;
图2为本发明实施例提供的无人机的示意性框图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
应当理解,当在本说明书和所附权利要求书中使用时,术语“包括”和“包含”指示所描述特征、整体、步骤、操作、元素和/或组件的存在,但并不排除一个或多个其它特征、整体、步骤、操作、元素、组件和/或其集合的存在或添加。
还应当理解,在此本发明说明书中所使用的术语仅仅是出于描述特定实施例的目的而并不意在限制本发明。如在本发明说明书和所附权利要求书中所使用的那样,除非上下文清楚地指明其它情况,否则单数形式的“一”、“一个”及“该”意在包括复数形式。
还应当进一步理解,在本发明说明书和所附权利要求书中使用的术语“和/或”是指相关联列出的项中的一个或多个的任何组合以及所有可能组合,并且包括这些组合。
请参阅图1,图1为本发明实施例提供的用于医院血液样本运输的无人机姿态控制方法的流程图;
如图1所示,该方法包括步骤S101~S106。
S101、接收无人机目标姿态的控制指令。
所述目标姿态是无人机在运输医院血液样本时的最佳姿态,在目标姿态下,血液样本可保持平稳放置。但无人机在携带血液样本飞行运输的过程中,因飞行环境因素的影响,比如障碍、风阻等因素的影响,无人机的飞行姿态可能会产生变化而偏离目标姿态,例如会产生剧烈晃动,而导致血液样本红细胞被破坏,引发溶血等现象,从而影响检验结果。故本实施例需要针对无人机当前姿态进行实时调整,以使无人机保持平稳飞行。
首先,需要确定无人机的目标姿态,该目标姿态可以是经过多次测试后得到的最佳姿态。具体可以通过控制系统将无人机目标姿态的控制指令发送至无人机,这样无人机即可按照目标姿态进行飞行。当然,也可以直接在无人机上进行设置,使无人机按照目标姿态进行飞行。
S102、获取无人机当前姿态,并计算出当前姿态与目标姿态之间的姿态角控制误差状态量。
如前所述,无人机虽然已接收到了目标姿态,在理想环境下其会按照目标姿态进行飞行,但实际飞行过程中,由于各种因素的影响,其实际姿态可能会发生偏离,故本实施例中,需获取无人机当前姿态并将当前姿态与接收的所述目标姿态进行比较,得到当前姿态与目标姿态之间的姿态差距,所述姿态差距即当前姿态与目标姿态之间的姿态角控制误差状态量,无人机的当前姿态需以目标姿态为标准进行调整,调整的过程即为当前姿态结合所述姿态角控制误差状态量做出姿态调整,使所述当前姿态达到目标姿态。
在一实施例中,所述步骤S102包括:
按如下公式计算当前姿态与目标姿态之间的姿态角控制误差状态量:
Figure BDA0002426931240000041
其中,
Figure BDA0002426931240000042
为目标姿态,
Figure BDA0002426931240000043
为当前姿态。
本实施例中,根据上述公式,即可将预设好的所述目标姿态的控制参数和所述当前姿态的控制参数进行对比,即可计算出当前姿态与目标姿态之间的姿态角控制误差状态量。
所述当前姿态一般由无人机上的惯性器件IMU解算得到,常用的解算方法是对IMU输出的角速率数据按照如下公式进行积分;
Figure BDA0002426931240000051
其中,
Figure BDA0002426931240000052
为IMU输出的三轴角速率数据。
S103、获取无人机当前的飞行速度。
本实施例中,无人机的飞行速度是影响无人机飞行姿态的重要因素,当所述飞行速度发生变化时,无人机的飞行姿态也要做出相应调整,才能保持无人机平稳飞行,所以在无人机飞行的过程中,需实时检测无人机的飞行速度,并结合所述飞行速度对当前姿态进行调整。
在一实施例中,所述步骤S103包括:
通过GPS测得所述无人机当前的飞行速度。
本实施例中,可以利用无人机的GPS芯片提供的GPS功能对无人机当前的飞行速度进行测量。GPS的定位系统非常精准且技术成熟稳定,可以提供连续、实时、高精度的三维位置,非常合适用于测量无人机的飞行速度;当然,也可以采用空速管或者微差压风速传感器或者超波测速微差压风速传感器等等测量方式进行测量。
S104、基于增益调度算法和无人机当前的飞行速度,对初始P增益进行更新,得到更新后的P增益,所述增益调度算法如下:
Figure BDA0002426931240000053
其中,
Figure BDA0002426931240000054
为初始P增益,
Figure BDA0002426931240000055
为控制增益系数,V0为无人机当前的飞行速度。
本实施例中,根据所述增益调度算法,在上述公式中代入控制增益系数和无人机当前的飞行速度,即可获取更新后的P增益。
在另一实施例中,所述初始P增益为V0=0状态下的P增益。
本实施例中,当V0=0,相当于无人机飞行速度为0,在此状态下的P增益即为初始P增益。目标姿态是根据特定飞行环境预先调好的,在无人机受飞行环境影响导致飞行速度发生变化时,会造成PID控制器控制效果下降,从而引起飞行姿态变化增大,飞行不稳定。
在一具体场景中,无人机飞行速度发生变化时,无人机螺旋桨的气动效率发生变化,在无风状态下,空气静止,无人机相对空气以V0速度飞行;相当于无人机静止,空气以V0速度吹向无人机,Vr为螺旋桨的转动线速度,则螺旋桨相对大气的速度为Ve,则
Ve=V0+Vr
螺旋桨收到的气动力f为
Figure BDA0002426931240000061
其中,ρ为大气密度,Cd为阻力系数,S为桨的气动面积。
由此可见,螺旋桨的气动效率随着飞行速度V0的变化而变化。当飞行速度变化时,传统的PID姿态控制算法中的系数矩阵保持不变,造成控制效率降低,所以会引起飞行姿态变化增大,出现飞行不稳定的情况。
本实施例正是发现了上述问题,所以根据增益调度算法,获取了更新后的P增益,可有效抑制由于无人机飞行速度变化导致的姿态晃动,提高了控制精度。
也就是说,虽然采用无人机运送血液样本可以降低疾病传播的风险,但是受各种飞行环境因素影响,无人机的飞行状态发生变化时,PID控制器的控制效果下降,会导致无人机的稳定性不够,在飞行过程中可能引发剧烈晃动,容易导致血液样本被破坏。如果血液标本在运输过程中由于震荡或溅洒导致标本不合格,就要重新抽血,再次增加医务人员与患者接触机会,如果该患者刚好是新冠或者疑似新冠人员,就会导致医务人员乃至其他密切接触者的感染,所以通过本实施例提供的方法可以解决血液样本运输过程中的晃动问题,提高飞行稳定性。
S105、根据所述更新后的P增益以及姿态角控制误差状态量,计算出控制输出。
本实施例中,所述更新后的P增益以及姿态角控制误差状态量均为变量,依据无人机的飞行姿态变化而产生的变量,其计算出的控制输出可针对无人机实时的飞行姿态进行稳定控制,大大增强飞行的稳定性。
在一实施例中,所述步骤S105包括:
按如下公式计算控制输出:
Figure BDA0002426931240000071
其中,u(t)为控制输出,
Figure BDA0002426931240000072
为基于所述更新后的P增益转换得到的姿态P系数矩阵,
Figure BDA0002426931240000073
为姿态I系数矩阵,
Figure BDA0002426931240000074
为姿态D系数矩阵,
Figure BDA0002426931240000075
为姿态角控制误差状态量。
本实施例中,根据更新后的P增益以及姿态角控制误差状态量,代入公式中计算出控制输出,通过该公式算出的控制输出有效的提高了无人机的姿态控制效率和精准度,无人机的飞行更加平稳,使得无人机运送血液样本的过程更加安全稳定。
S106、基于所述控制输出,控制无人机的姿态。
本实施例中,通过所述控制输出来控制无人机从当前姿态变化为目标姿态,以应对飞行环境和飞行速度的影响,确保无人机平稳飞行。
在一实施例中,该方法还包括步骤S201~S202。
S201、预先将无人机的飞行速度进行分段;
S202、基于各个分段区间,分别设置对应的控制增益系数。
本实施例中,所述无人机的飞行速度和控制增益系数是对初始P增益进行更新的重要指标,更新后的P增益又是控制输出控制飞行姿态的重要数据,所以,为了使更新后的P增益更加精准,可以对无人机的飞行速度进行分段,每个分段区间分别设置对应的控制增益系数,这样各个分段区间将具有更加精准的控制增益系数。
具体的,所述控制增益系数的取值受无人机质量、转动惯量、动力系统配置等因素的影响较大,因此在实际应用时可根据无人机的机型进行调试。
更具体的,将所述飞行速度分为三段,
Figure BDA0002426931240000081
系数的取值根据三段飞行速度分别进行取值,比如:速度分段为
Figure BDA0002426931240000082
分别对应
Figure BDA0002426931240000083
系数的取值
Figure BDA0002426931240000084
即当0≤V0<V1时,Kpφa=p1,并以此类推。其中,V1,V2,V3,V4,V5,V6均为预设值;p1,p2,p3,p4,p5,p6,p7,p8,p9均为常系数。
如图2所示,本发明实施例还提供一种无人机,包括:接收单元201、第一计算单元202、获取单元203、更新单元204、第二计算单元205以及控制单元206。
接收单元201,用于接收无人机目标姿态的控制指令;
第一计算单元202,用于获取无人机当前姿态,并计算出当前姿态与目标姿态之间的姿态角控制误差状态量;
获取单元203,用于获取无人机当前的飞行速度;
更新单元204,用于基于增益调度算法和无人机当前的飞行速度,对初始P增益进行更新,得到更新后的P增益,所述增益调度算法如下:
Figure BDA0002426931240000085
其中,
Figure BDA0002426931240000086
为初始P增益,
Figure BDA0002426931240000087
为控制增益系数,V0为无人机当前的飞行速度;
第二计算单元205,用于根据所述更新后的P增益以及姿态角控制误差状态量,计算出控制输出;
控制单元206,用于基于所述控制输出,控制无人机的姿态。
所述无人机通过动态调整飞行姿态的方式,解决了无人机受飞行速度影响导致的姿态不平稳的问题,提高了运送血液样本的安全性、时效性。
在一实施例中,所述第一计算单元202包括:
误差状态量计算单元,用于按如下公式计算当前姿态与目标姿态之间的姿态角控制误差状态量:
Figure BDA0002426931240000091
其中,
Figure BDA0002426931240000092
为目标姿态,
Figure BDA0002426931240000093
为当前姿态。
通过计算出当前姿态与目标姿态之间的姿态角控制误差状态量,提供当前姿态需药进行调整的姿态角控制状态量。
在一实施例中,所述获取单元203包括:
速度获取单元,通过GPS测得所述无人机当前的飞行速度。根据所测的飞行速度对无人机的飞行姿态的进行调整。
本发明实施例提供的无人机包括通过系统总线连接的处理器、存储器和网络接口,其中,存储器可以包括非易失性存储介质和内存储器。
该处理器用于提供计算和控制能力,支撑整个无人机的运行。
该内存储器为非易失性存储介质中的计算机程序的运行提供环境,该计算机程序被处理器执行时,可使得处理器执行用于医院血液样本运输的无人机姿态控制方法。
该网络接口用于进行网络通信,如提供数据信息的传输等。本领域技术人员可以理解,上述实施例并不构成对本发明方案所应用于其上的无人机的限定,具体的无人机可以包括比上述实施例更多或更少的部件,或者组合某些部件,或者具有不同的部件布置。
本领域技术人员可以理解,所述无人机的实施例并不构成对无人机具体构成的限定,在其他实施例中,无人机可以包括比上述实施例更多或更少的部件,或者组合某些部件,或者不同的部件布置。例如,在一些实施例中,无人机可以仅包括存储器及处理器,在这样的实施例中,存储器及处理器的结构及功能与上述实施例一致,在此不再赘述。
应当理解,在本申请实施例中,处理器可以是中央处理单元(Central ProcessingUnit,CPU),该处理器还可以是其他通用处理器、数字信号处理器(Digital SignalProcessor,DSP)、专用集成电路(Application Specific Integrated Circuit,ASIC)、现成可编程门阵列(Field-Programmable Gate Array,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。其中,通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。
以上所述,仅为本申请的具体实施方式,但本申请的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本申请揭露的技术范围内,可轻易想到各种等效的修改或替换,这些修改或替换都应涵盖在本申请的保护范围之内。因此,本申请的保护范围应以权利要求的保护范围为准。

Claims (10)

1.一种用于医院血液样本运输的无人机姿态控制方法,其特征在于,包括:
接收无人机目标姿态的控制指令;
获取无人机当前姿态,并计算出当前姿态与目标姿态之间的姿态角控制误差状态量;
获取无人机当前的飞行速度;
基于增益调度算法和无人机当前的飞行速度,对初始P增益进行更新,得到更新后的P增益,所述增益调度算法如下:
Figure FDA0002426931230000011
其中,
Figure FDA0002426931230000012
为初始P增益,
Figure FDA0002426931230000013
为控制增益系数,V0为无人机当前的飞行速度;
根据所述更新后的P增益以及姿态角控制误差状态量,计算出控制输出;
基于所述控制输出,控制无人机的姿态。
2.根据权利要求1所述的用于医院血液样本运输的无人机姿态控制方法,其特征在于,所述获取无人机当前姿态,并计算出当前姿态与目标姿态之间的姿态角控制误差状态量,包括:
按如下公式计算当前姿态与目标姿态之间的姿态角控制误差状态量:
Figure FDA0002426931230000014
其中,
Figure FDA0002426931230000015
为目标姿态,
Figure FDA0002426931230000016
为当前姿态。
3.根据权利要求1所述的用于医院血液样本运输的无人机姿态控制方法,其特征在于,所述获取无人机当前的飞行速度,包括:
通过GPS测得所述无人机当前的飞行速度。
4.根据权利要求1所述的用于医院血液样本运输的无人机姿态控制方法,其特征在于,还包括:
预先将无人机的飞行速度进行分段;
基于各个分段区间,分别设置对应的控制增益系数。
5.根据权利要求1所述的用于医院血液样本运输的无人机姿态控制方法,其特征在于,所述根据所述更新后的P增益以及姿态角控制误差状态量,计算出控制输出,包括:
按如下公式计算控制输出:
Figure FDA0002426931230000021
其中,u(t)为控制输出,
Figure FDA0002426931230000022
为基于所述更新后的P增益转换得到的姿态P系数矩阵,
Figure FDA0002426931230000023
为姿态I系数矩阵,
Figure FDA0002426931230000024
为姿态D系数矩阵,
Figure FDA0002426931230000025
为姿态角控制误差状态量。
6.根据权利要求1所述的用于医院血液样本运输的无人机姿态控制方法,其特征在于,所述初始P增益为V0=0状态下的P增益。
7.一种无人机,其特征在于,包括:
接收单元,接收无人机目标姿态的控制指令;
第一计算单元,获取无人机当前姿态,并计算出当前姿态与目标姿态之间的姿态角控制误差状态量;
获取单元,获取无人机当前的飞行速度;
更新单元,基于增益调度算法和无人机当前的飞行速度,对初始P增益进行更新,得到更新后的P增益,所述增益调度算法如下:
Figure FDA0002426931230000026
其中,
Figure FDA0002426931230000027
为初始P增益,
Figure FDA0002426931230000028
为控制增益系数,V0为无人机当前的飞行速度;
第二计算单元,根据所述更新后的P增益以及姿态角控制误差状态量,计算出控制输出;
控制单元,基于所述控制输出,控制无人机的姿态。
8.根据权利要求7所述的无人机,其特征在于,所述第一计算单元包括:
误差状态量计算单元,用于按如下公式计算当前姿态与目标姿态之间的姿态角控制误差状态量:
Figure FDA0002426931230000031
其中,
Figure FDA0002426931230000032
为目标姿态,
Figure FDA0002426931230000033
为当前姿态。
9.根据权利要求7所述的无人机,其特征在于,所述获取单元包括:
速度获取单元,通过GPS测得所述无人机当前的飞行速度。
10.一种无人机,其特征在于,包括:存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现如权利要求1至6中任一项所述的用于医院血液样本运输的无人机姿态控制方法。
CN202010223640.4A 2020-03-26 2020-03-26 用于医院血液样本运输的无人机姿态控制方法及无人机 Active CN111290424B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010223640.4A CN111290424B (zh) 2020-03-26 2020-03-26 用于医院血液样本运输的无人机姿态控制方法及无人机

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010223640.4A CN111290424B (zh) 2020-03-26 2020-03-26 用于医院血液样本运输的无人机姿态控制方法及无人机

Publications (2)

Publication Number Publication Date
CN111290424A true CN111290424A (zh) 2020-06-16
CN111290424B CN111290424B (zh) 2020-11-06

Family

ID=71027265

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010223640.4A Active CN111290424B (zh) 2020-03-26 2020-03-26 用于医院血液样本运输的无人机姿态控制方法及无人机

Country Status (1)

Country Link
CN (1) CN111290424B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115035998A (zh) * 2022-08-02 2022-09-09 之江实验室 基于早期预测和无人快速配送的紧急血液调度方法及系统

Citations (21)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1984001345A1 (en) * 1982-09-30 1984-04-12 Boeing Co Total energy based flight control system
WO2003027789A1 (en) * 2001-09-25 2003-04-03 Sikorsky Aircraft Corporation Flight control system for a hybrid aircraft in a transition region
CN101339404A (zh) * 2008-08-07 2009-01-07 北京航空航天大学 飞行器姿态动力学简化模型增益切换比例-微分控制的设计方法
EP2233766A1 (en) * 2009-03-27 2010-09-29 Hoerbiger Antriebstechnik GmbH Clutch pressure control device
CN102375678A (zh) * 2010-08-10 2012-03-14 联想(新加坡)私人有限公司 用于姿态控制的装置和方法
CN102607562A (zh) * 2012-04-12 2012-07-25 南京航空航天大学 基于载体飞行模态判别的微惯性参数自适应姿态确定方法
CN103365295A (zh) * 2013-06-29 2013-10-23 天津大学 基于dsp的四旋翼无人飞行器自主悬停控制系统及方法
CN103869701A (zh) * 2014-02-27 2014-06-18 天津大学 基于姿态序列解算的飞行器新型实时制导方法
CN104808674A (zh) * 2015-03-03 2015-07-29 广州亿航智能技术有限公司 多旋翼飞行器的控制系统、终端及机载飞控系统
WO2015121169A1 (en) * 2014-02-11 2015-08-20 Saudi Basic Industries Corporation Control system
CN105573333A (zh) * 2016-01-22 2016-05-11 青岛大学 一种用于四旋翼飞行器的模块式控制方法
CN106882363A (zh) * 2017-02-10 2017-06-23 杭州市第人民医院 一种用于医院血液样本运输的无人机运输系统及运输方法
CN107065901A (zh) * 2017-01-18 2017-08-18 北京京东尚科信息技术有限公司 一种旋翼无人机姿态控制方法、装置及无人机
US20180032089A1 (en) * 2016-07-27 2018-02-01 Kitty Hawk Corporation Maintaining a stable phase difference between multiple tethered vehicles lifting a payload
CN108078577A (zh) * 2017-11-22 2018-05-29 上海奕瑞光电子科技股份有限公司 一种数字x射线放射系统、姿态检测方法以及姿态检测系统
CN108762284A (zh) * 2018-05-17 2018-11-06 北京航空航天大学 一种基于lpv技术的航天器姿态跟踪控制方法与装置
CN109506646A (zh) * 2018-11-20 2019-03-22 石家庄铁道大学 一种双控制器的无人机姿态解算方法及系统
CN110132287A (zh) * 2019-05-05 2019-08-16 西安电子科技大学 一种基于极限学习机网络补偿的卫星高精度联合定姿方法
CN110161855A (zh) * 2019-05-21 2019-08-23 中国电子科技集团公司第三十八研究所 一种基于鲁棒伺服增益调度无人机控制器的设计方法
CN110673623A (zh) * 2019-11-04 2020-01-10 苏州经贸职业技术学院 一种基于双环pd控制算法控制的四旋翼无人机着陆方法
CN110888451A (zh) * 2019-12-20 2020-03-17 国网山西省电力公司电力科学研究院 一种多旋翼无人机容错控制方法及系统

Patent Citations (21)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1984001345A1 (en) * 1982-09-30 1984-04-12 Boeing Co Total energy based flight control system
WO2003027789A1 (en) * 2001-09-25 2003-04-03 Sikorsky Aircraft Corporation Flight control system for a hybrid aircraft in a transition region
CN101339404A (zh) * 2008-08-07 2009-01-07 北京航空航天大学 飞行器姿态动力学简化模型增益切换比例-微分控制的设计方法
EP2233766A1 (en) * 2009-03-27 2010-09-29 Hoerbiger Antriebstechnik GmbH Clutch pressure control device
CN102375678A (zh) * 2010-08-10 2012-03-14 联想(新加坡)私人有限公司 用于姿态控制的装置和方法
CN102607562A (zh) * 2012-04-12 2012-07-25 南京航空航天大学 基于载体飞行模态判别的微惯性参数自适应姿态确定方法
CN103365295A (zh) * 2013-06-29 2013-10-23 天津大学 基于dsp的四旋翼无人飞行器自主悬停控制系统及方法
WO2015121169A1 (en) * 2014-02-11 2015-08-20 Saudi Basic Industries Corporation Control system
CN103869701A (zh) * 2014-02-27 2014-06-18 天津大学 基于姿态序列解算的飞行器新型实时制导方法
CN104808674A (zh) * 2015-03-03 2015-07-29 广州亿航智能技术有限公司 多旋翼飞行器的控制系统、终端及机载飞控系统
CN105573333A (zh) * 2016-01-22 2016-05-11 青岛大学 一种用于四旋翼飞行器的模块式控制方法
US20180032089A1 (en) * 2016-07-27 2018-02-01 Kitty Hawk Corporation Maintaining a stable phase difference between multiple tethered vehicles lifting a payload
CN107065901A (zh) * 2017-01-18 2017-08-18 北京京东尚科信息技术有限公司 一种旋翼无人机姿态控制方法、装置及无人机
CN106882363A (zh) * 2017-02-10 2017-06-23 杭州市第人民医院 一种用于医院血液样本运输的无人机运输系统及运输方法
CN108078577A (zh) * 2017-11-22 2018-05-29 上海奕瑞光电子科技股份有限公司 一种数字x射线放射系统、姿态检测方法以及姿态检测系统
CN108762284A (zh) * 2018-05-17 2018-11-06 北京航空航天大学 一种基于lpv技术的航天器姿态跟踪控制方法与装置
CN109506646A (zh) * 2018-11-20 2019-03-22 石家庄铁道大学 一种双控制器的无人机姿态解算方法及系统
CN110132287A (zh) * 2019-05-05 2019-08-16 西安电子科技大学 一种基于极限学习机网络补偿的卫星高精度联合定姿方法
CN110161855A (zh) * 2019-05-21 2019-08-23 中国电子科技集团公司第三十八研究所 一种基于鲁棒伺服增益调度无人机控制器的设计方法
CN110673623A (zh) * 2019-11-04 2020-01-10 苏州经贸职业技术学院 一种基于双环pd控制算法控制的四旋翼无人机着陆方法
CN110888451A (zh) * 2019-12-20 2020-03-17 国网山西省电力公司电力科学研究院 一种多旋翼无人机容错控制方法及系统

Non-Patent Citations (6)

* Cited by examiner, † Cited by third party
Title
A.A.TUNIK ETAL: "Robust Digital Gain-Scheduling Control of the UAV Altitude", 《2017 IEEE 4TH INTERNATIONAL CONFERENCE ACTUAL PROBLEMS OF UNMANNED AERIAL VEHICLES DEVELOPMENTS(APUAVD)》 *
SU HAOQIN ETAL: "Morphing Process Research of UAV with PID Controller", 《PROCEDIA RNGINEERING》 *
文嘉瑜: "倾转旋翼机飞行控制律重构技术研究", 《中国优秀硕士学位论文全文数据库 工程科技II辑》 *
李中健等: "不确定性表示及在高性能鲁棒飞行控制器设计中的应用研究", 《西北工业大学学报》 *
许江涛等: "协调增益调度的重复使用助推器姿态控制设计", 《光学精密工程》 *
黄安: "涵道风扇无人机悬停状态姿态控制器设计", 《中国优秀硕士学位论文全文数据库 工程科技II辑》 *

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115035998A (zh) * 2022-08-02 2022-09-09 之江实验室 基于早期预测和无人快速配送的紧急血液调度方法及系统
CN115035998B (zh) * 2022-08-02 2022-11-11 之江实验室 基于早期预测和无人快速配送的紧急血液调度方法及系统

Also Published As

Publication number Publication date
CN111290424B (zh) 2020-11-06

Similar Documents

Publication Publication Date Title
Sanchez-Cuevas et al. Robotic system for inspection by contact of bridge beams using UAVs
De Marina et al. Adaptive UAV attitude estimation employing unscented Kalman filter, FOAM and low-cost MEMS sensors
CN106681344A (zh) 一种用于飞行器的高度控制方法及控制系统
KR20150043392A (ko) 바람 벡터 추산
CN106774409A (zh) 一种无人机的半自主仿地飞行系统及其控制方法
CN105843249A (zh) 基于Pixhawk飞控的无人机自动巡航系统及其巡航方法
Rodriguez Salazar et al. Small uas-based wind feature identification system part 1: Integration and validation
CN106774374B (zh) 一种无人机自动巡检方法及系统
CN111221347B (zh) 垂直起降固定翼无人机姿态估计中加速度补偿方法及系统
Meier et al. Wind estimation with multirotor uavs
Jimenez et al. Experimental validation of total energy control system for UAVs
CN111290424B (zh) 用于医院血液样本运输的无人机姿态控制方法及无人机
CN109725649A (zh) 一种基于气压计/imu/gps多传感器融合的旋翼无人机定高算法
Chan et al. Implementation of the rauch-tung-striebel smoother for sensor compatibility correction of a fixed-wing unmanned air vehicle
WO2023044173A2 (en) Methods and systems for flight control configured for use in an electric aircraft
Bigazzi et al. Development of non expensive technologies for precise maneuvering of completely autonomous unmanned aerial vehicles
Guo et al. Low-cost sensors state estimation algorithm for a small hand-launched Solar-powered UAV
Xu et al. An extensible positioning system for locating mobile robots in unfamiliar environments
Jacewicz et al. Quadrotor model for energy consumption analysis
Keller et al. A robust and accurate landing methodology for drones on moving targets
Dong et al. An integrated UWB-IMU-vision framework for autonomous approaching and landing of UAVs
US20170336803A1 (en) Automated flight control system with altitude-based, automatically-adjusting rate of climb
Gill et al. An annular wing VTOL UAV: Flight dynamics and control
CN106292685A (zh) 模型飞机及其飞行控制方法和系统
Ge et al. Vision-based UAV landing with guaranteed reliability in adverse environment

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
GR01 Patent grant
GR01 Patent grant