光学 精密工程, 2019, 27 (10): 2199, 网络出版: 2020-02-11
非线性反馈和二次型调节器在两栖机器人中的应用
Application of nonlinear feedback and quadratic regulators in amphibious robots
球形机器人 两栖 水下探测 非线性反馈 二次型调节器 spherical robot amphibious underwater detection nonlinear feedback quadratic regulator
摘要
球形两栖机器人具有对称的结构和多自由度的运动状态特性, 在环境适应性和运动稳定性上具有优势。本文介绍一种可以用于深海水下探测与救援的新型水陆两栖机器人控制系统的结构和建模方法, 根据机器人的运动控制模式, 推导出具有6个自由度的动态数学模型, 并在动态模型的基础上, 建立并评估了两种控制模型。第一种是基于二次型调节器(LQR)的控制器模型, 第二种是基于非线性状态反馈(FL)的控制器模型。最后对两种控制模型进行水下实验验证及评估, 从而证明两种控制器的有效性和优劣性。实验表明: 非线性状态反馈系统在响应时间(LQR=67.5 s, FL=46.5 s)方面都优于有限时域LQR控制器, 而LQR控制器在上升时间(LQR=24.5 s, FL=39.8 s)方面更加具有优势。
Abstract
Amphibious Spherical Robots (ASRs) possess high environmental adaptability and high motion stability owing to their symmetrical structural characteristics and multiple degrees of freedom in motion. This paper proposes a novel ASR control system that can be used in underwater detection and rescue and discusses its structure and modeling method. Depending on the motion control model of the robot, it can enable a dynamics system with 6 Ddegrees of Freedom (DOF). The mathematical model, based on the dynamic model, establishes and evaluates two versions of the control system. One is a controller model based on a Linear Quadratic Regulator (LQR) and the other is a motion equation of a control system based on nonlinear state Feedback Linearization (FL). Underwater control experiments were carried out on both control systems to prove their effectiveness and advantages. The experiments showed that the nonlinear state feedback system is superior to the finite time domain LQR controller in terms of corresponding durations of operation (LQR = 67.5 s, FL = 46.5 s) and fall times (LQR = 24.5 s, FL = 39.8 s).
郑亮, 朴燕, 马宇科. 非线性反馈和二次型调节器在两栖机器人中的应用[J]. 光学 精密工程, 2019, 27(10): 2199. ZHENG Liang, PIAO Yan, MA Yu-ke. Application of nonlinear feedback and quadratic regulators in amphibious robots[J]. Optics and Precision Engineering, 2019, 27(10): 2199.