基于四臂协调控制的魔方还原系统设计与实现

为了解决舵机本身旋转角度的限制、滑轨机械自由度的限制,以及在四机械臂的机械限制下能够协调控制旋转魔方6个平面的问题,针对魔方结构建立易于控制的位置状态模型,通过切换魔方位置状态控制其所有平面。建立舵机及机械臂的状态模型,进而针对建立的模型设计四机械臂协调控制算法,有序执行魔方的各个旋转操作。通过设计控制电路、舞台演示模块、滑轨机械臂、U型机械手等模块完成系统硬件搭建,并根据四机械臂协调控制算法设计了完整的控制程序。结果表明,系统通过四机械臂协调控制算法能够在现有机械结构的限制下流畅地将一个任意打乱、任意放置的魔方还原,实现教学演示与科普展示的推广使用。系统中的颜色识别和机械手的协同控制部分为其他分拣装配提供了新的思路,对无人自动展示装置等设计也具有一定的参考价值。