一种力/位协调的多臂机器人柔顺控制方法技术

技术编号:19199572 阅读:75 留言:0更新日期:2018-10-20 01:34
本发明专利技术涉及一种力/位协调的多臂机器人柔顺控制方法,属于机器人控制领域。本发明专利技术在机械臂的大闭环周期中采用力同步协调控制方法,在小闭环周期中采用位姿同步协调控制的方法,从而实现多机械臂的力/位同步协调控制;通过采用力同步控制的思想,建立多机械臂之间的力同步控制器,保证了力协调的精确性;在机械臂控制的小闭环内采用位姿同步控制的思想,建立多机械臂之间的位姿同步控制器,提高了系统的响应频率,缩短了响应周期,提高了位姿协调控制精度,从而实现基于力/位协调的多机械臂柔顺控制方法。本发明专利技术在确定不同机械臂之间的力协调的同时,保证了位置的同步协调关系。

A force / position coordinated compliant control method for multi arm robots

The invention relates to a force/position coordinated compliance control method for a dobby robot, belonging to the field of robot control. The force synchronization coordination control method is adopted in the large closed-loop cycle of the manipulator, and the position and posture synchronization coordination control method is adopted in the small closed-loop cycle, thereby realizing the force/position synchronization coordination control of the multi-manipulator, and the force synchronization controller between the multi-manipulators is established by adopting the idea of force synchronization control to ensure the force coordination. In the small closed loop of manipulator control, the idea of position and attitude synchronization control is adopted, and the position and attitude synchronization controller between multiple manipulators is established, which improves the response frequency, shortens the response period, improves the precision of position and attitude coordination control, and realizes the compliance control method of multiple manipulators based on force/position coordination. The invention ensures the synchronous coordination relationship of the position while determining the force coordination between different manipulators.

