CN113156819A - 协调打磨机械臂系统自适应神经网络同步阻抗控制方法 - Google Patents
协调打磨机械臂系统自适应神经网络同步阻抗控制方法 Download PDFInfo
- Publication number
- CN113156819A CN113156819A CN202110386032.XA CN202110386032A CN113156819A CN 113156819 A CN113156819 A CN 113156819A CN 202110386032 A CN202110386032 A CN 202110386032A CN 113156819 A CN113156819 A CN 113156819A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- representing
- grinding
- matrix
- formula
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
- Finish Polishing, Edge Sharpening, And Grinding By Specific Grinding Devices (AREA)
Abstract
本发明涉及协调机械臂打磨领域,具体涉及协调打磨机械臂系统自适应神经网络同步阻抗控制方法,该方法包含打磨轨迹环跟踪和打磨力环跟踪两个部分,在这两个环的方法设计中,分别设计了基于神经网络的不确定性补偿控制律,从而快速消除协调机械臂系统中的动力学不确定性和工件打磨系统中的不确定性,在双环中同时保证了协调打磨机械臂系统的协同高精度打磨轨迹和打磨力的跟踪效果,为协调机械臂打磨领域提供了一个精准稳定的控制方法。
Description
技术领域
本发明涉及协调机械臂打磨领域,具体涉及协调打磨机械臂系统自适应神经网络同步阻抗控制方法。
技术背景
随着工业机器人越来越多的被应用在工业生产领域,传统的单机械臂越来越不能满足复杂高精度的生产任务,多机械臂协调加工越来越多的被引入实际的生产加工中。以打磨加工场景为例,传统的单机械臂打磨多集中在工件固定、机械臂进行打磨的任务场景,这种加工模式在面对具有复杂工件表面时,由于自由度有限,打磨机械臂很难全面到达所需的加工位姿,需要在加工过程中人为进行打磨工件的位姿调整,降低了加工效率。而且,在流水线生产中,单机械臂加工过程中,由于工件多是固定不动的,这就在一定程度上影响了产线运行效率。协调机械臂的应用,由于协调系统具有更多的打磨自由度,因此可以在一次装夹后面对更为复杂工件表面,减少了人工干预。同时,协调打磨机械臂系统可以在打磨过程中同步进行打磨工件的搬运,提高了产线效率。
由于协调打磨机械臂系统面临着动力学参数不确定和加工环境不确定的因素,传统的位置跟踪和打磨力自适应跟踪算法多针对于单机械臂,难以适应协调机械臂之间的协同位置跟踪精度的要求。而且,传统的自适应阻抗方法由于很少考虑工件表面的复杂不确定环境,在打磨力跟踪速度和精度上都存在较大不足。神经网络在处理非线性不确定问题上具有很广泛的应用,可以快速补偿系统的不确定性误差。因此,针对协调机械臂设计考虑多机械臂系统之间的高精度自适应神经网络协同力位跟踪方法,对提高协调机械臂的打磨精度和稳定性具有重大意义。
发明内容
为了解决现有技术中存在的上述技术问题,本发明提供一种协调打磨机械臂系统自适应神经网络同步阻抗控制方法,研究协调机械臂打磨系统在加工过程中面对机械臂系统自身动力学参数不确定和工件环境不确定的情况下,通过设计基于自适应神经网络的阻抗控制器,来保证协调机械臂协同位置跟踪精度和打磨力跟踪精度,从而为协调机械臂打磨的相关研究提供理论支持,进而提高控制精度和稳定性,其具体技术方案如下:
协调打磨机械臂系统自适应神经网络同步阻抗控制方法,包括如下步骤:
S1.构建协调打磨机械臂系统的动力学模型,所述协调打磨机器人系统包含夹持机械臂系统和打磨机械臂系统;
S2.设计打磨机械臂系统和夹持机械臂系统之间的同步跟踪误差,并由此构建全局耦合滑模因子,进而构建基于笛卡尔任务空间的包含打磨机械臂系统和夹持机械臂系统动力学不确定性的闭环滑模耦合动力学模型,设计基于神经网络不确定性快速补偿的协调打磨机械臂系统驱动力矩表达式;
S3.构建包含打磨工件环境不确定性的闭环阻抗控制模型,通过引入神经网络对所述闭环阻抗控制模型进行补偿,得到新的误差补偿阻抗模型,后推导得到打磨机械臂系统阻抗修正模型。
进一步的,所述步骤S1具体包括:
所述协调打磨机械臂系统中第i个机械臂的动力学表达式为:
在所述夹持机械臂系统中,工件的动力学模型表达式为:
在公式(2)中,MO表示工件的惯量矩阵,DO表示工件的哥式力和离心力矩阵,GO表示工件的重力矩阵,FO表示工件所受的外力之和,xO表示工件在世界坐标系中的运动轨迹,表示工件的运动速度,表示工件的运动加速度;
所述夹持机械臂系统的动力学表达式为:
在公式(3)中,MΔG代表工件夹持机械臂系统的耦合惯量矩阵,DΔG代表哥式力和离心力矩阵,GΔG代表耦合重力矩阵,dΔG代表工件夹持机械臂系统的耦合摩擦干扰项,JO表示从工件中心到夹持机械臂基座标系的雅可比矩阵,JG表示从夹持机械臂末端夹具中心到夹持机械臂基座标系的雅可比矩阵,GGO表示从夹具中心到工件中心的广义位置转换矩阵,GMO表示从刀具和工件加工的接触点到工件中心的广义位置转换矩阵,FM表示加工刀具和被加工工件之间的打磨接触力;
在所述打磨机械臂系统中,打磨刀具模块的动力学模型为:
在公式(4)中,MT表示刀具的惯量矩阵,DT表示刀具的哥式力和离心力矩阵,GT表示刀具的重力矩阵,FT表示工件重心所受的合外力,xT表示刀具重心的运动轨迹,表示刀具重心的运动速度,表示刀具重心的加速度;
所述打磨机械臂系统的动力学表达式如下所示,
在公式(5)中,MΔT代表打磨机械臂系统的耦合惯量矩阵,DΔT代表哥式力和离心力矩阵,GΔT代表耦合重力矩阵,dΔT代表打磨机械臂系统的耦合摩擦干扰项,JM表示从刀具末端到打磨机械臂基座标系的雅可比矩阵,GMO表示从打磨点到工件重心的广义位置转换矩阵,AT和BT表示打磨刀具模块中关于速度和加速度的运动学转换矩阵。
进一步的,所述步骤S2包括:
S2.1.所述设计打磨机械臂系统和夹持机械臂系统之间的同步跟踪误差,并由此构建全局耦合滑模因子,具体为:
设计第i个机械臂系统的位置跟踪误差为eci,eci的表达式为:
设计机械臂系统之间的同步跟踪误差为esi,esi的表达式为:
esi=xi-xi+1 (7)
设计机械臂系统的耦合位置同步跟踪误差为epi,epi的表达式为:
epi=eci+γesi (8)
在公式(8)中,γ是调节机械臂系统自身位置跟踪误差和同步跟踪误差的同步因子;
设计第i个机械臂系统的耦合速度同步跟踪误差为evi,evi的表达式为:
si=ksepi+evi (10)
在公式(10)中,ks为正常量;
S2.2.所述构建基于笛卡尔任务空间的包含打磨机械臂系统和夹持机械臂系统动力学不确定性的闭环滑模耦合动力学模型,具体为:
所述打磨机械臂系统正向运动学表达式为:
在公式(11)中,代表打磨机械臂刀具末端在笛卡尔空间的速度,JT代表从打磨机械臂刀具末端到打磨机械臂基座标的雅可比矩阵,GET代表从打磨机械臂本体末端到打磨机械臂刀具末端的位置转换矩阵,将公式(11)代入公式(5)得到打磨机械臂系统在笛卡尔空间的耦合动力学表达式为:
在公式(12)中,MΔi代表笛卡尔空间打磨机械臂系统的广义惯量矩阵,DΔi代表打磨机械臂系统在笛卡尔空间的广义哥式力和离心力矩阵,GΔi代表广义重力矩阵,dΔi代表广义干扰和摩擦项;
将公式(10)代入公式(12),得到打磨机械臂系统闭环滑模耦合动力学模型:
S2.3.所述设计基于神经网络不确定性快速补偿的协调打磨机械臂系统驱动力矩表达式,具体为:
在公式(14)中,是Ηi通过神经网络获得的最优逼近项,神经网络的权重更新律,Φi(χi)是RBF神经网络的高斯基函数,χi是神经网络的输入矩阵,ci是高斯基函数的中心坐标,bi是高斯基函数的敏感度带宽,εi是神经网络的理想逼近误差;
结合公式(14),公式(13)中的打磨机械臂系统闭环滑模耦合动力学模型结合所述神经网络表示如下:
针对公式(14)中的神经网络逼近函数,设计新的加权平方同步神经网络更新律,表达式为:
公式(16)中,λi是一个正常量增益,k0是一个正常量增益;
结合公式(16),针对协调打磨机械臂系统的驱动力矩,设计一个新的自适应神经网络同步阻抗控制器ANSIC,如下所示,
在公式(17)中,k1,k2和k3是正常量增益,||*||代表*的二范数。
进一步的,所述步骤S3包括:
S3.1.所述构建包含打磨工件环境不确定性的闭环阻抗控制模型,具体为:
协调打磨机械臂系统中打磨刀具和打磨工件之间的阻抗模型为:
公式(18)中,MI是阻抗惯量矩阵,DI是阻抗阻尼矩阵,KI是阻抗刚度矩阵,xc是根据期望位置xd得到的修正期望位置,FM是实际的打磨力,Fd是期望的打磨力。设计修正误差为ei=xc-xd,打磨力跟踪误差为ΔF=FM-Fd,FM=Ke(xe-xc)=Ke(xe-xd)-Keei,Ke表示被打磨工件的刚度矩阵,xe是被打磨工件的实际表面位置,因此,将公式(18)重写为以下形式:
通过对公式(19)进行拉普拉斯变换,得到以下表达形式:
根据终值定理,打磨力在时域的稳态跟踪误差为:
在公式(23)中,Δxe代表工件表面的不确定位置,ΔDI表示不确定的阻尼参数,将公式(23)降维得到在单个加工方向的阻抗模型:
S3.2.所述通过引入神经网络对所述闭环阻抗控制模型进行补偿,得到新的误差补偿阻抗模型,后推导得到打磨机械臂系统阻抗修正模型,具体为:
在公式(30)中,σ是正常量增益,P是正定矩阵;结合以上公式推导得到基于阻抗参数不确定和工件环境不确定的打磨机械臂系统阻抗修正模型:
本发明的有益效果是:
1)在打磨轨迹跟踪环路中,应用RBF神经网络来估计协调系统的不精确动力学参数和外部干扰。与传统的神经网络更新律相比,该加权平方神经网络更新律可以有效地加快收敛速度,同时减少稳态误差。
2)将同步因子引入到全局耦合滑模误差设计中,以解决协调机械臂各系统之间的同步位置跟踪问题。通过调整同步因子,可以有效减小同步跟踪误差。
3)在打磨力跟踪环路中,本发明创造性地利用RBF神经网络估计项来重建新的阻抗控制模型,可以在不确定的表面形状和工件刚度下快速而准确地跟踪期望的打磨力;
因此,本发明方法为协调机械臂打磨领域提供了一个可以在复杂不确定环境下快速稳定跟踪打磨轨迹和打磨力的自适应神经网络阻抗控制方法,有利于提高生产效率。
附图说明
附图1是本发明的双机械臂协调打磨系统的应用场景示意图;
附图2是本发明的简化双机械臂协调打磨系统模型示意图;
附图3是本发明的打磨刀具和工件阻抗关系示意图;
附图4是在存在机械臂参数不确定和工件表面非线性位置变化情况下的仿真场景示意图;
附图5a是本发明的在打磨工件表面非线性变化下的X方向位置跟踪误差对比示意图;
附图5b是本发明的在打磨工件表面非线性变化下的Y方向位置跟踪误差对比示意图;
附图5c是本发明的在打磨工件表面非线性变化下的Z方向角度跟踪误差对比示意图;
附图5d是本发明的在打磨工件表面非线性变化下的Y方向打磨力跟踪误差对比示意图;
其中,1夹持机械臂,2被打磨工件—汽车尾翼,3打磨刀具模组,4打磨机械臂,5基座平台。
具体实施方式
为了使本发明的目的、技术方案和技术效果更加清楚明白,下面结合说明书附图和具体实施步骤来对本专利的技术方案作进一步详细的说明。
协调机械臂打磨系统自适应神经网络同步阻抗控制方法,包含如下步骤:
A.构建协调打磨系统的耦合动力学表达式,设计打磨机械臂系统和夹持机械臂系统之间的同步跟踪误差,并由此构建耦合滑模因子,进而构建包含打磨机械臂系统和夹持机械臂系统动力学不确定性的闭环误差表达式,设计基于神经网络不确定性快速补偿的机械臂驱动力矩表达式,保证协调打磨系统在不确定环境下的高稳定、高精度轨迹跟踪。
协调打磨系统中第i个机械臂的动力学表达式如下所示,
协调打磨系统中包含夹持机械臂系统和打磨机械臂系统。在夹持机械臂系统中,工件的动力学模型表达式如下所示,
在公式(2)中,MO表示工件的惯量矩阵,DO表示工件的哥式力和离心力矩阵,GO表示工件的重力矩阵,FO表示工件所受的外力之和,xO表示工件在世界坐标系中的运动轨迹,表示工件的运动速度,表示工件的运动加速度。
夹持机械臂系统的动力学表达式如下所示,
在公式(3)中,MΔG代表工件夹持机械臂系统的耦合惯量矩阵,DΔG代表哥式力和离心力矩阵,GΔG代表耦合重力矩阵,dΔG代表工件夹持机械臂系统的耦合摩擦干扰项,JO表示从工件中心到夹持机械臂基座标系的雅可比矩阵,JG表示从夹持机械臂末端夹具中心到夹持机械臂基座标系的雅可比矩阵,GGO表示从夹具中心到工件中心的广义位置转换矩阵,GMO表示从刀具和工件加工的接触点到工件中心的广义位置转换矩阵,FM表示加工刀具和被加工工件之间的打磨接触力。
在打磨机械臂系统中,打磨刀具模块的动力学模型如下所示,
在公式(4)中,MT表示刀具的惯量矩阵,DT表示刀具的哥式力和离心力矩阵,GT表示刀具的重力矩阵,FT表示工件重心所受的合外力,xT表示刀具重心的运动轨迹,表示刀具重心的运动速度,表示刀具重心的加速度。
打磨机械臂系统的动力学表达式如下所示,
在公式(5)中,MΔT代表打磨机械臂系统的耦合惯量矩阵,DΔT代表哥式力和离心力矩阵,GΔT代表耦合重力矩阵,dΔT代表打磨机械臂系统的耦合摩擦干扰项,JM表示从刀具末端到打磨机械臂基座标系的雅可比矩阵,GMO表示从打磨点到工件重心的广义位置转换矩阵,AT和BT表示打磨刀具模块中关于速度和加速度的运动学转换矩阵。
至此,协调打磨机器人系统的动力学模型构建已经完成。
接下来进行夹持机械臂系统和打磨机械臂系统的驱动力矩设计。首先,令表示为机械臂的期望位置,代表机械臂经过打磨阻抗控制模型确定的修正位置,xi代表第i个机械臂系统的实时位置,设计第i个机械臂系统的位置跟踪误差为eci,eci的表达式为:
设计机械臂系统之间的同步跟踪误差为esi,esi的表达式为:
esi=xi-xi+1 (7)
设计机械臂系统的耦合位置同步跟踪误差为epi,epi的表达式为:
epi=eci+γesi (8)
在公式(8)中,γ是调节机械臂系统自身位置跟踪误差和同步跟踪误差的同步因子。设计第i个机械臂系统的耦合速度同步跟踪误差为evi,evi的表达式如下所示,
si=ksepi+evi (10)
在公式(10)中,ks为正常量。
为构建基于笛卡尔任务空间的协调机械臂的耦合动力学模型,以打磨机械臂系统为例进行分析,打磨加工机械臂系统正向运动学表达式如下所示,
在公式(11)中,代表打磨机械臂刀具末端在笛卡尔空间的速度,JT代表从打磨机械臂刀具末端到打磨机械臂基座标的雅可比矩阵,GET代表从打磨机械臂本体末端到打磨机械臂刀具末端的位置转换矩阵。将公式(11)代入公式(5)可得打磨机械臂系统在笛卡尔空间的耦合动力学表达式为,
在公式(12)中,MΔi代表笛卡尔空间打磨机械臂系统的广义惯量矩阵,DΔi代表打磨机械臂系统在笛卡尔空间的广义哥式力和离心力矩阵,GΔi代表广义重力矩阵,dΔi代表广义干扰和摩擦项。
将公式(10)代入公式(12),可得打磨机械臂系统闭环滑模耦合动力学模型,如下所示,
在公式(14)中,是Ηi通过神经网络获得的最优逼近项,神经网络的权重更新律,Φi(χi)是RBF神经网络的高斯基函数,χi是神经网络的输入矩阵,ci是高斯基函数的中心坐标,bi是高斯基函数的敏感度带宽,εi是神经网络的理想逼近误差。
结合公式(14),公式(13)中的打磨机械臂系统闭环滑模耦合动力学模型可以结合神经网络表示如下,
针对公式(14)中的神经网络逼近函数,设计一个新的加权平方同步神经网络更新律,如下所示,
公式(16)中,λi是一个正常量增益,k0是一个正常量增益。
结合公式(16),针对打磨机械臂系统的驱动力矩,设计一个新的自适应神经网络同步阻抗控制器ANSIC,如下所示,
在公式(17)中,k1,k2和k3是正常量增益,||*||代表*的二范数。
B.将打磨工件的不确定性参数带入传统阻抗控制模型,构建包含打磨工件环境不确定性的闭环阻抗控制模型,通过设计神经网络对阻抗模型不确定进行补偿,进而保证在协调打磨机械臂系统中,打磨力跟踪误差在不确定工件环境下能够快速收敛。
协调打磨机械臂系统中打磨刀具和打磨工件之间的阻抗模型表示如下,
公式(18)中,MI是阻抗惯量矩阵,DI是阻抗阻尼矩阵,KI是阻抗刚度矩阵,xc是根据期望位置xd得到的修正期望位置,FM是实际的打磨力,Fd是期望的打磨力。设计修正误差为ei=xc-xd,打磨力跟踪误差为ΔF=FM-Fd,FM=Ke(xe-xc)=Ke(xe-xd)-Keei,Ke表示被打磨工件的刚度矩阵,xe是被打磨工件的实际表面位置,因此,将公式(18)重写为以下形式:
通过对公式(19)进行拉普拉斯变换,得到以下表达形式:
根据终值定理,打磨力在时域的稳态跟踪误差如下所示,
因此,如果要满足需要满足xd=xe-Fd/Ke或者KI=O这两个判定条件。但是,在世界的工作环境中,精确的位置信息和刚度信息不容易获得的,所以满足KI=O这个条件就可以保证在工件表面保持平面下的打磨力跟踪精度。
但是,当工件表面不是一个平面,而是出现线性或者非线性的表面位置变化的时候,由于不确定性的存在,就不能保证这些不确定性包括阻抗模型参数的不确定性,工件表面的不确定性等。结合KI=O,结合不确定性的新阻抗控制模型表示如下,
在公式(23)中,Δxe代表工件表面的不确定位置,ΔDI表示不确定的阻尼参数,将公式(23)降维得到在单个加工方向的阻抗模型,如下所示,
在公式(30)中,σ是正常量增益,P是正定矩阵,结合以上公式推导,可以得到基于阻抗参数不确定和工件环境不确定的打磨机械臂系统阻抗修正模型,如下所示,
实施例:
如图1所示,选取典型的双机械臂协调打磨的场景来进行技术方案的映射,协作打磨系统包括夹持机械臂1,被打磨工件—汽车尾翼2,打磨刀具模组3,打磨机械臂4,基座平台5。
如图2所示,夹持机械臂1和打磨机械臂4具有相同的物理参数,左边的机械臂A用来夹持被打磨工件,右边的打磨机械臂B携带打磨刀具在打磨工件上按照预设的轨迹进行打磨。
双机两机械臂的基座标原点在世界坐标系中的位置分别为和两机械臂连杆的转动惯量I1=I2=0.5kg·m2,I3=0.25kg·m2,两机械臂上三根连杆的质量为m1=m2=m3=1.5kg,连杆的长度为l1=l2=0.6m,l3=0.2m。被打磨工件的转动惯量是0.02kg·m2,工件的质量是0.1kg,工件重心到夹持机械臂夹具末端的距离是0.2m,加工刀具模组的重量是0.5kg。打磨机械臂系统刀具和夹持机械臂系统工件之间的阻抗关系如图3所示。
本发明的协调打磨机械臂系统自适应神经网络同步阻抗控制方法ANSIC的算法参数如下表所示:
为了验证本专利所提方法的有效性,设计在存在机械臂参数不确定和工件表面非线性位置变化情况下的仿真场景,仿真场景如图4所示。
将本发明所提的协调打磨机械臂系统自适应神经网络同步阻抗控制方法ANSIC和现有研究中的自适应神经网络跟踪控制器ANNFTIC和自适应双环阻抗学习控制器ATLPILC进行对比,对比结果如图5a-5d所示。
综合实验结果分析,本发明提出的协调打磨机械臂系统自适应神经网络同步阻抗控制方法ANSIC思路清晰,方案容易实施,模型参数比较准确,对协调打磨轨迹和打磨力的跟踪精度较高,收敛速度较快,具有较高的理论研究和应用价值。
Claims (4)
1.协调打磨机械臂系统自适应神经网络同步阻抗控制方法,其特征在于,包括如下步骤:
S1.构建协调打磨机械臂系统的动力学模型,所述协调打磨机器人系统包含夹持机械臂系统和打磨机械臂系统;
S2.设计打磨机械臂系统和夹持机械臂系统之间的同步跟踪误差,并由此构建全局耦合滑模因子,进而构建基于笛卡尔任务空间的包含打磨机械臂系统和夹持机械臂系统动力学不确定性的闭环滑模耦合动力学模型,设计基于神经网络不确定性快速补偿的协调打磨机械臂系统驱动力矩表达式;
S3.构建包含打磨工件环境不确定性的闭环阻抗控制模型,通过引入神经网络对所述闭环阻抗控制模型进行补偿,得到新的误差补偿阻抗模型,后推导得到打磨机械臂系统阻抗修正模型。
2.如权利要求1所述的协调打磨机械臂系统自适应神经网络同步阻抗控制方法,其特征在于,所述步骤S1具体包括:
所述协调打磨机械臂系统中第i个机械臂的动力学表达式为:
在所述夹持机械臂系统中,工件的动力学模型表达式为:
在公式(2)中,MO表示工件的惯量矩阵,DO表示工件的哥式力和离心力矩阵,GO表示工件的重力矩阵,FO表示工件所受的外力之和,xO表示工件在世界坐标系中的运动轨迹,表示工件的运动速度,表示工件的运动加速度;
所述夹持机械臂系统的动力学表达式为:
在公式(3)中,MΔG代表工件夹持机械臂系统的耦合惯量矩阵,DΔG代表哥式力和离心力矩阵,GΔG代表耦合重力矩阵,dΔG代表工件夹持机械臂系统的耦合摩擦干扰项,JO表示从工件中心到夹持机械臂基座标系的雅可比矩阵,JG表示从夹持机械臂末端夹具中心到夹持机械臂基座标系的雅可比矩阵,GGO表示从夹具中心到工件中心的广义位置转换矩阵,GMO表示从刀具和工件加工的接触点到工件中心的广义位置转换矩阵,FM表示加工刀具和被加工工件之间的打磨接触力;
在所述打磨机械臂系统中,打磨刀具模块的动力学模型为:
在公式(4)中,MT表示刀具的惯量矩阵,DT表示刀具的哥式力和离心力矩阵,GT表示刀具的重力矩阵,FT表示工件重心所受的合外力,xT表示刀具重心的运动轨迹,表示刀具重心的运动速度,表示刀具重心的加速度;
所述打磨机械臂系统的动力学表达式如下所示,
在公式(5)中,MΔT代表打磨机械臂系统的耦合惯量矩阵,DΔT代表哥式力和离心力矩阵,GΔT代表耦合重力矩阵,dΔT代表打磨机械臂系统的耦合摩擦干扰项,JM表示从刀具末端到打磨机械臂基座标系的雅可比矩阵,GMO表示从打磨点到工件重心的广义位置转换矩阵,AT和BT表示打磨刀具模块中关于速度和加速度的运动学转换矩阵。
3.如权利要求2所述的协调打磨机械臂系统自适应神经网络同步阻抗控制方法,其特征在于,所述步骤S2包括:
S2.1.所述设计打磨机械臂系统和夹持机械臂系统之间的同步跟踪误差,并由此构建全局耦合滑模因子,具体为:
设计第i个机械臂系统的位置跟踪误差为eci,eci的表达式为:
设计机械臂系统之间的同步跟踪误差为esi,esi的表达式为:
esi=xi-xi+1 (7)
设计机械臂系统的耦合位置同步跟踪误差为epi,epi的表达式为:
epi=eci+γesi (8)
在公式(8)中,γ是调节机械臂系统自身位置跟踪误差和同步跟踪误差的同步因子;
设计第i个机械臂系统的耦合速度同步跟踪误差为evi,evi的表达式为:
si=ksepi+evi (10)
在公式(10)中,ks为正常量;
S2.2.所述构建基于笛卡尔任务空间的包含打磨机械臂系统和夹持机械臂系统动力学不确定性的闭环滑模耦合动力学模型,具体为:
所述打磨机械臂系统正向运动学表达式为:
在公式(11)中,代表打磨机械臂刀具末端在笛卡尔空间的速度,JT代表从打磨机械臂刀具末端到打磨机械臂基座标的雅可比矩阵,GET代表从打磨机械臂本体末端到打磨机械臂刀具末端的位置转换矩阵,将公式(11)代入公式(5)得到打磨机械臂系统在笛卡尔空间的耦合动力学表达式为:
在公式(12)中,MΔi代表笛卡尔空间打磨机械臂系统的广义惯量矩阵,DΔi代表打磨机械臂系统在笛卡尔空间的广义哥式力和离心力矩阵,GΔi代表广义重力矩阵,dΔi代表广义干扰和摩擦项;
将公式(10)代入公式(12),得到打磨机械臂系统闭环滑模耦合动力学模型:
S2.3.所述设计基于神经网络不确定性快速补偿的协调打磨机械臂系统驱动力矩表达式,具体为:
在公式(14)中,是Ηi通过神经网络获得的最优逼近项,神经网络的权重更新律,Φi(χi)是RBF神经网络的高斯基函数,χi是神经网络的输入矩阵,ci是高斯基函数的中心坐标,bi是高斯基函数的敏感度带宽,εi是神经网络的理想逼近误差;
结合公式(14),公式(13)中的打磨机械臂系统闭环滑模耦合动力学模型结合所述神经网络表示如下:
针对公式(14)中的神经网络逼近函数,设计新的加权平方同步神经网络更新律,表达式为:
公式(16)中,λi是一个正常量增益,k0是一个正常量增益;
结合公式(16),针对协调打磨机械臂系统的驱动力矩,设计一个新的自适应神经网络同步阻抗控制器ANSIC,如下所示,
在公式(17)中,k1,k2和k3是正常量增益,||*||代表*的二范数。
4.如权利要求3所述的协调打磨机械臂系统自适应神经网络同步阻抗控制方法,其特征在于,所述步骤S3包括:
S3.1.所述构建包含打磨工件环境不确定性的闭环阻抗控制模型,具体为:
协调打磨机械臂系统中打磨刀具和打磨工件之间的阻抗模型为:
公式(18)中,MI是阻抗惯量矩阵,DI是阻抗阻尼矩阵,KI是阻抗刚度矩阵,xc是根据期望位置xd得到的修正期望位置,FM是实际的打磨力,Fd是期望的打磨力。设计修正误差为ei=xc-xd,打磨力跟踪误差为ΔF=FM-Fd,FM=Ke(xe-xc)=Ke(xe-xd)-Keei,Ke表示被打磨工件的刚度矩阵,xe是被打磨工件的实际表面位置,因此,将公式(18)重写为以下形式:
通过对公式(19)进行拉普拉斯变换,得到以下表达形式:
根据终值定理,打磨力在时域的稳态跟踪误差为:
在公式(23)中,Δxe代表工件表面的不确定位置,ΔDI表示不确定的阻尼参数,将公式(23)降维得到在单个加工方向的阻抗模型:
S3.2.所述通过引入神经网络对所述闭环阻抗控制模型进行补偿,得到新的误差补偿阻抗模型,后推导得到打磨机械臂系统阻抗修正模型,具体为:
在公式(30)中,σ是正常量增益,P是正定矩阵;结合以上公式推导得到基于阻抗参数不确定和工件环境不确定的打磨机械臂系统阻抗修正模型:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110386032.XA CN113156819B (zh) | 2021-04-09 | 2021-04-09 | 协调打磨机械臂系统自适应神经网络同步阻抗控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110386032.XA CN113156819B (zh) | 2021-04-09 | 2021-04-09 | 协调打磨机械臂系统自适应神经网络同步阻抗控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113156819A true CN113156819A (zh) | 2021-07-23 |
CN113156819B CN113156819B (zh) | 2022-06-24 |
Family
ID=76889781
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110386032.XA Active CN113156819B (zh) | 2021-04-09 | 2021-04-09 | 协调打磨机械臂系统自适应神经网络同步阻抗控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113156819B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113848729A (zh) * | 2021-10-19 | 2021-12-28 | 哈尔滨理工大学 | 一种基于流固耦合的船用鳍主动柔顺控制方法 |
CN113927592A (zh) * | 2021-08-24 | 2022-01-14 | 盐城工学院 | 一种基于自适应降阶滑模算法的机械臂力位混合控制方法 |
CN113977572A (zh) * | 2021-08-06 | 2022-01-28 | 华南理工大学 | 一种基于宽度径向基神经网络的机械臂阻抗学习控制方法 |
CN114102636A (zh) * | 2021-12-31 | 2022-03-01 | 华中科技大学 | 遥操作机器人的焊缝打磨控制系统及其设计方法和应用 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5049796A (en) * | 1989-05-17 | 1991-09-17 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Robust high-performance control for robotic manipulators |
US5550953A (en) * | 1994-04-20 | 1996-08-27 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | On-line method and apparatus for coordinated mobility and manipulation of mobile robots |
CN105911863A (zh) * | 2016-05-19 | 2016-08-31 | 杭州新松机器人自动化有限公司 | 多机器人协作夹持系统神经网络轨迹跟踪控制方法 |
CN109782601A (zh) * | 2019-01-31 | 2019-05-21 | 浙江大学 | 一种协调机械臂自适应神经网络同步鲁棒控制器设计方法 |
CN110908286A (zh) * | 2019-12-11 | 2020-03-24 | 浙江大学 | 不确定混沌系统间接自适应模糊最优同步控制器设计方法 |
CN110900604A (zh) * | 2019-12-02 | 2020-03-24 | 浙江大学 | 基于双机械臂协作打磨系统的动力学模型设计方法 |
CN110977988A (zh) * | 2019-12-27 | 2020-04-10 | 青岛大学 | 基于有限时间命令滤波的多关节机械臂阻抗控制方法 |
-
2021
- 2021-04-09 CN CN202110386032.XA patent/CN113156819B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5049796A (en) * | 1989-05-17 | 1991-09-17 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Robust high-performance control for robotic manipulators |
US5550953A (en) * | 1994-04-20 | 1996-08-27 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | On-line method and apparatus for coordinated mobility and manipulation of mobile robots |
CN105911863A (zh) * | 2016-05-19 | 2016-08-31 | 杭州新松机器人自动化有限公司 | 多机器人协作夹持系统神经网络轨迹跟踪控制方法 |
CN109782601A (zh) * | 2019-01-31 | 2019-05-21 | 浙江大学 | 一种协调机械臂自适应神经网络同步鲁棒控制器设计方法 |
CN110900604A (zh) * | 2019-12-02 | 2020-03-24 | 浙江大学 | 基于双机械臂协作打磨系统的动力学模型设计方法 |
CN110908286A (zh) * | 2019-12-11 | 2020-03-24 | 浙江大学 | 不确定混沌系统间接自适应模糊最优同步控制器设计方法 |
CN110977988A (zh) * | 2019-12-27 | 2020-04-10 | 青岛大学 | 基于有限时间命令滤波的多关节机械臂阻抗控制方法 |
Non-Patent Citations (3)
Title |
---|
孟凡丰: "多机械臂系统的自适应神经网络同步控制", 《青岛大学学报(工程技术版)》 * |
张海运: "面向未知连续非线性系统的间接自适应模糊规划最优控制方法", 《 FRONTIERS OF INFORMATION TECHNOLOGY & ELECTRONIC ENGINEERING》 * |
张连滨: "改进型神经网络在木件打磨机器人中的应用", 《林业机械与木工设备》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113977572A (zh) * | 2021-08-06 | 2022-01-28 | 华南理工大学 | 一种基于宽度径向基神经网络的机械臂阻抗学习控制方法 |
CN113927592A (zh) * | 2021-08-24 | 2022-01-14 | 盐城工学院 | 一种基于自适应降阶滑模算法的机械臂力位混合控制方法 |
CN113848729A (zh) * | 2021-10-19 | 2021-12-28 | 哈尔滨理工大学 | 一种基于流固耦合的船用鳍主动柔顺控制方法 |
CN113848729B (zh) * | 2021-10-19 | 2022-06-21 | 哈尔滨理工大学 | 一种基于流固耦合的船用鳍主动柔顺控制方法 |
CN114102636A (zh) * | 2021-12-31 | 2022-03-01 | 华中科技大学 | 遥操作机器人的焊缝打磨控制系统及其设计方法和应用 |
CN114102636B (zh) * | 2021-12-31 | 2024-03-19 | 华中科技大学 | 遥操作机器人的焊缝打磨控制系统及其设计方法和应用 |
Also Published As
Publication number | Publication date |
---|---|
CN113156819B (zh) | 2022-06-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113156819B (zh) | 协调打磨机械臂系统自适应神经网络同步阻抗控制方法 | |
CN112372630B (zh) | 一种多机械臂协同打磨力柔顺控制方法和系统 | |
Tian et al. | Polishing pressure investigations of robot automatic polishing on curved surfaces | |
KR940003204B1 (ko) | 제어로봇 | |
CN109434829B (zh) | 一种立体石雕机器人加工系统的变形预测及补偿方法 | |
CN109782601B (zh) | 一种协调机械臂自适应神经网络同步鲁棒控制器设计方法 | |
CN110315396B (zh) | 一种基于大数据的工业机器人恒力磨抛方法 | |
Lakshminarayanan et al. | An adaptive framework for robotic polishing based on impedance control | |
JP2011235374A (ja) | ロボットの負荷推定装置及び負荷推定方法 | |
CN114454060B (zh) | 一种机器人自适应曲面跟踪恒力磨抛方法及系统 | |
Yang et al. | Contouring error control of the tool center point function for five-axis machine tools based on model predictive control | |
CN111975579A (zh) | 一种基于打磨模型和迭代算法的机器人恒力打磨系统 | |
CN112405536B (zh) | 结合离线补偿和在线跟踪混合策略的高精度恒力控制方法 | |
Zhang et al. | A hybrid passive/active force control scheme for robotic belt grinding system | |
JP2016002627A (ja) | 加工軌道生成装置と方法 | |
CN110900604A (zh) | 基于双机械臂协作打磨系统的动力学模型设计方法 | |
CN113110290B (zh) | 一种基于力反馈控制的大型薄壁零件镜像加工方法 | |
JP5765557B2 (ja) | 加工ロボットの軌道追従装置と方法 | |
JP6390832B2 (ja) | 加工軌道生成装置と方法 | |
CN117331309A (zh) | 一种基于超扭曲滑模自适应导纳控制的机器人抛光方法 | |
Park et al. | Gantry type lapping manipulator toward unmanned lapping process for a large work surface | |
Lee | Apply force/torque sensors to robotic applications | |
CN110900605A (zh) | 一种基于速度重配的协调机械臂多约束加工优化方法 | |
Subrin et al. | Digital chain development for sanding application with a kinematically redundant robotic system | |
CN112975960B (zh) | 一种机器人末端精细控制模型的建立与参数校准方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |