機械臂控制系統(tǒng)的研究與設(shè)計

王若愚，盧小康，陳蘇明

(中國礦業(yè)大學徐海學院，江蘇 徐州 221008)

1 設(shè)計概述

針對目前常用的機械臂控制方式存在的操作復雜、靈活性差、靈敏度低、控制精度低等問題設(shè)計了一種通過人體手勢來控制機械臂運動的系統(tǒng)。此系統(tǒng)基于圖像識別技術(shù)，采用卷積神經(jīng)網(wǎng)絡(luò)并結(jié)合C++語言和Python語言，設(shè)備的組成由1個二維RGB攝像頭和1個三維深度攝像頭組合成視覺運動傳感器，并結(jié)合機械臂運動控制算法，使機械臂完成相應的人體手勢仿生動作。此手勢控制機械臂系統(tǒng)的操作簡單靈活、可以實現(xiàn)遠程控制，經(jīng)測試結(jié)果表明控制精度滿足系統(tǒng)穩(wěn)定性和精確控制的要求。因此可以廣泛應用在軍事和醫(yī)學中，如炸彈拆除，即拆彈人員通過遠程操控機械手完成拆彈工作，從而保證拆彈人員的安全；對于一些醫(yī)學手術(shù)可以利用手勢控制機械手臂遠程執(zhí)行解決偏遠地區(qū)醫(yī)學落后問題。

2 方案設(shè)計

本手勢運動控制數(shù)據(jù)處理系統(tǒng)的主要特點之一就是用了多信息系統(tǒng)互相融合的數(shù)據(jù)處理技術(shù)，同時采集和提取了有關(guān)用戶手臂和二維深度手部的運動姿態(tài)和三維深度的運動狀態(tài)變化的數(shù)據(jù)和信息。1個二維rgb深度運動攝像頭和1個三維tof兩個深度運動攝像頭組成一個獨立的視覺運動傳感器，采集有關(guān)用戶機械臂和手部的二維深度圖像進行信息處理與三維深度的運動攝像頭信息，然后將其發(fā)送至一臺計算機端口進行數(shù)據(jù)處理，同時單片機可以準確和持續(xù)地追蹤用戶手部的二維深度運動狀態(tài)情況，通過串口數(shù)據(jù)通信將一臺計算機端數(shù)據(jù)處理得到的二維深度手勢的控制指令和三維深度的運動攝像頭信息分別傳送至單片機進行解析和轉(zhuǎn)換，將機械臂手勢的控制和運動指令集解析轉(zhuǎn)換成為兩個機械臂各自由度的運動指令集，經(jīng)過單片機發(fā)送給相應的機械臂舵機，從而實現(xiàn)通過用戶手勢的運動來達到控制整個機械臂運動的目的。

此方案采用手勢來達到靈活控制機械臂的效果，既可以實現(xiàn)遠程控制、又可以使控制指令的方法簡單、方便工人操作；此外，還在機械臂爪端搭載了壓力傳感器，可以及時反饋被抓物體的信息，調(diào)整抓取方式。

3 硬件設(shè)計

基于圖像識別的機械臂手勢控制系統(tǒng)包括單片機控制系統(tǒng)、舵機模塊、電源模塊、視覺傳感器模塊、串口通信模塊等系統(tǒng)模塊。

3.1 單片機控制系統(tǒng)

為了能夠更好控制機械臂精準地完成工作，本設(shè)計的機械臂控制系統(tǒng)采用stm32f103zet6微處理器作為控制芯片，該單片機內(nèi)置有晶振以及高可靠復位系統(tǒng)，該芯片與目前市場上傳統(tǒng)的51單片機相比，具有系統(tǒng)功耗小，運算處理能力大大增強等諸多優(yōu)點。此外在機械爪端集成壓力傳感器可以實時檢測抓取物體的抓取力量從而及時對抓取方式進行調(diào)整。

本系統(tǒng)的基本工作原理：STM32處理器內(nèi)部本身具有的pwm單元可產(chǎn)生pwm波信號，此種信號驅(qū)動電機運動，依據(jù)stm32f103zet6微控制器輸出的pwm信號和舵機輸出信號的的頻率和占空比來控制舵機的運動狀態(tài)，此種控制方式更加簡單、準確。

3.2 電源模塊

此機械臂手勢控制系統(tǒng)主要采用雙電源直流穩(wěn)壓供電的工作模式，stm32單片機經(jīng)過一個AMS1117-3.3 V穩(wěn)壓芯片進行供電，舵機驅(qū)動模塊選用7.2 V可充電電池經(jīng)LM2596 dc-dc可調(diào)降壓模塊進行供電。

