不确定康复步行训练机器人的精确轨迹跟踪最优控制方法技术

本发明专利技术公开一种不确定康复步行训练机器人的精确轨迹跟踪最优控制方法，建立不确定康复步行训练机器人系统的动力学模型，构造一阶低通滤波器对影响康复步行训练机器人轨迹跟踪精度的不确定性进行整体估计，基于精确反馈线性化方法设计控制器，建立系统的线性化模型；以轨迹跟踪误差、速度跟踪误差和能量二次型为基础，设计康复步行训练机器人系统的二次型性能指标，采用优化控制方法，实现康复步行训练机器人的精确轨迹跟踪并使性能指标最优；本发明专利技术将输出高精度的PWM信号提供给电机驱动单元，使机器人实现对参考轨迹信号的精确跟踪。该控制方法无须知道系统不确定性的界限，可以提高康复步行训练机器人轨迹跟踪精度并使系统性能达到最优。

【技术实现步骤摘要】
不确定康复步行训练机器人的精确轨迹跟踪最优控制方法
：本专利技术属于轮式康复机器人的控制领域，尤其是关于不确定康复步行训练机器人的精确轨迹跟踪最优控制方法。
技术介绍
：康复步行训练机器人需要精确跟踪医生指定的训练轨迹，才能达到满意的康复效果。然而，由于康复者质量及系统偏心距带来的不确定性，严重影响轨迹跟踪精度，因此，研究提高轨迹跟踪精度并实现系统性能的最优控制方法具有重要意义。本专利技术将康复步行训练机器人系统的不确定性视为整体，通过构建一阶低通滤波器对其进行估计，从而无须知道系统不确定性的界限，避免了界限的不准确性对轨迹跟踪精度的影响。本专利技术在提高轨迹跟踪精度的同时，又能使系统性能达到最优，对于康复步行训练机器人高性能控制系统的设计具有重要参考价值。
技术实现思路
：专利技术目的：为了解决上述问题，本专利技术提供了一种不确定康复步行训练机器人的精确轨迹跟踪最优控制方法。技术方案：本专利技术是通过以下技术方案来实现的：一种不确定康复步行训练机器人的精确轨迹跟踪最优控制方法，其特征在于：建立不确定康复步行训练机器人系统的动力学模型，构造一阶低通滤波器对影响康复步行训练机器人轨迹跟踪精度的不确定性进行整体估计，基于精确反馈线性化方法设计控制器，建立系统的线性化模型；以轨迹跟踪误差、速度跟踪误差和能量二次型为基础，设计康复步行训练机器人系统的二次型性能指标，采用优化控制方法，实现康复步行训练机器人的精确轨迹跟踪并使性能指标最优；具体步骤如下：1)建立不确定康复步行训练机器人系统的动力学模型，构造一阶低通滤波器对影响康复步行训练机器人轨迹跟踪精度的不确定性进行整体估计，基于精确反馈线性化方法设计控制器，建立系统的线性化模型；2)以轨迹跟踪误差、速度跟踪误差和能量二次型为基础，设计康复步行训练机器人系统的二次型性能指标，采用优化控制方法，实现康复步行训练机器人的精确轨迹跟踪并使性能指标最优；3)基于STM32系列单片机将输出高精度的PWM信号提供给电机驱动单元，使机器人实现对参考轨迹信号的精确跟踪。步骤1)中，首先，建立系统的动力学模型：其中M0为包含机器人质量M、康复者质量m和转动惯量I0的系数矩阵，r0为系统偏心距，X为机器人的实际行走轨迹，B(θ)为机器人旋转角度构成的系数矩阵，u(t)表示机器人的控制输入力，θ表示水平轴和机器人中心与第一个轮子中心连线间的夹角。因康复者质量m及偏心距r0大大影响系统轨迹跟踪精度，将其视为系统的不确定性d；分解M0为仅含机器人质量M和转动惯量I0的确定系数矩阵M1及含有r0和m结合的不确定系数矩阵ΔM1，建立不确定康复步行训练机器人系统的动力学模型：其中设计控制器其中构造一阶低通滤波器G(s)对不确定性d进行整体估计其中τ为时间常数；为抵消不确定性d对系统跟踪精度的影响，设计于是得到根据不确定康复机器人实际行走轨迹X和医生指定的训练轨迹Xd的跟踪误差e(t)，得到如下形式的误差状态模型：建立系统的线性化模型为其中步骤2)中，基于误差状态模型，设计系统的二次型性能指标为：基于最优控制理论得到控制率v(t)为：v(t)＝-R-1BTPx(t)其中R为正常数，且满足PA+ATP-PBR-1BTP＝Q；进一步，控制率采用优化控制方法，使系统性能指标最优并完成精确轨迹跟踪控制，将v(t)代入u(t)和vd(t)，得到不确定康复步行训练机器人系统的控制器为：步骤3)中，以STM32系列单片机为主控制器，主控制器的输入接电机测速模块，输出接电机驱动模块，电机驱动电路与直流电机相连，电源系统给各个电气设备供电。主控制器的控制方法为通过读取电机编码器的反馈信号与主控制器给定的控制命令信号Xd对比得出误差信号，根据误差信号，主控制器按照预定的控制算法计算出电机的控制量，送给电机驱动单元，电机转动带动轮子维持自身平衡及按指定方式运动。优点及效果：本专利技术是一种不确定康复步行训练机器人的精确轨迹跟踪最优控制方法，具有如下优点：本专利技术提供的控制方法无须知道系统不确定性的界限，可以提高康复步行训练机器人的轨迹跟踪精度并使系统性能达到最优。本专利技术通过构建一阶低通滤波器对系统的不确定性进行整体估计，设计方法简单且易于实现，增强了控制器处理系统不确定性的鲁棒能力，从而可实现康复步行训练机器人对指定轨迹的高精度跟踪。附图说明：图1为本专利技术控制器工作框图；图2为本专利技术的STM32F101单片机最小系统示意图；图3为本专利技术的主控制器外围扩展电路图；图4为本专利技术硬件总体原理电路图。具体实施方式：下面结合附图对本专利技术做进一步的说明，但本专利技术的保护范围不受实施例的限制。本专利技术是一种不确定康复步行训练机器人的精确轨迹跟踪最优控制方法，建立不确定康复步行训练机器人系统的动力学模型，构造一阶低通滤波器对影响康复步行训练机器人轨迹跟踪精度的不确定性进行整体估计，基于精确反馈线性化方法设计控制器，建立系统的线性化模型；以轨迹跟踪误差、速度跟踪误差和能量二次型为基础，设计康复步行训练机器人系统的二次型性能指标，采用优化控制方法，实现康复步行训练机器人的精确轨迹跟踪并使性能指标最优。具体步骤如下：1)建立不确定康复步行训练机器人系统的动力学模型，构造一阶低通滤波器对影响康复步行训练机器人轨迹跟踪精度的不确定性进行整体估计，基于精确反馈线性化方法设计控制器，建立系统的线性化模型；2)以轨迹跟踪误差、速度跟踪误差和能量二次型为基础，设计康复步行训练机器人系统的二次型性能指标，采用优化控制方法，实现康复步行训练机器人的精确轨迹跟踪并使系统性能指标最优；3)基于STM32系列单片机将输出高精度的PWM信号提供给电机驱动单元，使机器人实现对参考轨迹信号的精确跟踪。步骤1)中，基于康复步行训练机器人的特征，首先，建立系统的动力学模型，步骤如下：其中M0为包含机器人质量M、康复者质量m和转动惯量I0的系数矩阵，X为机器人的实际行走轨迹，B(θ)为机器人旋转角度构成的系数矩阵，u(t)表示机器人的控制输入力，θ表示水平轴和机器人中心与第一个轮子中心连线间的夹角。因康复者质量m及偏心距r0大大影响系统轨迹跟踪精度，将其视为系统的不确定性d。分解M0为仅含机器人质量M和转动惯量I0的确定系数矩阵M1及含有r0和m结合的不确定系数矩阵ΔM1，建立不确定康复步行训练机器人系统的动力学模型：其中基于不确定康复步行训练机器人系统的动力学模型，结合精确反馈线性化理论，设计控制器其中构造一阶低通滤波器G(s)对不确定性d进行整体估计其中τ为时间常数，G(s)能保证为抵消不确定性d对系统跟踪精度的影响，设计于是得到使系统实现精确轨迹跟踪的最优控制方法，根据不确定康复机器人实际行走轨迹X和医生指定的训练轨迹Xd的跟踪误差e(t)，将控制器u(t)代入动力学模型(2)，得到如下形式的误差状态模型：根据式(5)，建立系统的线性化模型为其中步骤2)以轨迹跟踪误差、速度跟踪误差和能量二次型为基础，建立不确定康复步行训练机器人系统的二次型性能指标，具体过程如下：基于误差状态模型，设计系统的二次型性能指标为：采用优化控制方法，使系统性能达到最优的情况下完成精确轨迹跟踪控制，基于最优控制理论得到控制率v(t)为v(t)＝-R-1BTPx(t)(8)；其中R为正常数，且满足PA+ATP-PB本文档来自技高网...

