基于STM32的機械手臂控制系統(tǒng)設(shè)計

北京聯(lián)合大學(xué) 鐘曉青 林 智 和青芳

基于STM32的機械手臂控制系統(tǒng)設(shè)計

北京聯(lián)合大學(xué) 鐘曉青 林 智 和青芳

機械臂在近十幾年的發(fā)展中，已經(jīng)實現(xiàn)根據(jù)軟件程序的設(shè)計操作機械臂完成相應(yīng)的特定工作。它不僅可以在人們無法作業(yè)的環(huán)境下工作，而且還能保持長時間的作業(yè)和低失誤率。本文簡要介紹基于STM32的機械手臂控制系統(tǒng)實現(xiàn)方案。

舵機；STM32單片機；PWM波

1.引言

早在很久以前，人們就已經(jīng)開始制作機器人，以減輕人類的繁重勞動。一直以來，人們總是嘗試將生活變的更加簡單。而如今，有關(guān)于自動機器人相關(guān)的技術(shù)已然成為了各國科技水平程度的體現(xiàn)之一。

2.系統(tǒng)設(shè)計及實現(xiàn)方案

2.1 系統(tǒng)分析

本文對基于STM32的自動機械臂控制系統(tǒng)進行了研究和設(shè)計。以六自由度機械臂為研究對象，使用STM32為主控芯片，再利用穩(wěn)壓模塊、無線模塊和電機驅(qū)動模塊設(shè)計了系統(tǒng)的硬件結(jié)構(gòu)，并在軟件設(shè)計方面采用了先進的控制理論。通過合理的算法進行了軟件設(shè)計。

2.2 設(shè)計結(jié)構(gòu)圖

本設(shè)計采用單CPU集中控制方式，即由stm32來控制舵機，執(zhí)行相應(yīng)的預(yù)定動作，自動機械臂控制系統(tǒng)的構(gòu)成如圖2.1所示。

圖2.1 機械臂控制系統(tǒng)結(jié)構(gòu)

該系統(tǒng)是通過計算機的事先的編程之后，通過數(shù)據(jù)傳輸下載到stm32當中通過控制stm32的定時器產(chǎn)生多路的PWM波。舵機就會依據(jù)給定的PWM波完成相應(yīng)的運動軌跡或按照預(yù)定的計劃完成任務(wù)。

2.3 機械臂的臂部設(shè)計

因為機械臂主要是由臂部組成，所以在進行臂部設(shè)計時應(yīng)當著重注意以下幾點：（1）手臂在機械臂中起著重要的作用：它不光可以讓物體進行移動而且還能進行一些操作。（2）因為機械臂的臂部在運動中有很大負擔(dān)，為了減小手臂的負擔(dān)，需要將手臂的截面形狀做的更加合理。在進行了各種截面對彎曲度的承受力的實驗后發(fā)現(xiàn)，在相同力的情況下，工字型的截面能承受的力最大，因此我選擇使用工字型截面做手臂的截面。（3）因為機械臂在直線運動中可能會發(fā)生突然的方向轉(zhuǎn)換，因此，為了防止機械臂的硬件損耗過大，需要采用一些裝置來保護機械臂。同時要采用一定形式的緩沖措施。（4）為了減少臂部在運動時會產(chǎn)生較大的轉(zhuǎn)動慣量，需要將臂部的重量減少，以免在運動中產(chǎn)生較大的誤差，從而影響機械臂的整體運作，加快機械臂的運行速度。

經(jīng)過對預(yù)期任務(wù)的特點和類型分析，該設(shè)計需要機械臂具有較高的靈活性和流暢性，因此在多次的比較和分析后，決定使用多關(guān)節(jié)型機械臂。它不僅可以靈活的完成預(yù)定任務(wù)，而且可以有更大的運動空間。

2.4 機械臂自由度選擇

