[发明专利]一种基于滑模观测器的非完整机器人去抖控制方法

说明书

本发明公开了一种基于滑模观测器的非完整机器人去抖控制方法，去抖控制过程分为以下几步：（1）对非完整机器人编队任务建立动力学模型；（2）在非完整机器人车身安装一台传感器，用于时时传输非完整机器人在控制的过程中的位置以及速度；（3）设计滑模观测器并将传感器时时采集到的位置数据和速度数据传输到去抖控制算法模块中，使得非完整机器人时时调整自己的运动从而保证能够按照规定的路线运动。本发明的一种基于滑模观测器的非完整机器人去抖控制方法纯几何运算、简单易懂、算法稳定，对硬件设备要求较低，运动稳定，实用性强，易于商业化。

技术领域

本发明涉及非完整机器人去抖控制技术领域，具体涉及一种基于滑模观测器的非完整机器人去抖控制方法。

背景技术

目前非完整机器人的应用几乎渗透各行各业。非完整机器人具有自量轻、承载大、驱动和控制相对方便、行走速度快、工作效率高等优点，从而从各类机器人中脱颖而出。

利用非完整机器人解决其在运动过程中受到的外部扰动问题是一项具有挑战性的任务，在控制领域引起了越来越多的关注。去抖技术有其自身的复杂性，主要表现在：外部扰动往往是未知的，非完整机器人自我调整姿态有时间延迟。使用非完整机器人进行编队任务一直是最受关注的前沿课题之一。因为它在协作机器人侦察，多机器人形成和轨迹跟踪中有非常重要的应用。目前针对非完整机器人的控制算法大致有三种：(1)自适应控制，(2)鲁棒控制，(3)增益调节控制；但是这些算法计算复杂、计算量大、对系统的实时性要求高，这将增加算法实现成本，不利于实际应用。

因此，为解决上述问题，需要提出一种计算量小、实时性好、成本低，利用实际应用的非完整机器人去抖控制算法。

发明内容

本发明的目的是为了解决现有非完整机器人控制技术中的上述缺陷，提供一一种基于滑模观测器的非完整机器人去抖控制方法，该算法计算量小、实时性好，实现成本低、便于实际应用。

本发明通过采取如下技术方案得到：

一种基于滑模观测器的非完整机器人去抖控制方法，包括下列步骤：

(1)、利用直角坐标系来刻画多个非完整机器人在平面中的编队运动；非完整机器人的带有未知外部扰动的动力学模型由公式(1)得到：

公式(1)中，[x_i,y_i]^T∈R²代表第i个非完整机器人在平面中的位置坐标，θ_i为第i个非完整机器人前进的速度方向与X轴正向的夹角，v_i表示第i个非完整机器人前进直线速度，ω_i表示第i个非完整机器人自转的角速度；τ_i1表示第i个非完整机器人的线速度力矩输入量；τ_i2表示第i个非完整机器人的角速度力矩输入量，[l_i1，l_i2]∈R为第i个非完整机器人在编队的过程中受到的不可测的外部干扰；

(2)、在非完整机器人上安装上用于传输位置信息和速度信息的传感器；直角坐标系下非完整机器人编队理想状态模型由公式(2)给出：

公式(2)中，d_i(t)是非完整机器人与编队旋转中心的实时距离；d_ρ是非完整机器人与编队旋转中心的理想距离；是非完整机器人绕旋转中心旋转的实时转速；是非完整机器人绕旋转中心旋转的理想转速；ψ_i(t)-ψ_j(t)是第i个非完整机器人与第j个非完整机器人绕旋转中心的角度偏差；γ_ij是第i个非完整机器人与第j个非完整机器人绕旋转中心的理想角度偏差；

(3)、针对步骤(1)在整个非完整机器人编队运动前首先利用滑模扰动观测器的控制方法估计未知外部扰动，设计外部扰动观测器滑模面：