【技术保护点】
一种不确定康复步行训练机器人的精确轨迹跟踪最优控制方法，其特征在于：建立不确定康复步行训练机器人系统的动力学模型，构造一阶低通滤波器对影响康复步行训练机器人轨迹跟踪精度的不确定性进行整体估计，基于精确反馈线性化方法设计控制器，建立系统的线性化模型；以轨迹跟踪误差、速度跟踪误差和能量二次型为基础，设计康复步行训练机器人系统的二次型性能指标，采用优化控制方法，实现康复步行训练机器人的精确轨迹跟踪并使性能指标最优；具体步骤如下：1)建立不确定康复步行训练机器人系统的动力学模型，构造一阶低通滤波器对影响康复步行训练机器人轨迹跟踪精度的不确定性进行整体估计，基于精确反馈线性化方法设计控制器，建立系统的线性化模型；2)以轨迹跟踪误差、速度跟踪误差和能量二次型为基础，设计康复步行训练机器人系统的二次型性能指标，采用优化控制方法，实现康复步行训练机器人的精确轨迹跟踪并使性能指标最优；3)基于STM32系列单片机将输出高精度的PWM信号提供给电机驱动单元，使机器人实现对参考轨迹信号的精确跟踪。

【技术特征摘要】
2014.11.21 CN 20141068190831.一种不确定康复步行训练机器人的精确轨迹跟踪最优控制方法，其特征在于：建立不确定康复步行训练机器人系统的动力学模型，构造一阶低通滤波器对影响康复步行训练机器人轨迹跟踪精度的不确定性进行整体估计，基于精确反馈线性化方法设计控制器，建立系统的线性化模型；以轨迹跟踪误差、速度跟踪误差和能量二次型为基础，设计康复步行训练机器人系统的二次型性能指标，采用优化控制方法，实现康复步行训练机器人的精确轨迹跟踪并使性能指标最优；具体步骤如下：1)建立不确定康复步行训练机器人系统的动力学模型，构造一阶低通滤波器对影响康复步行训练机器人轨迹跟踪精度的不确定性进行整体估计，基于精确反馈线性化方法设计控制器，建立系统的线性化模型；2)以轨迹跟踪误差、速度跟踪误差和能量二次型为基础，设计康复步行训练机器人系统的二次型性能指标，采用优化控制方法，实现康复步行训练机器人的精确轨迹跟踪并使性能指标最优；3)基于STM32系列单片机将输出高精度的PWM信号提供给电机驱动单元，使机器人实现对参考轨迹信号的精确跟踪；步骤1)中，首先，建立系统的动力学模型：其中M0为包含机器人质量M、康复者质量m和转动惯量I0的系数矩阵，r0为系统偏心距，X为机器人的实际行走轨迹，B(θ)为机器人旋转角度构成的系数矩阵，u(t)表示机器人的控制输入力，θ表示水平轴和机器人中心与第一个轮子中心连线间的夹角；因康复者质量m及偏心距r0大大影响系统轨迹跟踪精度，将其视为系统的不确定性d；分解M0为仅含机器人质量M和转动惯量I0的确定系数矩阵M1及含有r0和m结合的不确定系数矩阵ΔM1，建立不确定康复步行训练机器人系统的动力学模型：其中2.根据权利要求1所述的不确定康复步行训练机器人的精确轨迹跟踪最优控制方法，其特征在于：设计控制器其中构造一阶低通滤波器G(s)对不确定性d进行整体估计

【专利技术属性】
技术研发人员：孙平，周小舟，薛伟霖，王洲洲，刘博，
申请(专利权)人：沈阳工业大学，
类型：发明
国别省市：辽宁;21