速解魔方機器人(上)

1 設計概述
1.1  設計意圖
     機器人的出現和發(fā)展是計算機技術(shù)進(jìn)步和自動(dòng)化研究 不斷深入的結果。工業(yè)機器人的產(chǎn)生提高了人類(lèi)社會(huì )生產(chǎn) 力，極大地改變了工業(yè)生產(chǎn)和人類(lèi)生活樣貌。但現有機器人 一般系統較為復雜，并且成本昂貴。
本項目中我們設計了一套基于Linux 操作系統的FPGA- HPS數據交互聯(lián)合求解魔方的智能魔方破解平臺。項目在 FPG A部分利用CCD攝像頭識別獲取魔方54個(gè)小色塊的顏 色，通過(guò)lw_AXI_FPGA-to-HPS Bridge送到HPS部分，HPS收 到所有54個(gè)色塊的顏色之后，應用我們獨立設計的魔方求 解算法進(jìn)行求解得到還原該魔方的步驟，再通過(guò)lw_HPS-to- FPGA Bridge送到FPGA部分，進(jìn)而控制舵機來(lái)操縱破解平臺 上機械手臂旋轉伸縮，還原魔方。本系統的主要研究成果包 括：基于Verilog語(yǔ)言的顏色識別算法、多功能VGA顯示、獨 立自主設計的魔方求解算法、穩定靈活的機械結構。
1.2  適用范圍
目前，市場(chǎng)上的機器人都是按照固定的步驟完成相應 的功能，當外界環(huán)境出現變動(dòng)時(shí)，機器人就無(wú)法完成該功能 了，針對該問(wèn)題，本作品運用FPGA視頻處理技術(shù)，對周?chē)?環(huán)境進(jìn)行實(shí)時(shí)監控，然后再進(jìn)行相應的操作，大大提高了工

圖1  系統實(shí)物圖    

圖2  圖像采集和識別功能    

圖3　數碼管顯示效果圖
作效率，凸顯了機器人像人一樣的智慧、靈動(dòng)。 在實(shí)時(shí)監控的同時(shí)，我們的作品也具有很高的觀(guān)賞性。魔方本身就具 有很強的吸引力，再加上這個(gè)具有人功能的機械外觀(guān)，一定 顯得別具一格。
1.3  本設計采用SoC器件的優(yōu)勢
(1)在DE1-SoC開(kāi)發(fā)板上搭載帶有圖形界面的Ubuntu系 統，能有效地提高CPU的利用率，簡(jiǎn)化復雜系統的開(kāi)發(fā)難 度。
(2)DE1-SoC嵌入了ARM-9雙核處理器，運算速率高，
適合做算法，能對我們的求解魔方算法進(jìn)行快速處理。
(3)在A(yíng)RM上可以開(kāi)發(fā)應用程序來(lái)作為控制臺， Linux平 臺有多種圖形庫可供選擇，讓我們的應用程序更加美觀(guān)，具 有更高的觀(guān)賞性。


2 功能描述
本設計采用DE1- SoC作為開(kāi)發(fā)平臺，成功實(shí)現了基于 Linux操作系統的FPGA-HPS數據交互聯(lián)合求解魔方的智能魔 方破解系統。系統實(shí)物圖如圖1所示。
系統圍繞“顏色識別，魔方求解”實(shí)現以下功能
2.1  圖像采集和顏色識別(Verilog語(yǔ)言編寫(xiě))
在識別模式下，顯示屏將在固定區域出現9個(gè)方框，用 于指定圖像采集區域。通過(guò)調整魔方 的位置，使魔方某面的9個(gè)色塊均位于 方框內。顏色識別算法對方框內的圖 像信息進(jìn)行實(shí)時(shí)識別。識別結果會(huì )在 液晶屏幕右邊的魔方平面展開(kāi)圖中呈 現。魔方展開(kāi)圖中的9個(gè)色塊與實(shí)際的

