基于双臂机器人协同操作的柔顺控制方法及系统

摘要

本发明公开了一种基于双臂机器人协同操作的柔顺控制方法，包括双臂协同控制模块根据目标负载的期望运动轨迹和期望力建立动力学模型，得到各个机械臂的末端期望位姿和末端期望力；单臂控制模块完成对所述期望任务指令的解析与执行，得到机械臂各个关节的期望角度；驱动模块根据规划的期望关节角度，驱动所述机械臂完成任务轨迹。本发明还提供一种基于双臂机器人协同操作的柔顺控制系统，本方案采用主从式和共享式策略进行负载的公共力分解，得到两个机械臂的期望操作力，进而提出了双臂协同操作的主从式力柔顺控制方法和共享式力柔顺控制方法。广泛应用于机器人技术的双臂协作控制领域。