本发明专利技术提供了一种基于粒子群算法的力反馈设备动力学参数估计算法。具体为用一种改进的全面学习粒子群算法来更好的估计力反馈设备的动力学参数。主要包括以下步骤：步骤1，设定力反馈设备关节角理想运动轨迹；步骤2，对关节角理想运动轨迹进行位置跟踪；步骤3，对关节角运动轨迹和输入力矩采样；步骤4，利用ICLPSO算法估计力反馈设备参数。本发明专利技术通过使用四种策略：分层更新策略、位置学习策略、指导粒子学习策略、全局最优学习策略，有效地解决在传统PSO算法中存在的“两步向前，一步向后”问题以及早熟问题。与传统PSO算法对比，ICLPSO算法不仅收敛速度更快，而且获得的模型参数也更为精确，能够为各关节提供精确的力矩估计值，提升控制算法的性能。
【技术实现步骤摘要】
一种基于粒子群算法的力反馈设备动力学参数估计算法
本专利技术涉及力反馈设备参数的估计，具体为一种基于粒子群算法的力反馈设备动力学参数估计算法。
技术介绍
由于力触觉在人类感觉中具有显著的地位，研究者们尝试将力触觉特性引入遥操作机器人、虚拟现实等研究领域，为操作者在人机交互的过程中提供力触觉反馈信息。例如，核电站发生事故时，需要通过遥操作机器人完成检测、维修等任务，此时视频监控面临严重干扰，操作者借助力触觉反馈信息，可以有效提高操作的准确性、可靠性。在虚拟手术中，医生在虚拟人体上进行实时手术仿真训练，增加力触觉反馈信息，可以大幅提高培训效率，缩短培训周期，减轻一系列成本开销。另外，力触觉也常常应用在深海作业、医疗康复机器人、微创手术以及游戏和教育中，给操作者提供真实的力感和触感。而力触觉的实现依赖于力反馈设备，因此，力反馈设备的性能尤为重要。通常来说，力反馈设备的性能与两方面的因素有关。一方面与结构、减速器、传感器等硬件的选取有关，另一方面控制算法也是影响其性能的关键因素。通过控制算法可以消除力反馈设备中的自身惯量、摩擦力、重力等因素的影响，能够改进系统的透明性以及力反馈的逼真性。因此，对力反馈设备及其相关的控制算法进行研究是非常有意义的，是当前乃至今后一段时期内研究的热点。研究力反馈设备控制算法的基础前提是分析力反馈设备的运动学和动力学。其中，动力学模型的精确建立，对于设备保持高速、高精度的运行以及改进控制器性能等方面都起着重要的作用，同时也能够降低设计的成本、减少研究时间。建立力反馈设备的关节动力学模型，需要得到该设备的动力学参数以及摩擦力参数，即确定各个关节的关节质量、惯性张量、质心、库伦摩擦力以及粘滞摩擦力等参数。然而，通常情况下，力反馈设备参数是未知或不准确的，并且设备在长期的使用过程中，会受到磨损、形变以及环境等因素的影响，导致参数产生偏差。因此，需要对动力学参数进行估计。如果参数估计的越准确，动力学模型的精度就会越高，这也就能使各关节力矩的估计值越精确，为操纵者提供一个更精准的力反馈。获取力反馈设备参数的方法有：解体测量法，指通过将设备解体，然后测量设备的几何参数及其材料参数，然后得出其动力学参数的方法。该方法对设备关节质量、惯性张量、质心的获取是比较准确的。但操作复杂，可执行性低，并且参数值的结果容易受到设备的形状、材料等因素的影响，同时在解体过程中有可能会损伤或无法还原设备；CAD建模法，建立在计算机图形技术基础之上的，根据设备的结构图，利用相应的动力学模型，求解出设备的参数。能够便捷的获得独立的参数值，并且在设备的设计阶段就可以获得力反馈设备的参数值，然后根据参数值来计算机器人的动力学特性。但是该方法容易受到连杆材质不均匀等设备制造工艺的影响，使动力学参数存在一定的误差；估算方法，无论是解体测量法还是CAD建模法，除了存在上述问题外，都未考虑到设备在长期的使用过程中，会受到磨损、形变以及环境等因素的影响，导致模型参数产生偏差。Honegger等人提出一种利用非线性自适应控制算法(详见：Adaptivecontrolofthehexaglide,a6dofparallelmanipulator[C].ProceedingsofInternationalConferenceonRoboticsandAutomation.IEEE,1997,1:543-548.)对动力学参数进行在线辨识，但是该方法无法保证参数收敛。由于粒子群算法具有简单易行、快速收敛的优点，HosseinJahandideh等人利用粒子群算法(详见：UseofPSOinParameterEstimationofRobotDynamics；PartOne:NoNeedforParameterization[C].InternationalConferenceonSystemTheory.IEEE,2012.)对动力学参数进行估计，在该方法中，粒子各维度分别代表动力学模型的实际参数或者组合参数，根据假设的动力学模型，以力矩误差作为目标函数，对参数进行估计，相比于其它估计算法，PSO算法估计参数具有收敛速度快的特点。但估计的力矩误差较大，参数估计的效果较差，更容易陷入局部最优。
技术实现思路
基于上述背景，本专利技术提供了一种基于粒子群算法的力反馈设备动力学参数估计算法。具体为用一种改进的全面学习粒子群(ImprovedComprehensiveLearningParticleSwarmOptimization,ICLPSO)算法来更好的估计力反馈设备的动力学参数。本专利技术是通过以下技术方案实现的。本专利技术所述的一种基于粒子群算法的力反馈设备动力学参数估计算法，按以下步骤：通用力反馈设备的动力学方程具体如下：其中，θ为关节角；为关节角速度；为关节角加速度；D为力反馈设备的惯性矩阵；C为离心力和科里奥利力矩阵；G为重力矩阵；Fc为库伦摩擦系数矩阵；Fv为黏滞摩擦系数矩阵；τ为关节力矩；ΔX为考虑建模不确定性而引入的补偿项。需要估计的参数除了参数X外，还有补偿参数ΔX，如下所示：X＝[l1,l2,l3,ma,Iaxx,Iayy,Iazz,mbe,Ibexx,Ibeyy,Ibezz,mc,Icxx,Icyy,l5,mdf,mdfIdfxx,Idfyy,Idfzz,l6,Idf,Fc1,Fc2,Fc3,Fv1,Fv2,Fv3]ΔX＝[a1,b1,a2,b2,a3,b3]步骤1：设定力反馈设备关节角理想运动轨迹；力反馈设备具有N个可旋转的关节J1、J2…JN，对应的N个关节角为θ1、θ2…θN。设定N个关节角的理想运动轨迹分别为：角度θ1(t)、θ2(t)…θN(t),角速度角加速度步骤2：对关节角理想运动轨迹进行位置跟踪；使用PID控制算法，控制力反馈设备的N个关节对理想轨迹进行位置跟踪，得到N个关节的输入力矩τ1、τ2…τN和角度θ1(t)、θ2(t)…θN(t)。利用非线性跟踪—微分器得到各关节的角速度和角加速度步骤3：对关节角运动轨迹和输入力矩采样；对运动轨迹：关节角度θ1(t)、θ2(t)…θN(t),关节角速度关节角加速度以及输入的关节力矩τ1、τ2…τN进行采样，其中T为采样时间，P为采样点数。得到采样轨迹：关节角度关节角速度和关节角加速度及力矩步骤4：用改进的全面学习粒子群(ICLPSO)算法估计力反馈设备参数。(a)：将估计的参数及关节角运动轨迹代入动力学方程中，计算得到估计的关节力矩，第i个关节、第p次采样的力矩计算公式如下：上式中，为第i个关节、第p次采样得到的关节角度；为第i个关节、第p次采样得到的关节角速度；为第i个关节、第p次采样得到的关节角加速度(b)：定义误差矩阵为计算测量的关节力矩τ与估计的关节力矩之间的误差得到误差矩阵E为：定义目标函数：f＝||E||2(c)：设置ICLPSO算法的参数。粒子维度D；粒子的个数N；最大迭代次数m本文档来自技高网...
【技术保护点】
1.一种基于粒子群算法的力反馈设备动力学参数估计算法，其特征是按以下步骤：/n通用力反馈设备的动力学方程具体如下：/n
【技术特征摘要】
1.一种基于粒子群算法的力反馈设备动力学参数估计算法，其特征是按以下步骤：
通用力反馈设备的动力学方程具体如下：
其中，θ为关节角；为关节角速度；为关节角加速度；D为力反馈设备的惯性矩阵；C为离心力和科里奥利力矩阵；G为重力矩阵；Fc为库伦摩擦系数矩阵；Fv为黏滞摩擦系数矩阵；τ为关节力矩；ΔX为考虑建模不确定性而引入的补偿项；
需要估计的参数除了参数X外，还有补偿参数ΔX，如下所示：
X＝[l1，l2，l3，ma，Iaxx，Iayy，Iazz，mbe，Ibexx，Ibeyy，Ibezz，mc，Icxx，Icyy，l5，mdf，mdfIdfxx，Idfyy，Idfzz，l6，Idf，Fc1，Fc2，Fc3，Fv1，Fv2，Fv3]
ΔX＝[a1，b1，a2，b2，a3，b3]
步骤1：设定力反馈设备关节角理想运动轨迹；
力反馈设备具有N个可旋转的关节J1、J2…JN，对应的N个关节角为θ1、θ2…θN；设定N个关节角的理想运动轨迹分别为：角度θ1(t)、θ2(t)…θN(t)，角速度角加速度
步骤2：对关节角理想运动轨迹进行位置跟踪；
使用PID控制算法，控制力反馈设备的N个关节对理想轨迹进行位置跟踪，得到N个关节的输入力矩τ1、τ2…τN和角度θ1(t)、θ2(t)…θN(t)，利用非线性跟踪-微分器得到各关节的角速度和角加速度
步骤3：对关节角运动轨迹和输入力矩采样；
对运动轨迹：关节角度θ1(t)、θ2(t)…θN(t)，关节角速度关节角加速度以及输入的关节力矩τ1、τ2…τN进行采样，其中T为采样时间，P为采样点数；得到采样轨迹：关节角度关节角速度和关节角加速度及力矩
步骤4：用改进的全面学习粒子群(ICLPSO)算法估计力反馈设备参数；
(a)：将估计的参数及关节角运动轨迹代入动力学方程中，计算得到估计的关节力矩，第i个关节、第p次采样的力矩计算公式如下：
上式中，为第i个关节、第p次采样得到的关节角度；为第i个关节、第p次采样得到的关节角速度；为第i个关节、第p次采样得到的关节角加速度；
(b)：定义误差矩阵为计算测量的关节力矩τ与估计...
【专利技术属性】
技术研发人员：李春泉，何永华，杨峰，
申请(专利权)人：南昌大学，
类型：发明
国别省市：江西;36
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。