不仅抗干扰能力强

  是微型飞行器的其中一种,相对于固定翼飞行器,它的方向控制灵活、抗干扰能力强、飞行稳定,能够携带一定的负载和有悬停功能,因此能够很好地进行空中拍摄、监视、侦查等功能,在军事和民用上具备广泛的运用前景。

  四轴飞行器关键技术在于控制策略。由于智能控制算法在运行复杂的浮点型运算以及矩阵运算时,微处理器计算能力受限,难以达到飞行控制实时性的要求;而PID控制简单,易于实现,且技术成熟,因此目前主流的控制策略主要是围绕传统的PID控制展开。

  四轴飞行器结构主要由主控板和呈十字交叉结构的4个电子调速器、电机、旋浆组成,电机由电子调速器控制,主控板主要负责解算当前飞行姿态、控制电调等功能。

  以十字飞行模式为例,l号旋翼为头,1、3号旋翼逆时针旋转,2、4号旋翼顺时针旋转,如图1所示。

  参照飞行状态表1变化电机转速,由于四个电机转速不同,使其与水平面倾斜一定角度,如图l所示。四个电机产生的合力分解为向上的升力与前向分力。当重力与升力相等时,前向分力驱动四轴飞行器向倾斜角度的方向水平飞行。空间三轴角度欧拉角分为仰俯角、横滚角、航向角:倾斜角是仰俯角时,向前、向后飞行;倾斜角是横滚角时,向左、向右飞行;而倾斜航向角时,向左、右旋转运动,左(右)旋转是由于顺时针两电机产生的反扭矩之和与逆时针两电机产生的反扭矩之和不等,即不能相互抵消,机身便在反扭矩作用下绕z轴自旋转。

  四轴飞行器运用姿态解算计算出空间三轴欧拉角。结构框架如图2所示,陀螺仪采样三轴角速度值,加速度传感器采样三轴加速度值,而磁力传感器采样得到三轴地磁场值,将陀螺仪、加速度传感器、磁力传感器采样后的数据进行标定、滤波、校正后得到三轴欧拉角度,其中陀螺仪和加速度传感器选用MPU6050芯片,磁力传感器选用HMC5883L芯片,采用IIC总线与主控板通信。

  由于传感器存在器件误差,因此在使用前需要标定。陀螺仪在静止时,角速度为0;但实际情况由于器件误差并不为0,因此可在静止时采样500次数据,再求平均,得出偏移量,标定陀螺仪数据;加速度传感器可依据在静止时,三轴重力加速度平方和的开方为重力加速度的标定方程,利用最小二乘法求出标定偏移值和误差值进行标定。而磁力传感器校正,可将器件静置于桌面旋转一周找出最小值和最大值,通过电子罗盘校正计算公式计算出标定偏移值和误差值。

  由于陀螺仪长时间采集角速度会有飘移,因此需要使用加速度传感器的值与磁力传感器的值进行校正。将加速度的测量矢量和磁场的测量矢量与参考矢量做叉积后相加

  式(1)中:ex、ey、ez为两叉积之和,ax、ay、az为加速度的测量矢量,mx、my、mz为磁场的测量矢量,axref、ayref、azref为加速度的参考矢量,mxref、myref、mzref为磁场的参考矢量,参考矢量是通过实时四元数值与本次测量值计算出来。

  高度计算是通过气压传感器采集的大气压值计算出来,将气压传感器采集值进行校正后,在通过温度二阶补偿,得到准确的大气压值,最后经过气压转换为高度公式

  式(6)中Altitude为计算出来的实际高度,CurrentPressure为当前气压值,StartPressure为起飞之前气压值。气压传感器选用MS5611芯片,其中集成了温度传感器和气压传感器,采用IIC总线

  当四轴飞行器正常飞行时,突遇外力(风等)或磁场干扰,使加速度传感器或磁力传感器采集数据失真,造成姿态解算出来的欧拉角错误,只用角度单环情况下,使系统很难稳定运行,因此可以加入角速度作为内环,角速度由陀螺仪采集数据输出,采集值一般不存在受外界影响情况,抗干扰能力强,并且角速度变化灵敏,当受外界干扰时,回复迅速;同理,高度环中气压传感器同样也会受到外界干扰,引入z轴加速度环可有效避免外界干扰造成的影响,增强了系统的鲁棒性。四轴飞行器

  控制,如图3、图4所示。角度作为外环,角速度作为内环,进行姿态PID控制;当需要定高时,高度作为外环,z轴加速度作为内环,进行高度PID控制。其中,PID输出为油门值,油门给定电子调速器值,电子调速器控制电机使空间三轴欧拉角和高度变化。

  PID输出值先经过限幅处理,再输出给油门,防止某些时刻输出油门值过大,造成过冲,使系统难以稳定,公式如下

  以十字飞行模式为例,PID控制条件为线性环境,而给出的油门值与转速的关系为非线性,且两对向电机再同一油门下转速存在差异。运用光电传感器测出不同油门量对应的转速,通过matlab软件绘制出该曲线,其中一对向电机油门与转速的关系如图5所示,两电机在相同油门下转速存在差异且不平行,因此将油门曲线分段,并通过计算公式

  进行油门补偿,式(16)中、为补偿偏移系数,得出曲线(b)所示。

  本次测试姿态解算更新周期T 4 mS,PID控制更新周期T 10 ms,期望值为水平0度。将四轴飞行器控制仰俯角的一对电机固定住,另一对边能自由旋转,即能改变横滚角度,如图6所示。将横滚角倾斜到 - 70,遥控器油门迅速推到1400,平衡后如图6所示。

  由图7可知,横滚角波形经过一大波一小波震荡后近似归为期望值零点,且超调量较小,系统很快进入稳定状态。

  其他欧拉角测试结果类似。在加入双闭环高度PID控制,四轴飞行器在室外飞行效果如图8所示,可以看出飞行器飞行稳定,达到设计要求。

  主要研究了基于四轴飞行器的双闭环PID控制算法。在姿态PID控制和高度PID控制中分别增加了内环角速度环和加速度环,不仅抗干扰能力强,并且回复迅速,增强了系统的鲁棒性。

相关产品推荐

在线客服 :

服务热线:4008-071-523

电子邮箱: 5596321598@qq.com

公司地址:广东省汕尾市桃平新村工业开发区

秒速时时彩 有限公司是一家属于中德合资高科技型企业,专业研发、生产高品质气动元件 !是一家专注于生产制造和销售服务为一体综合的气缸厂家企业,气缸等气动元件出口欧美多个发达工业国家,主营铝合金气缸,不锈钢气缸,非标定制气缸,铝合金气缸,不锈钢气缸,非标定制气缸!为您提供全面详细的采购参考! ...

友情链接:
Copyright © 2011-2018 秒速时时彩 版权所有 丨网站地图