3.3 視覺傳感器模塊

采用1個二維采集圖像顏色信息的攝像頭和三維采集深度的攝像頭控制模塊組成視覺傳感器模塊，此模塊用來采集用戶手部的二維圖像顏色信息與三維深度圖像顏色信息并將其發(fā)送至計算機端進行數(shù)據(jù)處理。并將這些數(shù)據(jù)進行整合，從而轉(zhuǎn)換成機械臂運動的指令集，并通過通信子網(wǎng)絡(luò)傳送至機械臂，從而可以實現(xiàn)機械臂與人體手勢同步運動的狀態(tài)。

3.4 舵機模塊

可通過STM32處理器內(nèi)部發(fā)出的pwm信號來控制舵機的旋轉(zhuǎn)角度，不同類型的舵機最大可以旋轉(zhuǎn)的角度是不相同的，但是其中間位置的脈沖寬度都是1.5 ms。在選擇舵機時主要考慮的因素是扭矩的大小，本設(shè)計選用的60 kg超大扭力雙軸數(shù)字電機，具精度高、虛位小、扭力大的特點，可以很好地保證機械臂的運行。

3.5 串口通信模塊

串口只是無線通信的一種方式，它是指外部設(shè)備和計算機之間，通過微機數(shù)據(jù)信號線 、地線和控制縱向線等，按一定位置轉(zhuǎn)換順序相互進行直接傳送數(shù)據(jù)的一種通用無線通信的通信方式。這種通信方式使用的數(shù)據(jù)線少并且能夠?qū)崿F(xiàn)遠距離通信，所以本設(shè)計采用串口與系統(tǒng)中的單片機進行串口通信以此達到控制機械臂的目的。

4 軟件設(shè)計

4.1 系統(tǒng)軟件總體程序組成

本作品由手勢位置提取、基于Python的深度學習的樣本特征提取、手勢信息處理及機械臂舵機指令轉(zhuǎn)換、機械臂控制和壓力檢測部分等若干子部分組成。

4.2 圖像識別程序設(shè)計

在機械臂手勢識別系統(tǒng)開始運行之前，在網(wǎng)絡(luò)上采集了大量的手部和臂膀不同姿態(tài)和形狀下的機械臂圖片并對其進行了分類。為了更進一步提高機械臂圖片的識別率，從不同運動角度、遠近程度和運動方向?qū)C械臂手勢特征和運動進行來數(shù)據(jù)分析，然后通過卷積神經(jīng)網(wǎng)絡(luò)自動提取機械臂手勢的特征，并為進行下一次的機械臂手勢特征識別訓練提供了判斷的依據(jù)，當機械臂的手勢特征點識別成功后，系統(tǒng)會自動計算當前機械臂手勢在特征點中心的二維深度和坐標，然后計算機利用三維tof深度攝像頭自動計算特征點的深度和坐標。最后將上述機械臂手勢的特征類型、坐標點等信息進行融合，并將其轉(zhuǎn)換為特征點的機械臂6個自由度舵機的運動位置和控制指令，通過計算機串口發(fā)送給特征點的機械臂。如果特征點識別不成功，則重新再發(fā)送回到機械臂訓練的特征點。

4.3 機械臂控制程序設(shè)計

首先在機械臂控制系統(tǒng)上電后，對其進行系統(tǒng)初始化。機械臂的步進電機是由STM32內(nèi)部處理器具有的pwm信號來控制，因此需要控制stm32f103zet6芯片產(chǎn)生pwm信號，然后不間斷地監(jiān)測串口是否有信息傳入。在機械臂手指處添加了壓力傳感器，因此MCU可以及時檢測手指處的壓力。通過手指閉合時的壓力設(shè)置壓力閾值，當系統(tǒng)檢測到閉合時的壓力大于設(shè)置的壓力閾值時就不再繼續(xù)閉合，此時機械臂可以夾取相對脆弱的物體。

5 結(jié)語

利用圖像識別技術(shù)采集人體手勢運動的基本數(shù)據(jù)，通過串口傳輸給控制器進行數(shù)據(jù)處理，最后控制機械臂進行仿生運動。這種控制機械臂的方式能夠更加流暢和簡單，且經(jīng)過測試精確率達到98.5%可以滿足系統(tǒng)穩(wěn)定性和精確度。操控者可憑借此種機械臂控制方式減輕工作強度，進而提高工作效率。并且具有一定的抗外界干擾能力，避免了工作過程中發(fā)生碰撞現(xiàn)象，最終實現(xiàn)末端執(zhí)行精準控制?？稍诠I(yè)控制和服務領(lǐng)域進行推廣，具有良好的應用前景。