The invention discloses a method for attitude control of an underwater glider based on fuzzy PID. The algorithm includes: (1) fuzzy PID controller design principle; (2) fuzzy PID controller design in Matlab; (3) preparation of fuzzy PID controller control program; (4) to build a fuzzy PID controller structure diagram; (5) set up the control system, the operation of fuzzy PID controller control program, control algorithm. The invention can solve the problem of large delay and large inertia control of the attitude angle, the real-time control parameter setting of the attitude angle and the strong coupling control of the attitude angle. The utility model has the advantages of short development cycle, short test period, low cost, good control effect, shortening the adjustment time of the attitude angle and reducing the steady-state error. In the long run, good attitude control can reduce battery power consumption, enhance the glider endurance.
【技术实现步骤摘要】
本专利技术涉及一种基于模糊PID的水下滑翔机姿态控制算法。
技术介绍
当今社会,对于海洋全面认知的需求,实现真正了解海洋、服务人类的目的,海洋探索的步伐不断从近海走向远洋,从浅海走向深海,从定点走向空间,不断深入。用于海洋监测、考察和开发的主要工具也从海洋科考船只逐渐转向水下机器人,在海洋工程界通常称为潜水器。海洋探测工具按照历史进程取得了长足发展,其中水下机器人按是否载人分为载人、载人无人两用和无人三种类型。可载人型机器人相对机动灵活,便于处理复杂问题,但需要有复杂的生命保障系统,而且体积庞大,价格昂贵;对于航程长、范围广的考察任务则常选用无人潜水器,也可是无人水下机器人。水下滑翔机作为无人潜水器的一种,航行速度不如螺旋桨推进的水下自主航行器,但它由自身净浮力提供驱动力,具有能耗小、噪音低、续航能力长、制造成本低、可重复利用、投放回收方便等优势,适于大范围长期的海洋立体监测,能够长时间不间断地进行海洋信息的搜集,海洋探测和科研的范围从时间和空间上得到了拓展。水下滑翔机的姿态控制是滑翔机领域内的一个重要研究课题,因为滑翔机所需航行能量来源于其搭载电池组,而电池电量的消耗很大程度上来源于航行姿态,如若有一个很完备的航行姿态控制技术,便可优化航行轨迹,提高航行里程,减少航行电池电量的消耗,从而使得滑翔机有效工作时间更长。现有技术不能对滑翔机的姿态角进行实时控制,并且控制效果并不能很好的满足控制指标。另外,现有技术需要获得较为精确的姿态角传递函数,需要通过大量的试验,分析试验数据得出,成本高,效率低,耗时长。而本项专利技术的主要目的,是为解决现有技术的缺点来提 ...
【技术保护点】
基于模糊PID的水下滑翔机姿态控制算法,包括以下步骤:(1)模糊PID控制器原理性设计设计模糊PID控制器时首先需要进行模糊化处理和知识库的配置;根据要求设计出死区、饱和区和采样周期;根据PID各个参数对被控系统的影响可以得到:模糊PID控制以系统运行的不同状态为基础,考虑比例增益Δkp、积分增益Δki、微分增益Δkd三个参数之间的关联,根据工程实际经验设计模糊控制器整定这三个参数,选择输入变量为误差e和误差变化率ec,相对应的语言变量值取NB、NM、NS、ZE、PS、PM、PB七个模糊值;再选择输出语言变量为Kp、Ki、Kd,相对应的语言变量值也取NB、NM、NS、ZE、PS、PM、PB七个模糊值,并且可对应求出误差因子、误差变化率因子和输出比例因子;然后得出比例增益Δkp、积分增益Δki、微分增益Δkd的模糊规则表,其中Δ表示取微分;(2)模糊PID控制器Matlab中的设计基于以上模糊规则表的建立,然后在MATLAB中进行控制器设计,对输入输出结构、隶属度函数及规则库进行配置;该模糊控制器根据条件设置为两输入三输出结构,控制器输入为误差和误差变化率,输出为比例、积分和微分增益;根 ...
【技术特征摘要】
1.基于模糊PID的水下滑翔机姿态控制算法,包括以下步骤:(1)模糊PID控制器原理性设计设计模糊PID控制器时首先需要进行模糊化处理和知识库的配置;根据要求设计出死区、饱和区和采样周期;根据PID各个参数对被控系统的影响可以得到:模糊PID控制以系统运行的不同状态为基础,考虑比例增益Δkp、积分增益Δki、微分增益Δkd三个参数之间的关联,根据工程实际经验设计模糊控制器整定这三个参数,选择输入变量为误差e和误差变化率ec,相对应的语言变量值取NB、NM、NS、ZE、PS、PM、PB七个模糊值;再选择输出语言变量为Kp、Ki、Kd,相对应的语言变量值也取NB、NM、NS、ZE、PS、PM、PB七个模糊值,并且可对应求出误差因子、误差变化率因子和输出比例因子;然后得出比例增益Δkp、积分增益Δki、微分增益Δkd的模糊规则表,其中Δ表示取微分;(2)模糊PID控制器Matlab中的设计基于以上模糊规则表的建立,然后在MATLAB中进行控制器设计,对输入输出结构、隶属度函数及规则库进行配置;该模糊控制器根据条件设置为两输入三输出结构,控制器输入为误差和误差变化率,输出为比例、积分和微分增益;根据经验设置输入输出的隶属度函数都为三角型函数,通过搭建PID控制器系统仿真得出的合理PID参数;于是,误差e范围和误差变化率ec范围便可相应设置;同时设定比例增益Δkp范围,微分增益Δkd和积分增益Δki范围;设置完隶属...
【专利技术属性】
技术研发人员:宋大雷,苏志强,韩雷,王向东,
申请(专利权)人:中国海洋大学,
类型:发明
国别省市:山东;37
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。