跳转至

执行模块

进行中负责人: 任松


模块目标

接收动作序列,经安全校验后控制越疆 CR5AF 机械臂完成器械夹取与递交,全程力控防碰撞。

硬性约束: 所有运动指令须经 safety_manager.pyvalidate_path() 校验,否则拒绝执行。
完整安全边界见 全局安全约束


上下游接口

来源 数据 说明
决策模块 ActionSequence 动作步骤序列
safety_manager 校验结果 通过才执行
消费方 数据 说明
CR5AF 机械臂 关节角 / 末端位姿 Dobot SDK TCP 协议
状态机 执行状态反馈 完成 / 中断 / 急停

当前状态

子功能 状态 说明
CR5 SDK 基础封装 完成 hardware/cr5af_arm.py 封装完毕
基础运动控制 完成 关节运动 + 末端位姿运动可用
力控夹爪 进行中 夹持力参数调试中
执行前安全校验 进行中 P0-03,validate_path() 开发中
Z 轴高度自适应 待完成 P1-02,设计中
GUI 参数配置接口 待完成 P0-02,等 GUI 模块完成
递送姿态模板 待完成 把手朝向医生的标准姿态库

待决策问题

无当前待决策事项。


已知瓶颈

P0-03:缺少执行前安全校验

当前感知模块输出偏差时,机械臂会直接向错误位置运动(现场问题 #8)。
改进方向:core/safety_manager.py 实现 validate_path(),包含工作空间检查、碰撞预检、速度合规检查。

P1-02:Z 轴高度不一致

真实托盘桌面不平整,不同区域 Z 偏移量差异可达 5–10mm,导致夹取失败(现场问题 #3)。
改进方向: 执行层增加高度自适应补偿,夹取前先探测实际 Z 高度。


本周行动

  • 任松:完成 validate_path() 工作空间检查部分,单元测试通过
  • 任松:收集夹持力测试数据(不同器械类型),确定力控参数范围
  • 任松:与感知模块对齐 GraspTarget 坐标系定义

技术子页