【技术实现步骤摘要】
一种力/位协调的多臂机器人柔顺控制方法
本专利技术涉及机器人的控制,尤其涉及一种力/位协调的多臂机器人柔顺控制方法。
技术介绍
机器人在多机械臂力耦合情况下操作完成一个操作任务时,为了保证机械臂和操作物体的安全性,需要采用柔顺控制或者力控制的方式实现力协调,但是由于力闭环的响应周期较长,而实际上机械臂的内环大都采用位置控制的模式,因此,机械臂的响应时间会受到影响,因此,如果能够同时保证多机械臂协调操作过程中力的同步性,同时也保证位姿的同步性,这将会提高机械臂的协调操作能力。近年来,随着力控制的需求越来越大,机器人的操作任务需求也从单一的位置控制需求,逐渐发展为位置和力的同时需求的阶段。尤其是在多臂力耦合完成操作任务的情况下,多臂力/位协调控制变得更加重要。多臂力/位协调控制可以有效保证多机械臂力的协调关系和位,但是仅有力的协调关系,机械臂的位姿精度将无法保证,降低了多机械臂的协调控制性能。而机械臂保证力控制的有效方式是采用阻抗控制的方法,建立机械臂位姿与力之间关系的函数方程,从而实现力和位姿之间的动态协调平衡。单个机械臂中,阻抗方程的输出与输入关系只跟机械臂自身的位姿误差、力误差有关,当多机械臂协调时,为了保证系统的安全性,采用力同步的方式保证多机械臂的力协调关系,但是实际应用中,由于力传感器的物理响应和闭环周期都较慢,而机械臂的位姿闭环周期较短,因此,仅有力的同步闭环控制,会对机械臂的位姿跟踪产生影响。
技术实现思路
本专利技术的目的是提供一种力/位协调的多臂机器人柔顺控制方法,该方法在确定不同机械臂之间的力协调的同时,保证了位置的同步协调关系。本专利技术为解决上述技术问题采用以下技术方案:一种力/位协调的多臂机器人柔顺控制方法,机器人有N个机械臂T={t1,t2,…,ti,…,tN},1<i<N,ti表示第i个机械臂,所述控制方法具体包括以下步骤:步骤S10,由机械臂的操作任务计算机械臂末端期望接触力;步骤S11,通过安装的机械臂末端六维力矩传感器测量机械臂末端实际接触力;步骤S12,由机械臂的操作任务计算机械臂末端期望位姿;步骤S13,通过机械臂关节角度传感器测量机械臂关节绝对角度;步骤S14,以步骤S10得到的所述机械臂末端期望接触力、步骤S11得到的所述机械臂末端实际接触力、步骤S12得到的所述机械臂末端期望位姿以及步骤S13得到的所述机械臂关节绝对角度作为条件输入基于力/位协调的多机械臂同步阻抗控制器;步骤S15,根据步骤S14所述基于力/位协调的多机械臂同步阻抗控制器的输出结果实现机械臂闭环控制。进一步的,所述步骤S140的具体过程为:步骤S140,根据步骤S10得到的所述机械臂ti-1,机械臂ti,机械臂ti+1末端期望接触力和步骤S11得到的所述机械臂ti-1,机械臂ti,机械臂ti+1末端实际接触力以及同步控制思想得到机械臂ti末端力误差、同步力误差、同步力耦合误差;步骤S141,根据步骤S140得到的所述机械臂ti末端力误差、同步力误差以及同步力耦合误差得到机械臂ti末端力补偿量;步骤S142,设计机械臂末端同步阻抗控制器,所述机械臂末端同步阻抗控制器以步骤S141得到的所述机械臂ti末端力补偿量作为输入条件,从而建立多机械臂同步力与运动学之间的关系;步骤S143,根据所述机械臂末端同步阻抗控制器得到机械臂ti阻抗期望加速度;步骤S144,根据所述机械臂末端同步阻抗控制器得到机械臂ti阻抗期望速度;步骤S145,根据所述机械臂末端同步阻抗控制器得到机械臂ti阻抗期望位姿;步骤S146,根据步骤S12得到的所述机械臂ti-1,机械臂ti,机械臂ti+1的末端期望位姿得到机械臂ti的运动期望加速度;步骤S147,根据步骤S12得到的所述机械臂ti-1,机械臂ti,机械臂ti+1的末端期望位姿得到机械臂ti的运动期望速度;步骤S148,根据步骤S12得到的所述机械臂ti-1,机械臂ti,机械臂ti+1的末端期望位姿得到机械臂ti的运动期望位姿;步骤S149,根据步骤S13得到的所述机械臂ti-1,机械臂ti,机械臂ti+1的关节绝对角度信息和机械臂的正运动学得到机械臂ti末端实际位姿;步骤S1410,根据步骤S12得到的所述机械臂ti-1,机械臂ti,机械臂ti+1的末端期望位姿和步骤S149得到的所述机械臂ti末端实际位姿得到械臂ti末端位姿误差、同步位姿误差、同步位姿耦合误差;步骤S1411,根据步骤S1410得到的所述械臂ti末端位姿误差、同步位姿误差、同步位姿耦合误差得到机械臂ti末端同步位姿补偿量;步骤S1412,根据步骤S143得到的所述机械臂ti阻抗期望加速度和步骤S146得到的所述机械臂ti的运动期望加速度得到机械臂ti同步期望加速度;步骤S1413,根据步骤S144得到的所述机械臂ti阻抗期望速度和步骤S147得到的所述机械臂ti的运动期望速度得到机械臂ti同步期望速度;步骤S1414,根据步骤S145得到的所述机械臂ti阻抗期望位姿、步骤S148得到的所述机械臂ti的运动期望位姿和步骤S1411得到的所述机械臂ti末端同步位姿补偿量得到机械臂ti同步期望位姿。进一步的,所述步骤S15的具体过程为:步骤S150,通过步骤S13得到的所述机械臂关节绝对角度和建立关节的速度观测器,计算得到机械臂的关节角速度;步骤S151,根据机械臂速度雅克比关系和步骤S150得到的所述机械臂的关节角速度计算求得机械臂末端实际速度;步骤S152,根据步骤S13得到的所述机械臂关节绝对角度计算求得机械臂末端实际位姿;步骤S153,根据步骤S151得到的所述机械臂末端实际速度和步骤S152得到的所述机械臂末端实际位姿信息计算得到机械臂末端实际加速度;步骤154,根据步骤S151得到的所述机械臂末端实际速度和步骤S1413得到的所述机械臂ti同步期望速度之间的差值,求得机械臂速度补偿量;步骤S155,根据雅克比关系以及步骤S154求得的所述机械臂速度补偿量求得瞬间时刻的机械臂关节角速度补偿量,在短时间段内,该补偿量等效为关节速度补偿量;步骤S156,根据步骤S153得到的所述机械臂末端实际加速度和步骤S1412得到的所述机械臂ti同步期望加速度之间的差值得到机械臂加速度补偿量;步骤S157,根据步骤S156得到的所述机械臂末端加速度补偿量得到关节加速度补偿量;步骤S158,根据步骤S1414得到的所述机械臂同步期望位姿和步骤S152求得的所述机械臂末端实际位姿之间的差得到机械臂位姿补偿量;步骤S159,根据步骤S158得到的所述机械臂位姿补偿量和逆运动学关系得到机械臂的关节角度补偿量;步骤S1510,根据步骤S155得到的所述关节速度补偿量、步骤S157得到的所述关节加速度补偿量和步骤S159得到的所述机械臂的关节角度补偿量得到机械臂的关节控制补偿量从而实现机械臂关节闭环控制。进一步的,机械臂的阻抗控制系统采用笛卡尔阻抗控制系统,笛卡尔阻抗控制系统的内环采用笛卡尔位置控制,外环采用阻抗控制器。与现有技术相比,本专利技术有以下有益效果:(1)通过在机械臂的大闭环周期中采用力同步协调控制方法,在小闭环周期中采用位姿同步协调控制的方法,从而实现多机械臂的力/位同步协调控制;(2)本文档来自技高网...

