欢迎来到知嘟嘟! 联系电话:13095918853 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13095918853
知嘟嘟经纪人
收藏
专利号: 2021110412116
申请人: 中国地质大学(武汉)
专利类型:发明专利
专利状态:已下证
专利领域: 控制;调节
更新日期:2024-01-05
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种复杂约束下的移动机器人跟踪控制方法,其特征在于:包括以下步骤:步骤1、输入机器人的目标点,并设定机器人的初始状态,同时对机器人的每个部件进行受力分析,建立机器人的动力学模型,设置复杂约束机器人控制器;

步骤2、遥控控制机器人使用二维激光雷达扫描周围环境,通过SLAM算法创建环境地图;

步骤3、利用A‑star路径规划算法在所述环境地图中进行规划,并计算得到最优路径,从而获得机器人期望轨迹;

步骤4、通过激光雷达、编码器实时监测机器人的状态信息;

步骤5、设计复杂约束受限控制算法,根据机器人的实时状态信息,得到实际轨迹与期望轨迹的偏差,把此偏差输入到复杂约束机器人控制器,通过约束受限控制算法得到复杂约束虚拟控制律;

步骤6、同时将机器人的实时状态信息反馈给RBF自适应神经网络,RBF自适应神经网络算法通过逼近未知非线性项,来确定自适应虚拟控制律步骤7、将复杂约束虚拟控制律和自适应虚拟控制律进行结合,得到最终的实际控制律;

步骤8、实际控制律控制机器人的电机转速,来控制机器人持续平稳的运行;

步骤9:判断机器人是否到达目标点,如果到达目标点,机器人停止运行,如果没有到达目标点,重复步骤3至8,直至到达目标点。

2.如权利要求1所述的一种复杂约束下的移动机器人跟踪控制方法,其特征在于,步骤

1中所述的动力学模型设计如下:步骤1.1、所述动力学方程描述如下:T

其中,q=[x,y]表示位置向量,x和y分别表示机器人几何中心的横坐标和纵坐标。M(q)

2×2

∈R 表示正定惯性矩阵, 表示向心矩阵和科里奥利矩阵, 表示

2×2 2×1

地面摩擦,τd表示未知有界扰动,B(q)∈R 表示输入变换式矩阵,τ∈R 表示力矩的输入T 2×1

矢量,并且τ=[τr,τl],A(q)λ∈R 表示非完整约束力;

T

步骤1.2、确定所述动力学方程模型后,定义x1=q=[x,y] , 然后将所述动力学方程模型转换成下面形式:其中,x1为位置状态信息,x2为速度状态信息;

G(t)表示系统的集总不确定性。

3.如权利要求1所述的一种复杂约束下的移动机器人跟踪控制方法,其特征在于,步骤

3中所述的A‑star路径规划算法如下:f(n)=g(n)+h(n)其中g(n)表示从节点n到起始点的移动代价;f(n)表示第n个节点的综合优先级,算法根据节点的优先级大小选择下一个要遍历的节点;h(n)表示节点n到终点的期望代价;

所述A‑star路径规划算法完整步骤描述如下:步骤3.1、初始化开集和闭集;

步骤3.2、把初始点放入开集,并设优先级为最高;

步骤3.3、如果开集不为空,则从开集中选择优先级最高的节点作为节点n;

步骤3.3.1、如果节点n是目标节点,则完成路径规划,跟踪父节点n从终点到起点;

步骤3.3.2、如果节点n不是目标节点:将节点n从开集中移除,并置于闭集中;遍历节点n相邻的所有节点;

步骤3.3.2.1、如果n相邻的节点m在闭集中:跳过并检测下一个节点;

步骤3.3.2.2、如果n相邻的节点m既不在开集也不在闭集中,赋值n为m的父节点,计算m的优先级,将节点m加入开集;

步骤3.3.2.3、如果n相邻的节点m在开集中:计算比较综合优先级f(m)的值,如果f(m)是开集中的最小值,则该节点m为父节点;

步骤3.3.3、判断节点m是否为目标节点,如果节点m是目标节点,则完成路径规划,跟踪父节点m从终点到起点;如果节点m不是目标节点,重复步骤3.3.2~步骤3.3.2.3,直至到达目标节点。

4.如权利要求3所述的一种复杂约束下的移动机器人跟踪控制方法,其特征在于,所述期望代价公式如下:

其中nx,ny分别表示当前点的横纵坐标,中Px,Py分别表示目标点的横纵坐标。

5.如权利要求1所述的一种复杂约束下的移动机器人跟踪控制方法,其特征在于,在步骤5中,所述复杂约束受限控制算法的设计包括速度约束受限控制算法的设计和位置约束受限控制算法的设计:

步骤5.1、位置约束受限控制算法设计如下:采用backstepping的方法,基于对数函数 z1为位置偏差,然后选取满足约束条件的Lyapunov函数V1,V1>0, 为满足位置约束条件的Lyapunov函数,对所选取的Lyapunov函数求一阶导数,并化简得到 其中位置约束虚拟控制律 运用杨氏不等式使得 进而确定合适的位置约束虚拟控制律α1;其中a1>2k1H1,b1

步骤5.2、速度约束受限控制算法设计如下:采用backstepping的方法,基于对数函数 z2为速度偏差,然后选取满足约束条件的Lyapunov函数V2,V2>0, 为满足速度约束条件的Lyapunov函数,对所选取的Lyapunov函数求一阶导数,并化简得到 其中速度约束虚拟控制律 运用杨氏不等式使得 进而确定合适的速度虚拟控制律α2;其中a2>2k2H2,b2

步骤5.3、综合位置约束虚拟控制律和速度约束虚拟控制律,得到的动态复杂约束虚拟控制律α(t)。

6.如权利要求1所述的一种复杂约束下的移动机器人跟踪控制方法,其特征在于,在步骤6中所述RBF自适应神经网络是一种三层的神经网络,包括输入层、隐含层和输出层;输入层到隐含层的转换是非线性的,而隐含层到输出层的转换是线性的;

所述RBF自适应神经网络算法设计如下:T

利用所述RBF自适应神经网络θφ(z)+δz(z),去近似不确定量G(t),使得T

G(t)=θφ(z)+δz(z)T

上述等式成立时对应的θ,即为最合适的自适应虚拟控制律

7.如权利要求5所述的一种复杂约束下的移动机器人跟踪控制方法,其特征在于,所述RBF自适应神经网络算法通过对未知非线性项逼近,最终确定的自适应虚拟控制律为T l

其中 z2为速度偏差,a2、b2为常数,φ(Z)=[φ1(Z),...,φl(Z)]∈R是高斯函数,为虚拟控制律的导数。

8.如权利要求1所述的一种复杂约束下的移动机器人跟踪控制方法,其特征在于,步骤

7中所述实际控制律为:

2×1

其中M为正定惯性矩阵,τ∈R 表示力矩的输入矢量,对数函数 z2为速T l

度偏差,a2、b2、k为常数,为自适应虚拟控制律,φ(Z)=[φ1(Z),...,φl(Z)]∈R是高斯函数。