欢迎来到知嘟嘟! 联系电话:13095918853 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13095918853
知嘟嘟经纪人
收藏
专利号: 2022104091540
申请人: 湖北工业大学
专利类型:发明专利
专利状态:已下证
专利领域: 手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手
更新日期:2024-01-05
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种基于自抗扰控制策略的上肢外骨骼系统协同随动控制方法,其特征在于,包括:步骤S1、在上肢外骨骼系统的人机交互点安装多维力传感器,检测操作者对多维力传感器的人机相互作用力,将上肢外骨骼系统与人的相互作用力表示为惯性、阻尼与刚度的线性组合:其中,Fhm为多维力传感器检测到的人机相互作用力,e是上肢外骨骼系统的期望位置和上肢外骨骼系统实际位置之间的差值,M为惯性系数,B为阻尼系数,K为刚度系数;

构成上肢外骨骼系统的阻抗控制模型,对阻抗控制模型建模,考虑上肢外骨骼系统中人机接口的柔性特征,采用弹簧模型进行阻抗控制模型建模,人机接口动力学表达式如下:Fhm=K(ph‑pm)

其中,K为刚度系数,ph为操作者手部的位置,即上肢外骨骼系统期望位置,pm为上肢外骨骼系统的末端位置,Fhm为多维力传感器检测到的人机相互作用力;

步骤S2、通过阻抗控制模型获取操作手末端的期望位置,由得到的期望位置计算出上肢外骨骼系统中肩关节的期望关节角度和肘关节的期望关节角度;

步骤S3、通过自抗扰控制器估计上肢外骨骼系统的状态和干扰,将估计的干扰作为上肢外骨骼系统的负反馈,通过自抗扰控制器将干扰消除;

所述自抗扰控制器包括跟踪微分器、扩张状态观测器、线性状态误差补偿和扰动补偿,获取操作者对多维力传感器的人机相互作用力,通过多维力传感器得到给定输入信号,通过跟踪微分器对给定输入信号的微分进行提取,确定适合上肢外骨骼系统中给定输入信号的过渡过程,使得上肢外骨骼系统跟踪过渡过程对应的输出信号;所述扩张状态观测器将上肢外骨骼系统的自身不确定性、外部及环境因素的干扰,转化成含有未知扰动的积分串联环节,将估计的干扰作为上肢外骨骼系统的负反馈,通过线性状态误差补偿和扰动补偿进行实时补充,消除干扰;

通过跟踪过渡过程对应的输出信号,在噪声较大的情况下,将给定输入信号v输入到跟踪微分器,得到平滑的输入信号:其中,v1,v2是输入信号的跟踪信号;k1,k2为跟踪信号系数;

上肢外骨骼系统设有二阶系统:

其中,x1、x2是上肢外骨骼系统的状态变量,y是上肢外骨骼系统的输出,u为上肢外骨骼系统的控制量,f(t)表示上肢外骨骼系统的不确定因素,b为控制量系数;

针对上肢外骨骼系统设计二阶线性的扩张状态观测器的形式如下;

其中,Z1,Z2是上肢外骨骼系统内部状态变量的实时估计值,Z3是上肢外骨骼系统不确定因素的实时估计值,参数β1、β2、β3是扩张状态观测器的系数,起到误差校正作用,b0为控制量系数;

采用误差反馈线性组合方式也能取得良好的控制效果,为了避免对给定输入信号进行微分且使闭环传递函数成为不包括零点的二阶传递函数,状态误差反馈律可采用PD参数形式:其中,e=v1‑z1为扩张状态观测器的观测误差,kp、kd是控制器增益,自抗扰控制是通过扩张状态观测器的观测量对控制信号进行扰动补偿,控制表达式为:其中,b0为控制量系数,u0上肢外骨骼系统的初值,u为上肢外骨骼系统的控制量,z3是上肢外骨骼系统不确定因素的实时估计值。

2.根据权利要求1所述的一种基于自抗扰控制策略的上肢外骨骼系统协同随动控制方法,其特征在于:所述步骤S2中,上肢外骨骼系统包括第一机械臂、第二机械臂、肩关节、肘关节和握把,第一机械臂一端与肩关节固定,另一端与和肘关节可转动的连接,第二机械臂一端与肘关节固定,另一端与握把固定,人机交互点设在握把上,操作者手部握住握把,通过上肢外骨骼系统的运动学方程建立上肢外骨骼系统期望位置与肩关节角度和肘关节角度的关系:T