【技术保护点】
1.一种力/位协调的多臂机器人柔顺控制方法,其特征在于,机器人有N个机械臂T={t1,t2,…,ti,…,tN},1

【技术特征摘要】
1.一种力/位协调的多臂机器人柔顺控制方法,其特征在于,机器人有N个机械臂T={t1,t2,…,ti,…,tN},1<i<N,ti表示第i个机械臂,所述控制方法具体包括以下步骤:步骤S10,由机械臂的操作任务计算机械臂末端期望接触力;步骤S11,通过安装的机械臂末端六维力矩传感器测量机械臂末端实际接触力;步骤S12,由机械臂的操作任务计算机械臂末端期望位姿;步骤S13,通过机械臂关节角度传感器测量机械臂关节绝对角度;步骤S14,以步骤S10得到的所述机械臂末端期望接触力、步骤S11得到的所述机械臂末端实际接触力、步骤S12得到的所述机械臂末端期望位姿以及步骤S13得到的所述机械臂关节绝对角度作为条件输入基于力/位协调的多机械臂同步阻抗控制器;步骤S15,根据步骤S14所述基于力/位协调的多机械臂同步阻抗控制器的输出结果实现机械臂闭环控制。2.根据权利要求1所述的一种力/位协调的多臂机器人柔顺控制方法,其特征在于,所述步骤S140的具体过程为:步骤S140,根据步骤S10得到的所述机械臂ti-1,机械臂ti,机械臂ti+1末端期望接触力和步骤S11得到的所述机械臂ti-1,机械臂ti,机械臂ti+1末端实际接触力以及同步控制思想得到机械臂ti末端力误差、同步力误差、同步力耦合误差;步骤S141,根据步骤S140得到的所述机械臂ti末端力误差、同步力误差以及同步力耦合误差得到机械臂ti末端力补偿量;步骤S142,设计机械臂末端同步阻抗控制器,所述机械臂末端同步阻抗控制器以步骤S141得到的所述机械臂ti末端力补偿量作为输入条件,从而建立多机械臂同步力与运动学之间的关系;步骤S143,根据所述机械臂末端同步阻抗控制器得到机械臂ti阻抗期望加速度;步骤S144,根据所述机械臂末端同步阻抗控制器得到机械臂ti阻抗期望速度;步骤S145,根据所述机械臂末端同步阻抗控制器得到机械臂ti阻抗期望位姿;步骤S146,根据步骤S12得到的所述机械臂ti-1,机械臂ti,机械臂ti+1的末端期望位姿得到机械臂ti的运动期望加速度;步骤S147,根据步骤S12得到的所述机械臂ti-1,机械臂ti,机械臂ti+1的末端期望位姿得到机械臂ti的运动期望速度;步骤S148,根据步骤S12得到的所述机械臂ti-1,机械臂ti,机械臂ti+1的末端期望位姿得到机械臂ti的运动期望位姿;步骤S149,根据步骤S13得到的所述机械臂ti-1,机械臂ti,机械臂ti+1的关节绝对角度信息和机械臂的正运动学得到机械臂ti末端实际位姿;步骤S1410,根据步骤S12得到的所述机械臂ti-1,机械臂ti,机械臂ti+1的末端期望位姿和步骤S149得到的所述机械臂ti末端实际位姿得到械臂ti末端...

【专利技术属性】
技术研发人员:董洋洋张子建韩少杰朱新董
申请(专利权)人:南京航空航天大学
类型:发明
国别省市:江苏,32

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1