Sliding Mode Controller Design Based on Quaternion Feedback for UVMS
-
摘要: 随着水下机器人-机械手系统(UVMS)向轻量化、敏捷化方向发展, 对高精度水下姿态控制的需求日益突出。传统方法多使用欧拉角表示姿态, 其在特殊姿态下求运动学逆解会产生奇异, 不能满足特殊姿态作业的要求。因此, 文中采用四元数表示水下机器人本体姿态, 建立基于四元数的运动学模型, 避免了欧拉角的万向锁问题。同时, 进一步构建了UVMS的动力学模型, 构造基于四元数误差的滑模面, 设计了位置、姿态滑模控制器, 并通过广义Lyapunov理论分析了系统的稳定性。为了实现更好的控制效果, 利用时间误差绝对值函数设计适应度函数, 采用遗传算法优化了控制器参数。仿真结果验证了控制器的有效性。
-
关键词:
- 水下机器人-机械手系统 /
- 四元数反馈 /
- 滑模控制 /
- 遗传算法 /
- 参数优化
Abstract: With the development of lightweight and agile undersea vehicle manipulator systems(UVMSs), the demand for high-precision underwater attitude control is becoming increasingly prominent. Euler angle is traditionally used to represent the attitude; however, an inverse kinematic solution under a special attitude results in a singularity when this representation is employed. As a result, the requirements of special operations cannot be fulfilled through this representation. In this study, therefore, the quaternion is used to represent the posture of the rigid body of an undersea vehicle, and a quaternion-based kinematics model is established to avoid the gimbal lock. Furthermore, a dynamic model for the UVMS, sliding mode surface based on quaternion error, and position and attitude sliding mode controller are established. The stability of the system is analyzed by the generalized Lyapunov theory. In order to achieve a better control effect, this study uses the function of integrate time absolute error(ITAE) to design the fitness function and uses the genetic algorithm(GA) to optimize the controller parameters. The simulation results verify the effectiveness of the controller. -
[1] Evans J, Redmond P, Plakas C, et al. Autonomous Dock-ing for Intervention-AUVs Using Sonar and Video-based real-time 3D Pose Estimation[C]//Oceans. San Diego, CA, USA: IEEE, 2003. [2] Marani G, Choi S K, Yuh J. Underwater Autonomous Manipulation for Intervention Missions AUVs[J]. Ocean Engineering, 2009, 36(1): 15-23. [3] Ribas D, Palomeras N, Ridao P, et al. Girona 500 AUV: From Survey to Intervention[J]. IEEE/ASME Transac-tions on Mechatronics, 2012, 17(1): 46-53. [4] Zereik, Bibuli E, Marco, et al. Challenges and Future Trends in Marine Robotics[J]. Annual Reviews in Control, 2018, 46: 350-368. [5] Antonelli G. Underwater Robots[M]. Berlin Heidelberg: Springer, 2014. [6] Dai Y, Yu S. Design of an Indirect Adaptive Controller for the Trajectory Tracking of UVMS[J]. Ocean Engineering, 2018, 151: 234-245. [7] Dai Y, Yu S, Yan, et al. An EKF-Based Fast Tube MPC Scheme for Moving Target Tracking of a Redundant Underwater Vehicle-Manipulator System[J]. IEEE/ASME Transactions on Mechatronics, 2020, 24(6): 2803-2814. [8] Dai Y, Yu S, Yan Y. An Adaptive EKF-FMPC for the Trajectory Tracking of UVMS[J]. IEEE Journal of Oceanic Engineering, 2019, 45(3): 1-15. [9] Ramezani-Al M R, Sereshki Z T. A Novel Adaptive Sliding Mode Controller Design for Tracking Problem of an AUV in the Horizontal Plane[J]. International Journal of Dynamics and Control, 2019, 7(2): 679-689. [10] Dai P, Lu W, Le K, et al. Sliding Mode Impedance Control for Contact Intervention of an I-AUV: Simulation and Experimental Validation[J]. Ocean Engineering, 2020, 196: 106855. [11] Fjellstad O E, Fossen T I. Position and Attitude Tracking of AUV’s: a Quaternion Feedback Approach[J]. IEEE Journal of Oceanic Engineering, 2002, 19(4): 512-518. [12] Antonelli G, Chiaverini S. Singularity-free Regulation of Underwater Vehicle-manipulator Systems[C]//Proceedings of the 1998 American Control Conference. ACC(IEEE Cat. No.98CH36207). Philadelphia, USA: IEEE, 1998, 1: 399-403. [13] Antonelli G, Chiaverini S, Sarkar N, et al. Adaptive Control of an Autonomous Underwater Vehicle: Experimental Results on ODIN[J]. IEEE Transactions on Control Systems Technology, 2001, 9(5): 756-765. [14] Arrichiello V, Bartolini G, Pisano A, et al. Attitude and Position Tracking of Autonomous 6 DOF Vehicles with Mono-directional Actuators[C]//2016 14th International Workshop on Variable Structure Systems(VSS). Nanjing, China: IEEE, 2016: 80-85. [15] Thor I F. Guidance and Control of Ocean Vehicles[M]. Chichester, UK: John Wiley & Sons, 1994. [16] 魏延辉. UVMS系统控制技术[M]. 哈尔滨: 哈尔滨工程大学出版社, 2017: 19-69. [17] 李小岗, 王红都, 黎明. 自主水下航行器机械臂系统非线性PD控制器设计[J]. 水下无人系统学报, 2020, 28(1): 24-32.Li Xiao-gang, Wang Hong-du, Li Ming. Nonlinear PD Controller Design for Autonomous Undersea Vehicle-Manipulator System[J]. Journal of Unmanned Undersea Systems, 2020, 28(1): 24-32.
点击查看大图
计量
- 文章访问数: 797
- HTML全文浏览量: 23
- PDF下载量: 61
- 被引次数: 0