一种服务机器人有限时间适应结构变化的跟踪控制方法与流程

：
1.本发明涉及轮式服务机器人的控制领域，尤其是关于轮式坐垫服务机器人的控制方法。


背景技术：

2.随着人口老龄化加剧以及交通事故增多，导致下肢障碍者数量逐年增长，为了实现下肢残障者的日常自立生活，坐垫服务机器人得到广泛应用。然而，在实际应用中，残障者很难坐在机器人中心，导致使用者与坐垫服务机器人的重心无法重合，进而使人机系统产生结构上的变化，这一因素严重干扰了坐垫服务机器人对指定轨迹的跟踪，产生的过大跟踪误差可能使机器人发生碰撞危险，进而威胁使用者的安全。因此，研究如何抑制坐垫服务机器人系统的结构变化问题，对保证使用者的安全以及提高机器人的跟踪精度具有重要意义。
3.近年来，坐垫服务机器人轨迹跟踪控制已有许多研究成果，然而这些成果都无法解决人机系统结构变化的问题。如果坐垫机器人在运动过程中无法适应系统结构发生的变化，不仅会产生较大的跟踪误差，甚至影响系统的稳定性。到目前为止，还没有关于人机系统结构变化的估计方法，以及适应人机系统结构变化的有限时间稳定控制方法。本发明基于新视角提出了人机系统结构变化的估计模型，并研究了适应结构变化的有限时间稳定控制方法，对提高人机系统的跟踪性和安全性具有重要意义。


技术实现要素：

