基于模糊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.

     

/

返回文章
返回