基于模糊PID的矢量推进穿戴式蛙人运载器设计及姿态控制研究

Research on Design and Attitude Control of Vector Propulsion Wearable Diver Propulsion Vehicle Based on Fuzzy PID

  • 摘要: 【目的】针对当前穿戴式蛙人运载器在与通用潜水装备的兼容性、可穿戴人机交互、数学模型建立、闭环姿态控制算法方面存在的缺口,开展矢量推进的穿戴方便、智能可控的穿戴式蛙人运载器整体设计、数学模型的建立和姿态控制研究。【方法】首先,对穿戴式蛙人运载器的结构和功能组成、矢量推进布局进行设计,建立蛙人与运载器整个系统的运动学和动力学模型,开展“四螺旋桨组合式”矢量推进器作用下的蛙人运载器推力建模分析、简化整个系统的动力学模型研究;然后,提出了一种基于模糊PID控制器的姿态控制方法,针对俯仰角度和偏航角度控制分别设计了对应的控制器,利用Simulink搭建整个系统的姿态控制仿真模型对数学模型和控制器进行仿真;最后,搭建穿戴式蛙人运载器原理样机开展水池姿态控制实验。【结果】仿真和水池实验结果表明,所提出的运动模型和姿态控制方法可以实现对蛙人穿戴运载器的整个系统的稳定姿态控制,设计的模糊PID控制器相比传统PID控制器具有更好的控制性能,解决传统PID控制器参数整定的问题。【结论】所设计的穿戴式蛙人运载器可兼容通用潜水装备,具备方便实用的人机交互功能,所提出的模型和控制方法可使蛙人穿戴运载器在水下实现稳定的姿态控制,从而满足蛙人在水下俯仰和偏航角度的大角度变化、高稳定控制等作业需求。

     

    Abstract: Objectives To address the current gaps in wearable diver propulsion vehicle (DPV) regarding compatibility with general diving equipment, wearable human-computer interaction, mathematical model establishment, and closed-loop attitude control algorithms, this study focuses on the overall design, mathematical model development, and attitude control research of a vector-propelled wearable DPV that is easy to wear and intelligently controllable.Methods Firstly, the structure, functional composition, and vector propulsion layout of the wearable DPV were designed. Kinematic and dynamic models of the integrated frogman-propulsion vehicle system were established, followed by thrust modeling analysis of the DPV under the "four-propeller combined" vector thruster and research on simplifying the system’s dynamic model. Secondly, an attitude control method based on a fuzzy PID controller was proposed, with corresponding controllers designed for pitch and yaw angle control respectively. Simulink was used to construct the system’s attitude control simulation model for simulating the mathematical models and controllers. Finally, a prototype of the wearable DPV was built, and pool-based attitude control experiments were conducted. Results Simulation and pool experiment results show that the proposed motion model and attitude control method can achieve stable attitude control of the entire frogman-worn carrier system. The designed fuzzy PID controller has better control performance than the traditional PID controller, and solves the parameter tuning problem of the latter. Conclusions The designed wearable DPV is compatible with general diving equipment and has convenient, practical human-computer interaction. The proposed model and control method enable it to achieve stable underwater attitude control, thus meeting the frogman’s operational needs for large-angle changes in pitch/yaw angles and high-stability control underwater.

     

/

返回文章
返回