4.发明目的：
5.为了解决上述问题，本发明提供了一种坐垫服务机器人有限时间适应结构变化的跟踪控制方法，目的是解决人机系统的结构变化问题，保证有限时间内实现系统的稳定性。
6.技术方案：
7.本发明是通过以下技术方案来实现的：
8.一种服务机器人有限时间适应结构变化的跟踪控制方法，其特征在于：
9.1)基于坐垫服务机器人的动力学模型，拆分影响结构变化的物理量，构建结构变化的神经网络估计模型，建立坐垫服务机器人具有结构估计的动力学模型；
10.2)基于有限时间稳定理论设计跟踪控制器，抑制结构变化对系统跟踪精度的影响，实现系统在有限时间条件下的稳定性。
11.步骤如下：
12.步骤1)基于坐垫服务机器人的动力学模型，拆分影响结构变化的物理量，构建结构变化的动力学模型，其特征在于：系统的动力学模型描述如下
[0013][0014]
其中
[0015][0016][0017]
x(t)表示坐垫服务机器人的实际运动轨迹，u(t)表示机器人全向轮的控制输入力，m表示机器人的质量，m表示使用者的质量，i0表示转动惯量，m0,b(θ)为系数矩阵。θ表示水平轴和机器人中心与第一个轮子中心连线间的夹角，即θ＝θ1，由坐垫服务机器人结构可知，l表示系统重心到每个轮子中心的距离，r0表示中心到重心的距离(i＝1,2,3)。
[0018]
由式(1)可知r0影响机器人的结构变化，将r0从m0中分离，进而将m0表示为m0＝m1 δm1，其中m1由机器人质量、使用者质量及转动惯量组成，δm1表示结构变化的物理量，且
[0019][0020]
拆分动力学模型(1)中影响结构变化的物理量，建立刻画坐垫服务机器人具有结构变化的动力学模型如下
[0021][0022]
其中表示坐垫服务机器人结构变化的物理量，由坐垫服务机器人的特性可知，s(r0)具有结构变化和非线性特征，影响机器人的跟踪精度和安全性。
[0023]
步骤2)利用坐垫服务机器人具有结构变化的动力学模型(2)，通过神经网络模型估计s(r0)，进而建立具有估计人机系统结构变化的动力学模型。令x(t)表示坐垫服务机器人的实际行走轨迹，x
d
(t)表示指定的训练轨迹，设轨迹跟踪误差e1(t)和速度跟踪误差e2(t)分别为
[0024]
e1(t)＝x(t)
‑
x
d
(t)
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(3)
[0025][0026]
其中α表示待设计的参数，e1(t)＝[e
11
(t) e
12
(t) e
13
(t)]
t
分别表示x轴、y轴和旋转角方向的轨迹跟踪误差，e2(t)＝[e
21
(t) e
22
(t) e
23
(t)]
t
分别表示x轴、y轴和旋转角方向的速度跟踪误差。设计s(r0)的神经网络估计模型如下：
[0027][0028]
其中表示辅助变量，且z1(t)＝[z
11
(t),z
12
(t),z
13
(t)]
t
，z
1g
(t)(g＝1,2,3)分别表示x轴，y轴和旋转角方向的辅助变量。为的伪逆矩阵，k1＝diag(k
11
,k
12
,k
13
)表示参数矩阵。并且
[0029]
sig(ξ)
η
＝[|ξ1|
η
sgn(ξ1),...,|ξ
n
|
η
sgn(ξ
n
)]
t
，e＝[e1(t) e2(t)]
t
表示网络的输入向量，表示网络权值的估计值，并且σ(e)＝[σ1(e) σ2(e)...σ
n
(e)]
t
，σ
f
(e),(f＝1,2,...,n)表示高斯函数如下：
[0030][0031]
其中β
j
和σ
j
分别表示第f个节点函数的中心和基宽参数。设网络最优估计权值为δ*，对于给定的小正数ε0，设计估计误差如下：
[0032][0033]
定义表示权值估计误差，则有因此可得s(r0)的表达形式如下：
[0034][0035]
进而根据式(2)和式(8)，得到坐垫服务机器人具有结构变化估计的动力学模型如下：
[0036][0037]
步骤3)基于有限时间稳定理论设计跟踪控制器，抑制结构变化对系统跟踪精度的影响，使系统在有限时间内实现稳定，其特征在于：根据式(3)(4)(9)，得到跟踪误差系统如下：
[0038][0039]
由式(10)及辅助变量z1(t)可得跟踪误差系统为：
[0040][0041]
设计有限时间控制器及适应结构变化的网络估计权值如下：
[0042][0043]
其中为b(θ)的伪逆矩阵，k2＝diag(k
21
,k
22
,k
23
)和k3分别表示参数矩阵。
[0044]
建立李雅普诺夫函数如下：
[0045]
[0046]
沿误差系统(11)对式(13)求导得：
[0047][0048]
将有限时间控制器(12)带入式(14)，可得：
[0049][0050]
将带入式(15)，得
[0051][0052]
进一步，根据式(12)有：
[0053][0054][0055][0056]
这样由式(16)可以得到从而可知跟踪误差系统(11)有限时间稳定。其中间稳定。其中
[0057]
接下来，求解误差系统稳定的有限调整时间。设存在常数0≤k0≤1，则得到关于的如下不等式：
[0058][0059]
设有集合：
[0060][0061]
将式(18)带入式(17)，得到：
[0062][0063]
进一步根据式(18)得到有限调整时间为：
[0064][0065]
因此，坐垫服务机器人在有限时间内适应系统结构变化，稳定跟踪指定的运动轨迹。
[0066]
步骤4)根据权利要求1基于stm32g4系列单片机将输出pwm信号提供给电机驱动模块，使坐垫服务机器人实现对运动轨迹的有限时间稳定跟踪，其特征在于：以stm32g4系列单片机为主控制器，主控制器的输入接电机测速模块、输出接电机驱动模块；电机驱动模块与直流电机相连；电源系统给各个电气设备供电。主控制器控制方法为读取电机编码器的反馈信号与主控制器给定的控制命令信号x
d
(t)和计算得出误差信号。根据误差信号，主控制器按照预定的控制算法计算出电机的控制量，送给电机驱动模块，电机转动带动轮子维持自身平衡及按指定方式运动。
[0067]
优点及效果：
[0068]
本发明是一种坐垫服务机器人有限时间适应结构变化的跟踪控制方法，具有如下优点：
[0069]
本发明基于坐垫机器人的动力学模型，拆分影响结构变化的物理量，构建结构变化的神经网络估计模型，建立坐垫机器人具有结构估计的动力学模型；基于有限时间稳定理论设计跟踪控制器，抑制结构变化对系统跟踪精度的影响，使系统在有限时间内实现稳定，提高了人机系统跟踪精度，保障了训练者的安全。
附图说明：
[0070]
图1为本发明控制器工作框图；
[0071]
图2为本发明系统坐标图；
[0072]
图3为本发明stm32g4单片机最小系统；
[0073]
图4为本发明电源电路；
[0074]
图5为本发明电机驱动与测速模块电路；
[0075]
图6为本发明硬件总体原理电路。
具体实施方式：
[0076]
下面结合附图对本发明做进一步的说明，但本发明保护范围不受实施例的限制。
[0077]
本发明基于坐垫服务机器人的动力学模型，拆分影响结构变化的物理量，构建结构变化的神经网络估计模型，建立坐垫服务机器人具有结构估计的动力学模型；基于有限时间稳定理论设计跟踪控制器，抑制结构变化对系统跟踪精度的影响，使系统在有限时间
内实现稳定；
[0078]
一种服务机器人有限时间适应结构变化的跟踪控制方法，其特征在于：
[0079]
1)基于坐垫服务机器人的动力学模型，拆分影响结构变化的物理量，构建结构变化的神经网络估计模型，建立坐垫服务机器人具有结构估计的动力学模型；
[0080]
2)基于有限时间稳定理论设计跟踪控制器，抑制结构变化对系统跟踪精度的影响，实现系统在有限时间条件下的稳定性
[0081]
步骤如下：
[0082]
步骤1)基于坐垫服务机器人的动力学模型，拆分影响结构变化的物理量，构建结构变化的动力学模型，其特征在于：系统的动力学模型描述如下
[0083][0084]
其中
[0085][0086][0087]
x(t)表示坐垫服务机器人的实际运动轨迹，u(t)表示机器人全向轮的控制输入力，m表示机器人的质量，m表示使用者的质量，i0表示转动惯量，m0,b(θ)为系数矩阵。θ表示水平轴和机器人中心与第一个轮子中心连线间的夹角，即θ＝θ1，由坐垫服务机器人结构可知，l表示系统重心到每个轮子中心的距离，r0表示中心到重心的距离(i＝1,2,3)。
[0088]
由式(1)可知r0影响机器人的结构变化，将r0从m0中分离，进而将m0表示为m0＝m1 δm1，其中m1由机器人质量、使用者质量及转动惯量组成，δm1表示结构变化的物理量，且
[0089][0090]
拆分动力学模型(1)中影响结构变化的物理量，建立刻画坐垫服务机器人具有结构变化的动力学模型如下
[0091][0092]
其中表示坐垫服务机器人结构变化的物理量，由坐垫服务机器人的特性可知，s(r0)具有结构变化和非线性特征，影响机器人的跟踪精度和安全性。
[0093]
步骤2)利用坐垫服务机器人具有结构变化的动力学模型(2)，通过神经网络模型估计s(r0)，进而建立具有估计人机系统结构变化的动力学模型。令x(t)表示坐垫服务机器人的实际行走轨迹，x
d
(t)表示指定的训练轨迹，设轨迹跟踪误差e1(t)和速度跟踪误差e2(t)分别为
[0094]
e1(t)＝x(t)
‑
x
d
(t)
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(3)
[0095][0096]
其中α表示待设计的参数，e1(t)＝[e
11
(t) e
12
(t) e
13
(t)]
t
分别表示x轴、y轴和旋转角方向的轨迹跟踪误差，e2(t)＝[e
21
(t) e
22
(t) e
23
(t)]
t
分别表示x轴、y轴和旋转角方向的速度跟踪误差。设计s(r0)的神经网络估计模型如下：
[0097][0098]
其中表示辅助变量，且z1(t)＝[z
11
(t),z
12
(t),z
13
(t)]
t
，z
1g
(t)(g＝1,2,3)分别表示x轴，y轴和旋转角方向的辅助变量。为的伪逆矩阵，k1＝diag(k
11
,k
12
,k
13
)表示参数矩阵。并且
[0099]
sig(ξ)
η
＝[|ξ1|
η
sgn(ξ1),...,|ξ
n
|
η
sgn(ξ
n
)]
t
，
[0100]
e＝[e1(t) e2(t)]
t
表示网络的输入向量，表示网络权值的估计值，并且σ(e)＝[σ1(e) σ2(e)...σ
n
(e)]
t
，σ
f
(e),(f＝1,2,...,n)表示高斯函数如下：
[0101][0102]
其中β
j
和σ
j
分别表示第f个节点函数的中心和基宽参数。设网络最优估计权值为δ
*
，对于给定的小正数ε0，设计估计误差如下：
[0103][0104]
定义表示权值估计误差，则有因此可得s(r0)的表达形式如下：
[0105][0106]
进而根据式(2)和式(8)，得到坐垫服务机器人具有结构变化估计的动力学模型如下：
[0107][0108]
步骤3)基于有限时间稳定理论设计跟踪控制器，抑制结构变化对系统跟踪精度的影响，使系统在有限时间内实现稳定，其特征在于：根据式(3)(4)(9)，得到跟踪误差系统如下：
[0109][0110]
由式(10)及辅助变量z1(t)可得跟踪误差系统为：
[0111]
[0112]
设计有限时间控制器及适应结构变化的网络估计权值如下：
[0113][0114]
其中为b(θ)的伪逆矩阵，k2＝diag(k
21
,k
22
,k
23
)和k3分别表示参数矩阵。
[0115]
建立李雅普诺夫函数如下：
[0116][0117]
沿误差系统(11)对式(13)求导得：
[0118][0119]
将有限时间控制器(12)带入式(14)，可得：
[0120][0121]
将带入式(15)，得
[0122][0123]
进一步，根据式(12)有：
[0124][0125][0126][0127]
这样由式(16)可以得到从而可知跟踪误差系统(11)有限时间稳定。其中间稳定。其中
[0128]
接下来，求解误差系统稳定的有限调整时间。设存在常数0≤k0≤1，则得到关于的如下不等式：
[0129][0130]
设有集合：
[0131][0132]
将式(18)带入式(17)，得到：
[0133][0134]
进一步根据式(18)得到有限调整时间为：
[0135][0136]
因此，坐垫服务机器人在有限时间内适应系统结构变化，稳定跟踪指定的运动轨迹。
[0137]
步骤4)根据权利要求1基于stm32g4系列单片机将输出pwm信号提供给电机驱动模块，使坐垫服务机器人实现对运动轨迹的有限时间稳定跟踪，其特征在于：以stm32g4系列单片机为主控制器，主控制器的输入接电机测速模块、输出接电机驱动模块；电机驱动模块与直流电机相连；电源系统给各个电气设备供电。主控制器控制方法为读取电机编码器的反馈信号与主控制器给定的控制命令信号x
d
(t)和计算得出误差信号。根据误差信号，主控制器按照预定的控制算法计算出电机的控制量，送给电机驱动模块，电机转动带动轮子维持自身平衡及按指定方式运动。
[0138]
本发明解决了坐垫服务机器人有限时间适应结构变化的跟踪控制问题。利用坐垫服务机器人的动力学模型，拆分影响结构变化的物理量，构建结构变化的神经网络估计模型，建立坐垫服务机器人具有结构估计的动力学模型；基于有限时间稳定理论设计跟踪控制器，抑制结构变化对系统跟踪精度的影响，使系统在有限时间内实现稳定，提高了人机系统的跟踪精度，保障了使用者的安全。