[发明专利]一种带输入磁滞的机器人传输资源控制方法、系统及介质有效
申请号: | 202111370245.X | 申请日: | 2021-11-18 |
公开(公告)号: | CN114185268B | 公开(公告)日: | 2023-06-20 |
发明(设计)人: | 王建晖;王晨;李咏华;吴宇深;洪嘉纯;巩琪娟 | 申请(专利权)人: | 广州大学 |
主分类号: | G05B13/04 | 分类号: | G05B13/04 |
代理公司: | 广州嘉权专利商标事务所有限公司 44205 | 代理人: | 黎扬鹏 |
地址: | 510006 广东*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 输入 机器人 传输 资源 控制 方法 系统 介质 | ||
1.一种带输入磁滞的机器人传输资源控制方法,其特征在于,包括:
将输入磁滞模型化;
根据所述模型化后的输入磁滞模型,构建带输入磁滞的机器人系统模型;
根据所述带输入磁滞的机器人系统模型,确定控制机制;
根据所述控制机制的模糊逻辑,处理所述带输入磁滞的机器人系统模型中的模糊目标;
根据所述控制机制的触发机制,对所述带输入磁滞的机器人系统模型中的输入信号进行更新和/或对所述带输入磁滞的机器人系统模型中的输入磁滞进行补偿;
其中,所述将输入磁滞模型化,包括:
根据模型输入和模型输出的关联,将输入磁滞模型化,输入磁滞模型的表达式为:
其中,vc表示模型输出,表示模型输出的微分,uc表示模型输入,表示模型输入的微分,a、b和h是常数,且h0,hb;
根据所述输入磁滞模型,确定模型输出,所述模型输出的表达式为:
其中,表示输出配置函数,且为有界函数;vc(0)表示模型输出初始值;uc(0)表示模型输入初始值;表示模型输入uc的微分;e表示欧拉数,为数学常数;sign()表示符号函数;ξ表示积分变量;dξ表示积分变量的微分;
所述根据所述模型化后的输入磁滞模型,构建带输入磁滞的机器人系统模型,包括:
确定机器人系统模型,所述机器人系统模的型表达式为:
其中,t表示时刻,q(t)表示t时的机器人关节角,表示t时的机器人关节角速度,
表示t时的机器人关节角加速度,J表示转动惯量,B表示摩擦阻尼系数,M表示连杆质量,g表示重力加速度,l表示连杆长度,u(t)表示输入转矩;
根据输入磁滞模型,确定系统输入,所述系统输入的表达式为:
其中,t表示时刻,u(t)表示t时的系统输入,表示输出配置函数,且为有界函数;
根据所述机器人系统模型和所述系统输入,确定带输入磁滞的机器人系统模型,所述带输入磁滞的机器人系统模型的表达式为:
其中,x1=q(t),表示第一系统状态;表示第二系统状态;表示x1的导数;表示x2的导数;表示输出配置函数;表示系统模糊目标;g1(x1)表示第一外界干扰;g2(x1,x2)表示第二外界干扰;y表示系统输出;
所述根据所述带输入磁滞的机器人系统模型,确定控制机制,包括:
获取所述带输入磁滞的机器人系统模型的第一系统状态、第二系统状态和期望输出信号;
根据所述第一系统状态和所述期望输出信号,确定第一误差变量;
根据所述第一误差变量,确定第一虚拟控制律;
根据所述第二系统状态和所述第一虚拟控制律,确定第二误差变量;
根据所述第一误差变量和所述第二误差变量,结合模糊逻辑得到第一估计值;
根据所述第二误差变量和所述第一估计值,确定第二虚拟控制律;
根据所述第二虚拟控制律,确定控制矩阵;
根据所述第二误差变量和所述控制矩阵,确定第二估计值;
根据所述控制矩阵和所述第二估计值,确定控制律;
根据所述控制律,结合触发机制得到输入信号;
根据所述输入信号,确定实际输入;
将所述实际输入输入所述带输入磁滞的机器人系统模型,然后返回获取所述带输入磁滞的机器人系统模型的第一系统状态、第二系统状态和期望输出信号这一步骤;
所述根据所述控制机制的模糊逻辑,处理所述带输入磁滞的机器人系统模型中的模糊目标,包括:
确定未知组合函数,所述未知组合函数的表达式为:
其中,f表示未知组合函数,α1表示第一虚拟控制律,表示第一虚拟控制律α1的导数;
第一虚拟控制律α1的表达式为:
其中,c1为常数,且c10,z1是误差变量;
第二虚拟控制律α2的表达式如下:
其中,c2为常数,且c20,z2是误差变量,J表示转动惯量,表示第一估计值,ψ表示已知的模糊基函数,且ψ=[ψ1,ψ2,…,ψN]T∈RN,N为正整数,ψT表示ψ的转置,a是常数,yd表示期望输出信号;
控制律的表达式为:
其中,K表示模糊矩阵,且KT表示K的转置;H表示控制矩阵,H为1*2矩阵,且H=[α2,1]T,α2表示第二虚拟控制律;
由于K的值比较难获取,这里对K的真值进行估计,定义估计误差其中为第一估计值,进一步得到控制律的表达式为:
根据所述模糊逻辑,对所述未知组合函数进行逼近处理,逼近处理的未知组合函数的表达式为:
f=φTψ(X)+κ(X),
其中,κ(X)表示逼近误差,且||κ(X)||2τ,‖‖表示二范数,τ为常数,且τ0;φ表示理想权重向量,且φ=[φ1,φ2,…,φN]T∈RN,N为正整数;φT表示φ的转置;ψ(X)表示已知的模糊基函数,且ψ=[ψ1,ψ2,…,ψN]T∈RN,N为正整数;X表示模糊逻辑的输入向量,且X=[x1,x2,x3,x4]T,x1=q(t),x3=yd,表示期望输出信号yd的导数;
所述根据所述控制机制的触发机制,对所述带输入磁滞的机器人系统模型中的输入信号进行更新和/或对所述带输入磁滞的机器人系统模型中的输入磁滞进行补偿,包括:
确定触发机制模型,所述触发机制模型的表达式为:
其中,t表示时刻;w(t)表示t时刻的事件触发控制输入;δ、ρ、m1、和k均为常数,且0δ1,ρ0,m10,k∈Z+;表示控制律;uc(t)表示t时刻的模型输入信号;w(tk)表示tk时刻的事件触发控制输入;tk表示第k次事件触发的时刻,tk+1表示第k+1次事件触发的时刻;e(t)表示测量误差,且e(t)=w(t)-uc(t)。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于广州大学,未经广州大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111370245.X/1.html,转载请声明来源钻瓜专利网。