1.一种基于自适应阻抗的多移动机器人协同搬运控制方法,其特征在于,所述方法包括以下步骤:S100:建立移动机器人的动力学模型与物体的动力学模型,结合运动学约束,建立多移动机器人协同搬运的动态系统模型;
S200:利用多移动机器人之间的信息交互,设计两个有限时间全分布式观测器,分别估计参考点的实际位姿以及理想位姿及其前二阶微分,得到参考点的实际位姿的估计值、参考点的理想位姿及其前二阶微分的估计值;
S300:根据参考点的实际位姿的估计值、多移动机器人末端的实际位姿、协同搬运的闭链约束,得到参考点和移动机器人末端之间的位姿偏差的估计值,基于得到的位姿偏差的估计值和参考点的理想位姿及其前二阶微分的估计值,得到移动机器人关于参考点的抓取矩阵的估计值和移动机器人末端的理想位姿及它的前二阶微分;
S400:定义内力跟踪误差,结合移动机器人末端的实际位姿、内力跟踪误差以及获取的移动机器人末端的理想位姿建立基于虚拟能量罐的分布式自适应阻抗系统的动态模型,根据内力误差,移动机器人末端的位置跟踪误差以及能量罐的值在线更新阻抗系统的动态模型的刚度,并根据自适应阻抗系统的动态模型获得更新后的移动机器人末端的理想位姿、速度和加速度;
S500:根据更新后的移动机器人末端的理想位姿、速度与移动机器人末端实际的位置和速度,得到笛卡尔空间下移动机器人末端的位姿跟踪误差和速度跟踪误差,并结合更新后的移动机器人末端的理想速度和加速度,利用逆运动学得到移动机器人广义关节的理想速度和加速度,根据移动机器人广义关节的理想速度与当前关节速度,通过李雅普诺夫函数将动态系统模型引入力矩控制器,得到系统耦合动态项,设计基于积分有界函数的神经网络自适应更新律,自适应补偿力矩控制器中的系统耦合动态项,将控制信号发送到机器人执行机构,驱动移动机器人末端对更新后的理想轨迹的渐进跟踪,建立理想的自适应阻抗关系,实现对移动机器人末端的控制。
2.根据权利要求1所述的方法,其特征在于,S100包括:S110:考虑第i个移动机器人系统的机械臂带有其中,
考虑第i个移动平台的非完整约束为其中,
其中,
S120:考虑物体的动力学模型,其具体为:其中,
考虑物体的质量中心的速度
其中,
S130:考虑第i个移动机器人对应的负载分配系数其中,
3.根据权利要求2所述的方法,其特征在于,S200包括:S210:设计观测器估计参考点的实际位姿,定义其中,
其中,
其中,
S220:设计观测器估计参考点的理想位姿以及它的前二阶微分,定义参考点的理想轨迹为其中,
此外,
其中,
S230:定义观测误差
4.根据权利要求3所述的方法,其特征在于,S300包括:S310:考虑参考点实际位姿的估计值其中,
因为
S320:根据位置偏差的估计值其中,
其中,
其中,
S330:定义移动机器人末端的理想轨迹的估计误差为
5.根据权利要求4所述的方法,其特征在于,S400包括:S410:定义内力跟踪误差其中,
将自适应阻抗模型分解为多个一维的自适应阻抗系统,其中,每个移动机器人的一维的自适应阻抗系统的个数等于其控制输入的维数,第j个一维的自适应阻抗系统表示为:其中,
S420:考虑到对于阻抗系统大的刚度值有助于减小阻抗系统的跟踪误差,由内力跟踪误差,位置跟踪误差以及虚拟能量罐的值决定阻抗系统刚度的增长率,具体为:其中,
其中,
S430:设计虚拟能量罐的动态,其具体为:其中,
S440:为证明与虚拟能量罐互联的自适应阻抗系统满足无源性,对于整个多机器人协同搬运的自适应阻抗系统,考虑如下李雅普诺夫函数:将S410中的自适应阻抗模型的动态代入可知,当
对于整个多机器人协同搬运的自适应阻抗系统,输入-输出对S450:考虑渐近实现理想的自适应阻抗模型,需要阻抗误差为实现该目标,设计更新后的移动机器人末端的参考轨迹将上式代入阻抗误差
由此可知,当
6.根据权利要求5所述的方法,其特征在于,S500包括:S510:定义跟踪误差
其中,
对上式求导,可得到
为实现控制目标,移动机器人理想的关节速度可设计如下:其中,
S520:定义移动机器人的关节空间速度跟踪误差其中,
结合神经网络,设计如下渐近跟踪自适应控制器:其中,
其中,
S530:定义估计误差
对
考虑;
其中,
此外,因为
根据芭芭拉引理,可得当时间S540:编写分布式控制程序,实现对移动机器人末端的控制。