Drake中URDF解析异常：执行器未实例化致Pick n Place任务报错

核心原因 #

报错直接指向机器人模型的关节自由度数量与执行器数量不匹配，Drake的逆动力学控制器和PID控制器都要求控制输入维度与机器人可驱动关节维度严格对应，说明你的URDF未正确定义执行器信息，或关节配置不符合Drake解析规则。

可能遗漏的关键配置 #

• 未定义可驱动关节的执行器：Drake默认仅识别URDF中带<actuator>标签的关节为可驱动关节。若你的URDF未给需控制的关节添加<actuator>定义，Drake会判定执行器数量为0，自然与关节自由度数量不匹配。
• 关节类型或属性错误：将需驱动的旋转/移动关节（revolute/prismatic）误设为固定关节（fixed），或标记为被动关节（<passive>），会导致Drake统计的可驱动关节数减少，与总自由度不一致。
• URDF加载参数缺失：使用MultibodyPlant加载URDF时，若未正确配置执行器相关参数，比如未手动添加关节执行器（当URDF无<actuator>标签时），会导致执行器数量未被正确统计。
• 冗余或错误的关节定义：URDF中存在未被正确识别的关节，或固定关节被错误计入自由度统计，也会引发维度不匹配问题。

针对Nextage机器人的具体排查与修复步骤 #

1. 检查URDF的执行器定义：确认URDF中包含<actuator>标签块，每个需控制的关节都对应一个<actuator>配置，指定关节名称和传动类型（如transmission_interface/SimpleTransmission）。
2. 验证关节属性：检查所有非固定关节的类型，确保revolute/prismatic关节未被标记为被动，且每个关节都对应执行器配置。
3. 修正URDF加载逻辑：若URDF无<actuator>标签，加载时手动指定驱动关节并添加执行器：

   MultibodyPlant<double> plant(0.0);
   Parser parser(&plant);
   parser.AddModelFromFile("nextage.urdf");
   // 列出所有需控制的关节名称
   const std::vector<std::string> drive_joints = {"LARM_JOINT0", "LARM_JOINT1", "LARM_JOINT2", "LARM_JOINT3", "LARM_JOINT4", "LARM_JOINT5",
                                                 "RARM_JOINT0", "RARM_JOINT1", "RARM_JOINT2", "RARM_JOINT3", "RARM_JOINT4", "RARM_JOINT5"};
   for (const auto& joint_name : drive_joints) {
       plant.AddJointActuator(joint_name);
   }
   plant.Finalize();
   

4. 验证维度匹配：加载模型后，通过以下代码确认自由度与执行器数量一致：

   std::cout << "Num positions: " << plant.num_positions() << std::endl;
   std::cout << "Num actuators: " << plant.num_actuators() << std::endl;
   

内容的提问来源于stack exchange，提问作者kamiradi