ph=[lssin(qds)+lesin(qds+qde),‑lscos(qds)‑lecos(qds+qde),0]其中,ph为操作者手部的位置,即上肢外骨骼系统期望位置,qds为肩关节的期望关节角度,qde为肘关节的期望关节角度,ls为第一机械臂的长度,le为第二机械臂的长度。

3.根据权利要求1所述的基于自抗扰控制策略的上肢外骨骼系统协同随动控制方法,其特征在于:还包括驱动系统控制器,所述驱动系统控制器采用PID控制方法对驱动系统进行控制,驱动系统为驱动上肢外骨骼系统运动的系统,在PID控制方法中,设置比例单元P、积分单元I和微分单元D,并设置Kp、Ki和Kd实现上肢外骨骼系统的实际位置与上肢外骨骼系统的期望位置一致,通过PID控制方法获取输出驱动系统的电流:其中,U为输出到驱动系统的电流,e是上肢外骨骼系统的期望位置和上肢外骨骼系统实际位置之间的差值,t为时间,Kp、Ki、Kd分别是比例单元、积分单元和微分单元的增益;

上肢外骨骼系统的期望位置和上肢外骨骼系统实际位置之间的差值的计算公式为:e(t)=q(t)‑qd(t)

其中,qd是上肢外骨骼系统期望关节角度,q为上肢外骨骼系统实际关节角度;

获取驱动系统的输出力矩T,驱动上肢外骨骼系统运动,动力学方程可表示为:其中,Ts是肩关节的输出力矩,Te是肘关节的输出力矩,M,C,G分别是上肢外骨骼系统的惯性矩阵,向心力矩阵,重力矩阵。

4.根据权利要求1所述的基于自抗扰控制策略的上肢外骨骼系统协同随动控制方法,其特征在于:所述上肢外骨骼系统是一个多输入多输出系统,因此上肢外骨骼系统表达式可表示为:其中,Ts是肩关节的输出力矩,Te是肘关节的输出力矩,是角速度, 肩关节的角速度,肘关节的角速度,Td是外部干扰,Tds是肩关节的外部干扰,Tde是肘关节的外部干扰,M、C和G是惯性系数、向心力矢量和重力矢量;

其中, 当惯性矩阵恒为正,可以得到以下方程:

‑1

其中,τ=M (q)T, f是系统的总干扰,包括系

统误差,外部干扰和耦合等不确定因素,fs是肩关节的的总干扰,fe是肘关节的的总干扰,λ为所有误差总和,ΔC为向心力矢量的误差量,ΔG为重力矢量的误差量,经过解耦后,上肢外骨骼系统构成的多输入多输出系统可以分解为两个通道的单输入单输出系统,使得自抗扰控制器分别控制肩关节和肘关节,上式可表示为:肩关节状态扩张状态观测器可表示为:

其中,z1,z2,z3是肩关节扩展状态观测器的输出,β11,β12,β13是肩关节的扩张状态观测器增益;

肘关节的扩张状态观测器可表示为:

其中,z4,z5,z6是肘关节扩展状态观测器的输出,β21,β22,β23是肘关节扩张状态观测器的增益;

设扩张状态观测器的极点在‑ω1,‑ω2,扩张状态观测器的极点可根据多项式进行配置:其中,ω1,ω2是肩关节扩张状态观测器的带宽和肘关节扩张状态观测器的带宽,扩张状态观测器增益可以表示为:β11=3ω1,

β21=3ω1,

肩关节的反馈控制器和肘关节的反馈控制器可表达为:

其中,e1,e2分别是肩关节的扩张状态观测误差和肘关节的扩张状态观测误差,k11,k12是肩关节的反馈控制器的增益,k21,k22是肘关节的反馈控制器的增益,的反馈控制器的增益为 k12=2ω1, k22=2ω2;

自抗扰控制策略可表达如下:

其中, 是上肢外骨骼系统估计的干扰,

5.根据权利要求1所述的基于自抗扰控制策略的上肢外骨骼系统协同随动控制方法,其特征在于:扩张状态观测器的带宽在所述扩张观测器的性能及所述扩张观测器对噪声的容纳程度之间取一个平衡值。

我要求购
我不想找了,帮我找吧
您有专利需要变现?
我要出售
智能匹配需求,快速出售