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.
【技术实现步骤摘要】
一种力/位协调的多臂机器人柔顺控制方法
本专利技术涉及机器人的控制,尤其涉及一种力/位协调的多臂机器人柔顺控制方法。
技术介绍
机器人在多机械臂力耦合情况下操作完成一个操作任务时,为了保证机械臂和操作物体的安全性,需要采用柔顺控制或者力控制的方式实现力协调,但是由于力闭环的响应周期较长,而实际上机械臂的内环大都采用位置控制的模式,因此,机械臂的响应时间会受到影响,因此,如果能够同时保证多机械臂协调操作过程中力的同步性,同时也保证位姿的同步性,这将会提高机械臂的协调操作能力。近年来,随着力控制的需求越来越大,机器人的操作任务需求也从单一的位置控制需求,逐渐发展为位置和力的同时需求的阶段。尤其是在多臂力耦合完成操作任务的情况下,多臂力/位协调控制变得更加重要。多臂力/位协调控制可以有效保证多机械臂力的协调关系和位,但是仅有力的协调关系,机械臂的位姿精度将无法保证,降低了多机械臂的协调控制性能。而机械臂保证力控制的有效方式是采用阻抗控制的方法,建立机械臂位姿与力之间关系的函数方程,从而实现力和位姿之间的动态协调平衡。单个机械臂中,阻抗方程的输出与输入关系只跟机械臂自身的位姿误差、力误差有关,当多机械臂协调时,为了保证系统的安全性,采用力同步的方式保证多机械臂的力协调关系,但是实际应用中,由于力传感器的物理响应和闭环周期都较慢,而机械臂的位姿闭环周期较短,因此,仅有力的同步闭环控制,会对机械臂的位姿跟踪产生影响。
技术实现思路
本专利技术的目的是提供一种力/位协调的多臂机器人柔顺控制方法,该方法在确定不同机械臂之间的力协调的同时,保证了位置的同步协调关系。本专利技术为 ...
【技术保护点】
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
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。