[发明专利]不确定康复步行训练机器人的精确轨迹跟踪最优控制方法

说明书

技术领域：

本发明属于轮式康复机器人的控制领域，尤其是关于不确定康复步行训练机器人的精确轨迹跟踪最优控制方法。

背景技术：

康复步行训练机器人需要精确跟踪医生指定的训练轨迹，才能达到满意的康复效果。然而，由于康复者质量及系统偏心距带来的不确定性，严重影响轨迹跟踪精度，因此，研究提高轨迹跟踪精度并实现系统性能的最优控制方法具有重要意义。本发明将康复步行训练机器人系统的不确定性视为整体，通过构建一阶低通滤波器对其进行估计，从而无须知道系统不确定性的界限，避免了界限的不准确性对轨迹跟踪精度的影响。本发明在提高轨迹跟踪精度的同时，又能使系统性能达到最优，对于康复步行训练机器人高性能控制系统的设计具有重要参考价值。

发明内容：

发明目的：

为了解决上述问题，本发明提供了一种不确定康复步行训练机器人的精确轨迹跟踪最优控制方法。

技术方案：

本发明是通过以下技术方案来实现的：

一种不确定康复步行训练机器人的精确轨迹跟踪最优控制方法，其特征在于：建立不确定康复步行训练机器人系统的动力学模型，构造一阶低通滤波器对影响康复步行训练机器人轨迹跟踪精度的不确定性进行整体估计，基于精确反馈线性化方法设计控制器，建立系统的线性化模型；以轨迹跟踪误差、速度跟踪误差和能量二次型为基础，设计康复步行训练机器人系统的二次型性能指标，采用优化控制方法，实现康复步行训练机器人的精确轨迹跟踪并使性能指标最优；具体步骤如下：

1)建立不确定康复步行训练机器人系统的动力学模型，构造一阶低通滤波器对影响康复步行训练机器人轨迹跟踪精度的不确定性进行整体估计，基于精确反馈线性化方法设计控制器，建立系统的线性化模型；

2)以轨迹跟踪误差、速度跟踪误差和能量二次型为基础，设计康复步行训练机器人系统的二次型性能指标，采用优化控制方法，实现康复步行训练机器人的精确轨迹跟踪并使性能指标最优；

3)基于STM32系列单片机将输出高精度的PWM信号提供给电机驱动单元，使机器人实现对参考轨迹信号的精确跟踪。

步骤1)中，首先，建立系统的动力学模型：

其中M₀为包含机器人质量M、康复者质量m和转动惯量I₀的系数矩阵，r₀为系统偏心距，X为机器人的实际行走轨迹，B(θ)为机器人旋转角度构成的系数矩阵，u(t)表示机器人的控制输入力，θ表示水平轴和机器人中心与第一个轮子中心连线间的夹角。

因康复者质量m及偏心距r₀大大影响系统轨迹跟踪精度，将其视为系统的不确定性d；分解M₀为仅含机器人质量M和转动惯量I₀的确定系数矩阵M₁及含有r₀和m结合的不确定系数矩阵ΔM₁，建立不确定康复步行训练机器人系统的动力学模型：

其中

设计控制器其中构造一阶低通滤波器G(s)对不确定性d进行整体估计

其中τ为时间常数；为抵消不确定性d对系统跟踪精度的影响，设计于是得到

根据不确定康复机器人实际行走轨迹X和医生指定的训练轨迹X_d的跟踪误差e(t)，得到如下形式的误差状态模型：

建立系统的线性化模型为

其中

步骤2)中，基于误差状态模型，设计系统的二次型性能指标为：

基于最优控制理论得到控制率v(t)为：

v(t)＝-R^-1B^TPx(t)

其中R为正常数，且满足PA+A^TP-PBR^-1B^TP＝Q；

进一步，控制率

采用优化控制方法，使系统性能指标最优并完成精确轨迹跟踪控制，将v(t)代入u(t)和v_d(t)，得到不确定康复步行训练机器人系统的控制器为：

步骤3)中，以STM32系列单片机为主控制器，主控制器的输入接电机测速模块，输出接电机驱动模块，电机驱动电路与直流电机相连，电源系统给各个电气设备供电。