本发明涉及一种基于自适应在线学习的上肢康复机器人控制方法,应用于上肢康复人机协同运动控制领域。
背景技术:
随着机器人技术的迅速发展,机器人的应用领域已经从传统的工业领域向日常生活中渗透,其中上肢康复机器人更是目前的一个研究热点。上肢康复是一种可穿戴的人机一体化机械装置,该装置可以重建或者增强穿戴者的上肢运动能力,在医疗康复、人机协同工作或军事救灾等领域具有广泛的应用前景。为了实现上肢康复的助力功能,要求上肢康复需要严格跟踪穿戴者的上肢运动轨迹,同时上肢康复机器人和穿戴者上肢之间的交互力保持最小,甚至是不存在。若上肢康复机器人的跟踪性能较差,会导致人机的交互力变大,影响穿戴者的运动,甚至危及穿戴者的安全。
上肢康复机器人系统是一个强耦合、高度非线性的系统,在实际系统中难以建立精确的数学模型。自适应在线学习控制是一种在线修正的控制方法,它能够根据期望的性能指标和实际的性能指标之间的差值来修正控制律或者控制参数,使系统能够保持最优或者次最优的工作状态,因此自适应在线学习控制非常适应于解决这类人机协同的运动问题。利用自适应控制的在线学习能力,在线估计上肢康复机器人的未知模型参数,及时修正控制器的控制参数,实现控制器的实时优化,有助于提高系统的稳定性和鲁棒性。
技术实现要素:
本发明的目的在于克服已有技术存在的不足,提供一种基于自适应在线学习的上肢康复机器人控制方法,通过自适应在线学习控制逼近上肢康复机器人的模型,建立实时更新的上肢康复机器人控制系统。
为达到上述目的,本发明采用如下技术方案:
一种基于自适应在线学习的上肢康复机器人控制方法,具体步骤如下:
1)利用拉格朗日动力学方程建立上肢康复机器人单臂系统的动力学模型;
2)基于自适应在线学习设计上肢康复机器人的控制系统模型;
3)在matlab/simulink中建立上肢康复机器人自适应在线学习的控制仿真模型;
4)通过仿真实验,分析在自适应在线学习控制方法下,上肢康复机器人的角度及角速度跟踪误差,以及误差收敛情况。
所述步骤1)的具体步骤如下:
针对上肢康复机器人的单臂(左臂或者右臂)模型,只考虑单臂的肩关节和肘关节,对模型进行简化,利用拉格朗日动力学方程建立上肢康复机器人的动力学模型如下:
其中:
其中p=[p1p2p3]t表示上肢康复机器人的模型参数向量,
所述步骤2)的具体步骤如下:
定义上肢康复机器人的关节角度误差函数e(t)如下:
e(t)=q(t)-qd(t)(5)
定义滑模函数s(t)如下:
给定滑模控制律如下:
其中qd(t)是上肢康复机器人关节角度的期望值,c>0是滑模系数,d>0是干扰的上界,k1,k2是增益矩阵,u是用于克服干扰的鲁棒项,
通过自适应控制器在线逼近上肢康复机器人的模型参数,滑模主控制器实时地进行更新;给定上肢康复机器人的期望关节角度qd(t),在滑模主控制器和自适应控制器的作用下,实现上肢康复机器人的实际关节运动角度q(t)对期望轨迹qd(t)的有效跟踪,并且具有较强的抗干扰能力;
所述步骤3)的具体步骤如下:
基于上述的自适应在线学习控制方法,在matlab/simulink中搭建上肢康复机器人单臂控制的仿真模型;该仿真模型包含五个主要模块,即输入模块、自适应控制器模块、滑模主控制器模块、上肢康复机器人模型模块和输出模块;其中,输入模块用于定义上肢康复机器人的期望关节角度qd(t),自适应控制器模块和滑模主控制器模块组成总控制器,用于控制上肢康复机器人对期望轨迹进行有效地跟踪,上肢康复机器人模型模块用于定义上肢康复机器人的动力学模型,输出模块用于输出上肢康复机器人的期望关节角度,输出自适应控制器对上肢康复机器人模型参数的逼近效果,输出上肢康复机器人的实际关节运动轨迹。
本发明与现有技术相比较,具有如下显而易见的突出特点和显著优点:
本发明在于解决上肢康复机器人的轨迹跟踪问题,采用自适应在线学习的方法,可以有效地解决上肢康复机器人控制模型不精确的问题,且控制器结构相对简单,比较容易实现。本发明在控制器中加入了鲁棒项,有助于提高上肢康复机器人的抗干扰能力,同时能够提高系统的稳定性。
附图说明
图1为本发明基于自适应在线学习的上肢康复机器人控制的仿真模型图;
图2为本发明实施例一的肩关节角度和角速度的跟踪轨迹;
图3为本发明实施例一的肘关节角度和角速度的跟踪轨迹;
图4为本发明实施例一的肩关节和肘关节的轨迹跟踪误差。
具体实施方式
本发明的优选实施例结合附图详述如下:
实施例一:
一种基于自适应在线学习的上肢康复机器人控制方法,具体步骤如下:
a.建立上肢康复机器人的模型:
针对上肢康复机器人的单臂(左臂或右臂)模型,只考虑单臂的肩关节和肘关节,对模型进行简化,利用拉格朗日动力学方程建立上肢康复机器人的动力学模型如下:
其中q=[q1q2]t,q1是上肢康复机器人肩关节的运动角度,q2是上肢康复机器人肘关节的运动角度。m1=1kg,m2=1.2kg,l1=0.3m,l2=0.35m,g=9.8m/s2。
b.自适应在线学习控制
基于自适应在线学习的上肢康复机器人控制器如下:
其中k1=diag[150150],k2=diag[150150],c=5,d=3,ε=0.01,γ=diag[555]。
c.上肢康复机器人matlab/simulink仿真模型
建立如图1所示的自适应在线学习的上肢康复机器人控制系统模型。该仿真模型包含五个主要模块,即输入模块1、自适应控制器模块4、滑模主控制器模块3、上肢康复机器人模型模块5和输出模块7;其中,输入模块1用于定义上肢康复机器人的期望关节角度qd(t),自适应控制器模块4和滑模主控制器模块5组成总控制器8,用于控制上肢康复机器人对期望轨迹2进行有效地跟踪,上肢康复机器人模型模块5用于定义上肢康复机器人的动力学模型,输出模块7用于输出上肢康复机器人的期望关节角度,输出自适应控制器对上肢康复机器人模型参数的逼近效果,输出上肢康复机器人的实际关节运动轨迹。
d.仿真结果分析
通过仿真结果可以得到上肢康复机器人肩关节和肘关节的角度和角速度的跟踪情况,以及误差的收敛情况。基于自适应在线学习的上肢康复机器人控制系统模型如图1所示,肩关节角度和角速度的轨迹跟踪情况如图2所示,肘关节角度和角速度的轨迹跟踪情况如图3所示,肩关节和肘关节的轨迹跟踪误差如图4所示。从图2和图3可以看出基于自适应在线学习的控制对期望关节轨迹(角度和角速度)具有良好的跟踪效果,从图4可以得出,对于给定的上肢康复机器人模型,在自适应在线学习控制器的作用下,肩关节和肘关节的角度跟踪误差和角速度跟踪误差都能够快速收敛到零,并且逐渐稳定在零的某一个很小的领域之内,即|e|≤δ1,
本实例基于自适应在线学习设计了上肢康复机器人单臂的控制方法,可以有效地解决了上肢康复机器人控制误差较大的问题,对提高上肢康复机器人的控制性能有重大的指导意义。
技术特征:
1.一种基于自适应在线学习的上肢康复机器人控制方法,其特征在于,具体步骤如下:
1)利用拉格朗日动力学方程建立上肢康复机器人单臂系统的动力学模型;
2)基于自适应在线学习设计上肢康复机器人的控制系统模型;
3)在matlab/simulink中建立上肢康复机器人自适应在线学习的控制仿真模型;
4)通过仿真实验,分析在自适应在线学习控制方法下,上肢康复机器人的角度及角速度跟踪误差,以及误差收敛情况。
2.根据权利要求1所述的基于自适应在线学习的上肢康复机器人控制方法,其特征在于,所述步骤1)的具体步骤如下:
针对上肢康复机器人的单臂模型,只考虑单臂的肩关节和肘关节,对模型进行简化,利用拉格朗日动力学方程建立上肢康复机器人的动力学模型如下:
其中:
其中p=[p1p2p3]t表示上肢康复机器人的模型参数向量,
3.根据权利要求1所述的基于自适应在线学习的上肢康复机器人控制方法,其特征在于,所述步骤2)的具体步骤如下:
定义上肢康复机器人的关节角度误差函数e(t)如下:
e(t)=q(t)-qd(t)(5)
定义滑模函数s(t)如下:
给定滑模控制律如下:
其中qd(t)是上肢康复机器人关节角度的期望值,c>0是滑模系数,d>0是干扰的上界,k1,k2是增益矩阵,u是用于克服干扰的鲁棒项,
通过自适应控制器在线逼近上肢康复机器人的模型参数,滑模主控制器实时地进行更新;给定上肢康复机器人的期望关节角度qd(t),在滑模主控制器和自适应控制器的作用下,实现上肢康复机器人的实际关节运动角度q(t)对期望轨迹qd(t)的有效跟踪,并且具有较强的抗干扰能力。
4.根据权利要求1所述的基于自适应在线学习的上肢康复机器人控制方法,其特征在于,所述步骤3)的具体步骤如下:
基于上述的自适应在线学习控制方法,在matlab/simulink中搭建上肢康复机器人单臂控制的仿真模型;该仿真模型包含五个主要模块,即输入模块、自适应控制器模块、滑模主控制器模块、上肢康复机器人模型模块和输出模块;其中,输入模块用于定义上肢康复机器人的期望关节角度qd(t),自适应控制器模块和滑模主控制器模块组成总控制器,用于控制上肢康复机器人对期望轨迹进行有效地跟踪,上肢康复机器人模型模块用于定义上肢康复机器人的动力学模型,输出模块用于输出上肢康复机器人的期望关节角度,输出自适应控制器对上肢康复机器人模型参数的逼近效果,输出上肢康复机器人的实际关节运动轨迹。
技术总结
本发明公开了一种基于自适应在线学习的上肢康复机器人控制方法,属于上肢康复机器人控制系统设计领域。本方法的操作步骤为:1)利用拉格朗日动力学方程建立上肢康复机器人单臂系统的动力学模型;2)基于自适应在线学习设计上肢康复机器人的控制系统模型;3)在MATLAB/Simulink中建立上肢康复机器人自适应在线学习的控制仿真模型;4)通过仿真实验,分析在自适应在线学习控制方法下,上肢康复机器人的角度及角速度跟踪误差,以及误差收敛情况。本发明方法具有创新性和仿真依据,可解决现有上肢康复机器人运动控制中误差较大及鲁棒性不足等缺陷,对上肢康复机器人控制系统的设计具有重大的指导意义。
技术研发人员:任彬;王耀
受保护的技术使用者:上海大学
技术研发日:.09.27
技术公布日:.01.10
如果觉得《基于自适应学习的上肢康复机器人控制方法与流程》对你有帮助,请点赞、收藏,并留下你的观点哦!