通常將機械臂是由幾個傳動結(jié)構(gòu)組成的就稱為幾自由度。例如人類的自由度高達27個，而手臂部分的自由度一般為6自由度。所以仿照人類的特性，機械臂的自由度應(yīng)當選為6自由度，這樣既符合了身體力學(xué)并且動力傳輸效率也很高。為了更加流暢的完成抓取物體，并將物體移動到指定的位置，需要采用6自由度。而6自由度的機械臂的控制較為繁瑣，所以工業(yè)和生活中機械臂的自由度多少于6個。

2.5 機械臂控制器類型

控制器的主要任務(wù)就是按照預(yù)先設(shè)計的程序進行相應(yīng)的任務(wù)，它是機械臂中十分重要的組件。機械臂的控制器就相當于電腦中的處理器，只有處理器越好，電腦的運行速度和處理速度才會越快。對于機械臂來說也一樣，只有控制器越好，才能更加精準快速的進行控制。從控制器的數(shù)量和機械臂的控制方式可分為以下幾種：單CPU集中控制、多CPU分散控制、雙CPU分級控制。本文所設(shè)計的機械臂控制系統(tǒng)，利用stm32的強大的處理能力和多線程的管理能力，由此，采用單CPU集中控制方式即可。

3.機械系統(tǒng)設(shè)計與實現(xiàn)

機械臂的機械系統(tǒng)的基本要求應(yīng)當有如下幾個特點：（1）控制系統(tǒng)應(yīng)當微小化、輕便化和分塊化，以便將控制器安裝到受控對象的硬件上，以便更好的進行控制。因此為了更有效的減少硬件結(jié)構(gòu)的復(fù)雜度和負載，所以要盡可能的微小化和輕便化。此外，為了系統(tǒng)具有較好的獨立性，所以要盡可能的分層化。（2）控制系統(tǒng)的實時性：因為機械臂是一種即時的操作，所以對于機械臂的每一個動作，都要確保其是快速的反應(yīng)，否則機械臂就不能順利完成相應(yīng)的動作。（3）系統(tǒng)的穩(wěn)定性和開源性。為了確保機械臂可以完成任務(wù)要求，因此穩(wěn)定性是十分重要的。此外，因為后期可能出現(xiàn)更多的問題，所以要確保后期可以對控制系統(tǒng)進行二次開發(fā)。

本文的系統(tǒng)由控制模塊、直流伺服電機模塊和電源驅(qū)動模塊組成。每個模塊的作用如下：

控制模塊：該模塊是機械臂控制系統(tǒng)的核心，由stm32、串口和穩(wěn)壓模塊組成，其主要是控制各個直流伺服舵機進行運動。

直流伺服電機模塊：該模塊主要是實現(xiàn)不用動作的基礎(chǔ)，由控制模塊發(fā)送的PWM波進行控制。

圖4.1 系統(tǒng)流程圖

4.主要算法及實現(xiàn)

4.1 算法設(shè)計

硬件結(jié)構(gòu)作為機械臂的身體構(gòu)架支持著整個系統(tǒng)的運行。而軟件方面作為機械臂控制系統(tǒng)的大腦中樞，統(tǒng)籌著身體和思維進行正確的判斷和運作。軟件部分的優(yōu)劣影響著整個機械臂控制系統(tǒng)的運行流暢性、穩(wěn)定性和整體功能的發(fā)揮。因此程序設(shè)計十分重要，需要滿足整體系統(tǒng)的基本需要，主要包括以下幾點：（1）實時性：因為在控制器控制手臂時，要實現(xiàn)對手臂的實時控制，需要確保數(shù)據(jù)的實時性，并且只有整體的實時才可以保證機械臂操作系統(tǒng)在工作的時候不會出現(xiàn)死區(qū)等故障問題。（2）穩(wěn)定性：穩(wěn)定性是指系統(tǒng)在運行過程中，為了防止故障發(fā)生，以及出現(xiàn)故障后的自我解決故障的能力。因此，為了提高系統(tǒng)的穩(wěn)定性，在進行設(shè)計的時候必須要考慮到運行時可能出現(xiàn)的不正?，F(xiàn)象。（3）再開發(fā)性：好的程序設(shè)計不是一次設(shè)計和調(diào)試就可以正常運行的，而總是伴隨著一邊調(diào)試一邊更改的過程，經(jīng)過多次修改后才能達到系統(tǒng)的要求。所以在開發(fā)的過程時，就應(yīng)當有好的結(jié)構(gòu)，以便于程序的再調(diào)試，并確保程序具有結(jié)構(gòu)簡單、思路清晰的優(yōu)點。

