[发明专利]一种基于观测器的非完整机器人速度信息的获取方法

说明书

本发明公开了一种基于观测器的非完整机器人速度信息的获取方法，信息获取过程分为以下几步：（1）对非完整机器人建立运动学模型；（2）在非完整机器人车身安装一台传感器，用于时时传输非完整机器人在运动过程中的位置；（3）设计有限时间观测器并将传感器时时采集到的位置数据传输到观测器控制算法模块中，使得非完整机器人实时获取自己的前进速度和角速度从而保证能够按照规定的路线运动。本发明的一种基于观测器的非完整机器人速度信息的获取方法，控制速度快、方法简单易操作、算法稳定，对硬件设备要求较低，运动鲁棒性高，实用性强，易于商业化。

技术领域

本发明涉及非完整机器人获取实时速度信息的技术领域，具体涉及一种基于观测器的非完整机器人速度信息的获取方法。

背景技术

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

解决非完整机器人在运动过程中速度信息不可测的问题是一项具有挑战性的任务，在控制领域引起了越来越多的关注。信息获取技术有其自身的复杂性，主要表现在：非完整机器人在运动的过程中随着运动规律的变化速度也将时刻变化。使用非完整机器人进行军事任务一直是最受关注的前沿课题之一。因为它在协作机器人侦察，多机器人形成和轨迹跟踪中有非常重要的应用。目前针对非完整机器人的控制算法大致有三种：(1)自适应控制，(2)鲁棒控制，(3)增益调节控制；但是这些算法计算复杂、计算量大、对系统的实时性要求高，这将增加算法实现成本，不利于实际应用。

因此，为解决上述问题，需要提出一种稳定性好、实时性强、成本低，利用实际应用的非完整机器人信息获取控制算法。

发明内容

本发明的目的是为了解决现有非完整机器人控制技术中的上述缺陷，提供一一种基于观测器的非完整机器人速度信息的获取方法，该算法稳定性好、实时性强、成本低、便于实际应用。

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

一种基于观测器的非完整机器人速度信息的获取方法，包括下列步骤：

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

公式(1)中，[x,y]^T∈R²代表非完整机器人在平面中的位置坐标，θ为非完整机器人前进的速度方向与X轴正向的夹角，v表示其前进直线速度，ω表示其自转的角速度；u₁为非完整机器人的线速度力矩输入量，u₂为非完整机器人的角速度力矩输入量，[d₁,d₂]∈R为非完整机器人在编队的过程中受到的不可测的外部干扰，并且[d₁,d₂]∈R满足公式(2)：

公式(2)中L₁和L₂为常数；

(2)、在非完整机器人上安装上用于传输位置信息的传感器；直角坐标系下非完整机器人前进速度、坐标状态、角速度、旋转角和外部扰动观测器误差模型由公式(3)给出：

公式(3)中e₁为非完整机器人旋转角观测器误差，e₂为角速度观测器误差，e₃为非完整机器人前进时的外部扰动观测器误差，e₄为坐标状态观测器误差，e₅为速度观测器误差，e₆为非完整机器人自转时的外部扰动观测器误差；

(3)、步骤(2)中的6个状态观测器由公式(4)分别给出：