草庐IT

水下潜航器的建模与控制

(线性系统理论大作业)(待完成。。。)题目  水下潜器模型,可能是潜艇或者鱼雷等对象。一个主推进螺旋桨,前后两对水平陀翼,后面一对垂直陀翼。  潜器前进过程中,通过调节助推进螺旋桨推力,以及三对陀翼的角度变化,对潜器的五个自由度,X轴和Z轴方向的速度,以及垂直、滚动和俯仰方向角速度,进行控制,实现潜器的各种机动以及在运动过程中的姿态平稳。以大地坐标为静止坐标系,以潜器坐标为动坐标系,用动量定理以及动量矩定理可以得到潜器的动力学模型如下:MV˙+FI=FF+FG+FB+FCM\dot{V}+F_{I}=F_{F}+F_{G}+F_{B}+F_{C}MV˙+FI​=FF​+FG​+FB​+FC​公