基于双机械臂协作打磨系统的动力学模型设计方法

摘要

本发明公开了基于双机械臂协作打磨系统的动力学模型设计方法，包括如下步骤：步骤一，构建双机械臂基于打磨加工轨迹的雅可比矩阵，在运动学层面，基于双机械臂的雅可比矩阵，结合打磨刀具和夹持工件的物理参数，将双机械臂的各关节和打磨轨迹结合起来，构造出从打磨轨迹速度到各机械臂关节速度的雅可比矩阵；步骤二，构建打磨刀具和工件打磨力简化力学模型；步骤三，构建双机械臂协作打磨系统耦合动力学模型，将所述协作打磨系统分为加工机械臂系统和夹持机械臂系统，分别构建耦合加工机械臂系统的动力学模型和耦合夹持机械臂系统的动力学模型。