1.基于SCN步行力估计的康复机器人各轴速度直接约束控制，其特征在于：基于康复机器人的动力学模型，通过分解广义输入力，建立具有训练者步行力的康复机器人动力学模型；基于SCN方法构建训练者步行力的网络估计模型，以运动轨迹和运动速度为网络输入，通过不断随机配置隐含层节点参数，获得训练者的步行力估计；设计各轴速度直接约束控制器，抑制训练者步行力对控制精度的影响，同时控制器直接约束康复机器人各轴的实际运动速度。步骤如下：

1)基于康复机器人的动力学模型，通过分解广义输入力，建立具有训练者步行力的康复机器人动力学模型；

2)基于SCN方法构建训练者步行力的网络估计模型，以运动轨迹和运动速度为网络输入，通过不断随机配置隐含层节点参数，获得训练者的步行力估计；

3)设计各轴速度直接约束控制器，抑制训练者步行力对控制精度的影响，同时控制器直接约束康复机器人各轴的实际运动速度。

2.根据权利要求1所述基于SCN步行力估计的康复机器人各轴速度直接约束控制，其特征在于基于康复机器人的动力学模型，通过分解广义输入力，建立具有训练者步行力的康复机器人动力学模型，系统的动力学模型描述如下其中

T

u(t)＝[f1 f2 f3 f4] ，T

X(t)＝[x(t) y(t) θ(t)]分别为康复机器人x轴、y轴、旋转角的实际运动轨迹，u(t)表示广义输入力，M表示康复机器人的质量，m表示康复者的质量，I0表示转动惯量，M0，K(θ)，B(θ)为系数矩阵；θ表示水平轴和机器人中心与第一个轮子中心连线间的夹角，即θ＝θ1，由康复步行机器人结构可知 θ3＝θ+π， li表示系统重心到每个轮子中心的距离，r0表示中心到重心的距离，φi表示x′轴和每个轮子对应的li之间的夹角，λi表示重心到每个轮子的距离，i＝1,2,3,4；将u(t)分解为待设计的跟踪控制力u0(t)和待观测的训练者步行力Δu0(t)，代入模型(1)可得令x1(t)＝X(t)， 可得到具有训练者步行力的康复机器人动力学模型

3.根据权利要求1所述基于SCN步行力估计的康复机器人各轴速度直接约束控制，其特征在于基于SCN方法构建训练者步行力的网络估计模型，以运动轨迹和速度为网络输入，通过不断随机配置隐含层节点参数，获得训练者步行力估计，以机器人运动轨迹和速度作为SCN的网络输入层，并通过权重ω和阈值b与隐含层连接，利用高斯函数得到隐含层输出G(x(t))。

其中

T

b＝[b1,b2,...,bL]，T

G(x(t))＝[g1(ω1x(t)+b1),...,gL(ωLx(t)+bL)]，gj(ωjx(t)+bj)为隐含层第j个节点的输出j＝(1,2,...,L)，ωh,j为输入层第h个输入连接隐含层第j个节点的权值，h＝(1,2,...,6)，bj为隐含层第j个节点的阈值。

然后，SCN隐含层通过权重 与输出层连接，得到训练者步行力估计的网络输出如下：

其中

为第j个隐含层节点连接第g个输出的权值g＝(1,2,3)。

进一步，根据隐含层节点数为L‑1时得到的训练者步行力估计误差随机配置第L个隐含层节点参数，并使其满足δL>0，δL表达形式如下：其中，参数0

4.根据权利要求1所述基于SCN步行力估计的康复机器人各轴速度直接约束控制，其特征在于设计各轴速度直接约束控制器，抑制训练者步行力对控制精度的影响，同时控制器T

直接约束康复机器人各轴的实际运动速度，设Xd(t)＝[xd(t) yd(t) θd(t)]为医生指定的运动轨迹，定义轨迹跟踪误差、速度跟踪误差、虚拟速度跟踪误差为：e(t)＝X(t)‑Xd(t)＝x1(t)‑Xd(t)     (6)z(t)＝x2(t)‑α        (8)T

其中e(t)＝[ex(t) ey(t) eθ(t)]分别为康复机器人x轴、y轴、旋转角方向的轨迹误差；

分别为康复机器人x轴、y轴、旋转角方向的实际速度误差；α＝T T

[αx(t) αy(t) αθ(t)] 为虚拟运动速度，z(t)＝[zx(t) zy(t) zθ(t)] 分别为康复机器人x轴、y轴、旋转角方向的虚拟速度误差。

由式(7)(8)可得

令 并结合式(3)可得

利用式(10)(11)可得x轴、y轴、旋转角各轴方向跟踪误差系统如下：设计机器人虚拟运动速度表达形式如下：其中参数c11>0，c12>0，c13>0。

设计各轴速度直接约束控制器为

其中 且φ＝φ1+φ2+φ3，参数c21>0，c22>0，c23>0，k11>0，k12>0，k13>0，k21>

0，k22>0，k23>0。

由控制器式(14)可知：

分别设计x轴、y轴、旋转角各轴方向的李雅普诺夫函数如下：沿跟踪误差系统对式(16)求导，并将(9)(12)代入可得将式(13)(15)代入式(17)可得由式(18)可得 则各轴跟踪误差系统(12)渐近稳定；且由李雅普诺夫函数式(16)可知， 进而得到各轴速度约束范围由此可知控制器(14)抑制了训练者的步行力且直接约束了各轴的运动速度。

5.根据权利要求1所述基于SCN步行力估计的康复机器人各轴速度直接约束控制，其特征在于基于STM32F411系列单片机将输出PWM信号提供给电机驱动模块，使康复步行机器人在速度约束下帮助训练者跟踪医生指定的运动轨迹，以STM32F411系列单片机为主控制器，主控制器的输入接电机测速模块、输出接电机驱动模块；电机驱动模块与直流电机相连；电源系统给各个电气设备供电。主控制器控制方法为读取电机编码器的反馈信号与主控制器给定的控制命令信号Xd(t)和 计算得出误差信号。根据误差信号，主控制器按照预定的控制算法计算出电机的控制量，送给电机驱动模块，电机转动带动轮子维持自身平衡及按指定方式运动。