利索能及
我要发布
收藏
专利号: 2020107208025
申请人: 滨州学院
专利类型:发明专利
专利状态:已下证
更新日期:2025-09-11
缴费截止日期: 暂无
联系人

摘要:

权利要求书:

1.基于重心动力学的航模PID算法控制方法,具体步骤如下,其特征在于,步骤1:对三旋翼航模进行运动学建模,分别建立航模重心坐标系和各旋翼处坐标系;

步骤2:在步骤1的基础上建立无负重和有负重的旋翼航模力矩模型;

步骤2中无负重和有负重的旋翼航模力矩模型如下:

步骤2.1三旋翼航模飞行时,旋翼电机将产生两种力:上升力F1、F2、F3和旋翼电机扭转力f1、f2、f3,则旋翼电机的扭转力矩平衡方程可化为下式:l1·f1cos60°‑l2·f2sin30°=0                   (1)l1·f2sin60°+l2·f2cos30°+l3·f3=0                (2)其中,l1、l2、l3分别为航模旋翼力臂的长度,通过式1和式2可得旋翼电机扭转力之间的关系:步骤2.2建立负重时的航模力矩平衡方程,当航模承载负重后,航模本身重心将会发生改变,新的力矩平衡也将发生改变,设新的重心为O',新的力矩为l'1、l'2、l'3,机翼电机升力f'1、f'2、f'3为则满足力矩平衡方程:f'1·l'1+f'2·l'2+f'3·l'3+G0l0=0                (4)其中G0是航模负重后的重力,l0是航模新重心到支点O的距离;

步骤3:计算航模各机翼期望加速度和航模反馈重心动量矩阵和动量矩阵导数,通过重心动力学求出重心动量变化率,继而求出航模所受合外力;

步骤3中航模合外力求解如下:

对航模力矩建模后,进一步对航模重心动力学建模,航模的重心动力学建模与航模机翼的空间动力学方程有关,航模机翼的速度可由包含所有机翼的速度 描述,如下式所示:假设航模不受其他力影响,则航模的空间动力学方程可化为:H是航模机翼的空间惯性矩阵,机翼的加速度,C是航模机翼的空间偏差力矩阵,τ是航模机翼力矩矩阵,τg是航模重力矩阵,τ和τg由步骤2.1至2.2求得;

航模的重心动量和速度向量由重心动量矩阵AG相关联:

其中 是航模的实际重心动量,AG是重心动量矩阵;对式7求导可得:航模所受的外力主要有:航模的重力和机翼的作用力,当重心改变时,重心坐标将会发生改变1

其中 是重心坐标发生变换的变换矩阵,式8和式9是航模重心动力学方程在重心坐标系的形式,无论航模加速度 取何值时,式8和式9都是等价的,可得:在求得AG和 后,回代式8可得航模重心动量变化率,重心动量的变化率与航模所受的合外力相等;

步骤4:将控制器设置的合外力和实际合外力的偏差作为PID算法的输入,实现三旋翼PID算法的控制方法。

2.根据权利要求1基于重心动力学的航模PID算法控制方法,其特征在于:步骤1中建立航模重心坐标系和各旋翼处坐标系如下:对航模的各部分进行编号,地面的编号是B0、机身编号是B1、旋翼连杆分别是B2、B3、B4;

再分别建立航模重心坐标系Ob‑xbybzb和各旋翼处坐标系,其中旋翼坐标系与重心坐标系平行。

3.根据权利要求1基于重心动力学的航模PID算法控制方法,其特征在于:步骤4中三旋翼PID算法的控制方法如下:PID算法根据航模所受合外力输入值r(t)和合外力实际值y(t)的偏差值e(t),在经过比例(P)、积分(I)、微分(D)函数关系运算后,将PID算法的运算结果用于三旋翼航模的飞行器控制,PID算法控制公式如下:式中kp是比例系数,对航模合外力的偏差做出及时的反应,当产生偏差时,飞行器的控制器将产生控制作用使得航模被控量朝着减小偏差的方向变化,而飞行器控制器的强弱将取决于比例系数的大小;Tl是积分时间,积分项用于减小合外力偏差;TD是微分时间,微分项有着预测作用,可以减小控制器的超调量,从而减少系统震荡。