對于如何使系統(tǒng)的運行，更加的順利以及實現(xiàn)更多的功能，本文的機械臂控制系統(tǒng)的程序設(shè)計采用的是分層化結(jié)構(gòu)設(shè)計，其中含有系統(tǒng)時鐘與Systick定時器模塊，串口采集模塊，串口發(fā)送模塊，定時器模塊，計算器模塊?；镜某绦蛴谐绦虺跏蓟菏鼓K都處于可以被使用的狀態(tài)，自動運行：各模塊按照程序進行運作，手動操作：根據(jù)無線模塊獲取的信息進行處理后發(fā)送至舵機。流程圖如圖4.1所示。

5.結(jié)論

通過實驗證明：本文設(shè)計的機械臂控制系統(tǒng)，可以勝任中小型機器人控制器的要求，具有控制準確度高、操作方便、動作靈活等方面的優(yōu)良表現(xiàn)。然而仍有一些不足需喲改進，主要有：

（1）機械臂的改造。作為系統(tǒng)的主要受控對象，需要其有著優(yōu)越的穩(wěn)定性才能達到更加精準的控制。本文的機械臂的爪部有待改進，例如加入壓力傳感器可以更好的完成抓取的動作。

（2）算法的完善：對算法的冗余和處理方面進行改進，可以有效的改善機械臂的運作，例如調(diào)整：輸入?yún)?shù)和如何輸出更加精準的PMW波。

基于上述問題，在今后的時間里，我們將會不斷的修改以加強機械臂的穩(wěn)定性和可靠性。參考文獻

[1]焦保存.基于四自由度機械臂控制系統(tǒng)的設(shè)計與研究[D].西安:西安電子科技大學(xué),2009:5.

[2]李磊.六自由度機械臂控制系統(tǒng)設(shè)計[D].哈爾濱:哈爾濱工程大學(xué),2007:66.

[3]程立艷.五自由度機械手的抓取設(shè)計[D].成都:西華大學(xué),2012:51.

[4]ST Microelectronics 數(shù)據(jù)手冊 STM32G103XCSTM32G103xD

STM32G103XE[EB/QL].http://www.st.com.

[5]ST Microelectronics STM32F101xx,STM32F102xx,STM32F103xx,ST M32F105xx和STM32F107xx,ARM內(nèi)核32位高性能微控制器參考手冊.

[6]黃智偉,王兵,朱衛(wèi)華.STM32F32位ARM微控制器應(yīng)用設(shè)計與實踐[M].北京:北京航空航天大學(xué)出版社,2012:3-4.

[7]鄭珊珊.基于ARM處理器的鉆孔機械臂控制系統(tǒng)研究[D].南昌：江西理工大學(xué)，2009:5-6.

[8]庫少平,劉晶.基于STM32F10x和MDK的步進電機控制系統(tǒng)設(shè)計[J].武漢理工大學(xué),2011:7.

[9]曹歡.基于ARM和FPGA的多自由度機械臂控制系統(tǒng)設(shè)計[D].上海:華東理工大學(xué),2011:7.

和青芳，指導(dǎo)教師。

鳴謝：該項目的研究成果基于北京聯(lián)合大學(xué)“啟明星”大學(xué)生科技創(chuàng)新項目經(jīng)費資助，項目編號：201611417SJ096。