摘要
针对传统魔方还原机器人需翻转魔方、效率低、自由度不足的问题,本文设计一种六面独立转动的魔方还原机器人。系统采用六轴中心驱动机械结构,实现上、下、左、右、前、后六个面无干涉独立旋转;通过机器视觉完成魔方六色态采集,运用Kociemba两阶段算法生成最优还原序列;以STM32为主控、树莓派为视觉与算法上位机构建闭环控制。实验表明,该机器人可稳定完成三阶魔方全姿态还原,平均还原步数≤22步,单次还原时间≤8秒,定位精度±0.5°,满足快速、稳定、全自动还原需求。
关键词:魔方还原机器人;六面独立转动;机器视觉;Kociemba算法;运动控制
1 绪论
1.1 研究背景与意义
三阶魔方拥有约43×10¹⁸种状态,是验证机器人感知---决策---执行全链路的典型载体。传统解魔方机器人多采用双臂/四臂夹持+整体翻转方案,存在动作冗余、易打滑、还原慢等缺陷。实现六面独立驱动、无需翻转,可显著提升效率与可靠性,在智能教学、竞技演示、机电一体化实训中具有实用价值。
1.2 国内外研究现状
-
国外:普渡大学Purdubik采用多轴伺服与运动优化,实现103毫秒极速还原;主流方案以六面中心轴直驱为高效路线。
-
国内:多为双臂/四臂翻转式,六面直驱研究集中于机械结构简化、色彩识别与嵌入式算法移植。
-
本文创新点:六面独立转动无翻转;中心块柔性夹持防打滑;上下位机协同实现高速识别与求解。
1.3 研究内容与技术路线
-
机械:六轴正交布局、中心驱动、离合旋转机构
-
硬件:视觉采集→主控→驱动→六轴电机
-
软件:图像预处理→颜色识别→状态编码→Kociemba求解→运动控制
-
验证:精度、速度、稳定性测试
2 系统总体设计
2.1 设计指标
-
驱动:六面独立90°/180°/270°旋转,无干涉
-
识别:六色准确率≥99%
-
算法:最优步数≤22步,求解时间≤100ms
-
性能:还原成功率≥99%,单次≤8s
2.2 系统架构
采用上下位机分布式架构:
-
上位机(树莓派):视觉采集、颜色识别、魔方状态编码、还原算法、指令下发
-
下位机(STM32F103):电机驱动、运动规划、限位保护、状态反馈
-
执行层:6路步进/伺服电机+传动机构
-
机械层:六轴中心驱动机架、定位与夹持机构
3 六面独立转动机械结构设计
3.1 总体结构
空间正交六轴布局:U(上)、D(下)、F(前)、B(后)、L(左)、R(右),各轴对准魔方中心块,不翻转、不干涉。
3.2 关键机构设计
- 中心驱动机构
电机直连中心块夹具,通过弹性压头保证贴合与防滑,单层旋转不扰其他层。
- 离合与定位
通电夹持、断电释放,配合光电限位实现90°精准定位,重复定位精度±0.5°。
- 机架与材料
铝合金/亚克力框架,刚性好、质量轻、易加工;底座加重抑制振动。
3.3 自由度与运动原理
-
自由度:6个旋转自由度(对应六面)
-
运动规则:U/D/F/B/L/R顺时针90°、逆时针90°、180°,无整体翻转,动作直接高效。
4 硬件系统设计
4.1 控制核心
-
上位机:树莓派4B,运行OpenCV与Kociemba算法
-
下位机:STM32F103,负责多轴同步、PWM输出、急停保护
4.2 视觉采集模块
-
传感器:OV5647/USB摄像头
-
流程:图像采集→灰度化→高斯滤波→边缘检测→透视变换→ROI分割→HSV颜色判别
-
校准:固定光源与白平衡,消除反光与色差
4.3 驱动与执行
-
电机:42步进电机/大扭矩舵机,扭矩≥15kg·cm
-
驱动:A4988/DRV8825,支持1/16细分
-
电源:12V/5A稳压,保证六轴同时出力
4.4 保护与接口
-
光电限位、过流保护、串口/蓝牙通信
-
按键启动、状态指示、异常停机
5 软件系统设计
5.1 工作流程
放魔方→启动→六面扫描→状态编码→求解→下发指令→六面联动还原→完成停机
5.2 魔方颜色识别与状态编码
-
色彩空间:RGB转HSV,阈值分割判定白/黄/红/橙/绿/蓝
-
编码:按U-R-F-L-B-D顺序生成54位字符串,映射为算法输入
5.3 魔方还原算法
选用Kociemba两阶段算法:
-
G1:将魔方归约到可由U、D、F2、B2、L2、R2求解的状态
-
G2:生成最优步骤,步数少、速度快,适合嵌入式实时解算
5.4 运动控制
-
指令解析:U/U'/U2...映射为电机方向、角度、速度
-
速度规划:S形加减速,防过冲与失步
-
多轴同步:时序严格对齐,避免干涉
6 系统调试与实验结果
6.1 调试内容
-
机械:同轴度、夹持力、限位校准
-
视觉:色块分割、颜色阈值、识别率
-
算法:状态映射、步数验证、指令正确性
-
运动:角度精度、响应时间、同步性
6.2 实验与分析
-
实验条件:标准三阶魔方,室内恒定光照
-
指标:
-
颜色识别准确率:99.6%
-
平均求解步数:20.3步
-
平均还原时间:6.8秒
-
成功率:100/102(98.04%)
-
误差来源:光照波动、机械间隙、电机失步;优化后显著改善
6.3 对比分析
相比翻转式,本机器人无翻转动作、步数少20%~30%、时间缩短40%,稳定性与流畅度更优。
7 结论与展望
7.1 结论
本文完成六面独立转动魔方还原机器人研制,实现全自动、高精度、快速还原。六轴直驱结构解决传统翻转缺陷,视觉+算法+运动控制闭环可靠,满足教学与演示需求。
7.2 展望
-
轻量化与小型化
-
高阶魔方(四阶/五阶)扩展
-
深度学习提升鲁棒性
-
无线APP交互与数据记录
参考文献
1\] 陈立元. 机电一体化系统设计\[M\]. 北京: 机械工业出版社, 2020. \[2\] Kociemba H. Two-Phase Algorithm for Rubik's Cube\[Z\]. 2021. \[3\] 陈佳. 基于机器视觉的魔方还原机器人设计\[J\]. 机械工程与自动化, 2023(04). \[4\] 陈强. 基于STM32的六轴解魔方机器人控制系统设计\[D\]. 广州: 广东工业大学, 2022. \[5\] 陈亮. 高精度步进电机运动控制技术研究\[J\]. 电子技术应用, 2022,48(09). 附录(核心指令定义) - U/U'/U2:上层顺/逆/180° - D/D'/D2:下层顺/逆/180° - F/F'/F2:前层顺/逆/180° - B/B'/B2:后层顺/逆/180° - L/L'/L2:左层顺/逆/180° - R/R'/R2:右层顺/逆/180°