圖4　多功能VGA顯示 效果圖
9個(gè)色塊一致， 即實(shí)現了圖像采集和顏色識別功能,效果如圖2。
2.2  破解還原魔方功能
將 C C D 攝 像 頭 識 別 到 的 顏 色 數 據，通過(guò)DE1- SoC上的LW FPGA-to- HPS Bridge將數據傳送給HPS，然后 通過(guò)寫(xiě)入在HPS里面的魔方破解算法 得到破解該魔方的算法， 再通過(guò)LW HPS-to-FPGA Bridge將破解還原魔方 步驟輸出，控制PPGA的GPIO，達到 破解魔方的目的。
2.3  數碼管顯示
系統得到破解魔方的算法后，將破解該魔方所需的總
步數通過(guò)數碼管顯示出來(lái)，破譯機器人每按算法操作一步， 數碼管顯示的數值就會(huì )減1，直到數碼管顯示為0時(shí)，魔方算 法執行完畢。效果如圖3。
2.4  多功能VGA顯示
在液晶顯示屏的右邊區域繪制出魔方6個(gè)面54個(gè)格子的 展開(kāi)圖，CCD攝像頭識別好實(shí)物魔方的顏色后就會(huì )將顏色 繪制在展開(kāi)圖的各個(gè)方框中，呈現出混亂魔方的六個(gè)面的展 開(kāi)圖。具體實(shí)現效果如圖4。

圖5　機器人硬件搭建    

圖6　DE1-SoC開(kāi)發(fā)板資源使用情況

圖7　系統總體設計框圖
2.5  機器人硬件的搭建
利用兩個(gè)舵機來(lái)完成伸縮和旋轉，然后利用四個(gè)機械 手臂來(lái)完成這個(gè)機器人系統搭建，通過(guò)結構來(lái)固定這四個(gè)機 械手臂，實(shí)現機器人穩定靈活地破解魔方，具體實(shí)現效果如 圖5。

3 性能參數
3.1 各模塊性能參數
(1)DE1-SoC主控板 直流電壓：9V 系統頻率：CPU工作頻率：100MHz (2)CCD攝像頭       輸入電壓：12V TV制式：PAL    工作溫度 ： -20℃~70℃(3)MG996R舵機    尺寸:40.8*20*38mm   重量:55g 速度:4.8V@0.20sec/60°6.0V@0.19sec/60° 扭矩:4.8V@13kg-cm  6.0V@15kg-cm電壓:4.8V-7.2V
( 4 ) D C -D C 電源    輸入電壓： 9 ~ 1 6 V    輸出電壓：6.0~7.4V 體積：40mm*30mm*20mm (5)視頻接口解碼芯片：ADV7123     工作頻率：25MHz    顯示分辨 率：640*480
(6)魔方
魔方種類(lèi):三階 魔方尺寸：52mm
魔方重量：0.1g
(7)SD卡
型號：Sandisk/閃迪   容量：8G
讀寫(xiě)速度: UHS-1    文件系統：FAT163.2 開(kāi)發(fā)板使用情況DE1-SoC開(kāi)發(fā)板資源使用情況(如圖6所示)。4  設計結構
4.1  系統功能設計
系統總體設計框圖如圖7所示。
4.1.1  HPS部分
在H P S 部分， 分為四個(gè)步驟： 控制F P G A 完成顏色識 別->獲取魔方顏色->魔方求解->發(fā)送求解步驟到FPGA舵機控制模塊。
第一步，通過(guò)lw_AXI_FPGA- to-HPS Bridge控制FPGA部分的顏色 識別模塊和舵機轉動(dòng)模塊，按一定 的次序轉動(dòng)魔方，對其六個(gè)面依次 進(jìn)行指定區域的RGB獲取。
第二步，六個(gè)面所有小色塊的RGB獲取完成后，HPS對每個(gè)小色 塊的顏色進(jìn)行判斷，得到準確的顏 色。第三步，根據魔方六個(gè)面的顏色，利用我們獨立自主 設計的魔方求解算法得出還原魔方的步驟。
第四步，得到步驟之后，通過(guò)lw_AXI_HPS-to- FPGA Bridge發(fā)送給舵機轉動(dòng)模塊。