鉆孔機械臂控制體系硬件設(shè)計與實現(xiàn)

前言：想要寫出一篇引人入勝的文章？我們特意為您整理了鉆孔機械臂控制體系硬件設(shè)計與實現(xiàn)范文，希望能給你帶來靈感和參考，敬請閱讀。

0緒論

工業(yè)機械臂（以下簡稱機械臂）是近代自動控制領(lǐng)域中出現(xiàn)的一項新技術(shù)，作為多學(xué)科融合的邊沿學(xué)科，它是當(dāng)今高技術(shù)發(fā)展最快的領(lǐng)域之一，并已成為現(xiàn)代機械制造生產(chǎn)系統(tǒng)中的一個重要組成部分。隨著機器人系統(tǒng)設(shè)計應(yīng)用的復(fù)雜化以及機器人系統(tǒng)對控制精度、實時性能、可靠性的要求不斷變高，需要給機械設(shè)備裝備嵌入式操作系統(tǒng)。嵌入式系統(tǒng)應(yīng)用于機械的控制，將是機器控制領(lǐng)域的一個發(fā)展方向，為機器的智能控制的實現(xiàn)提供了廣闊的平臺。與傳統(tǒng)的微處理器和DSP相比，ARM微處理器資源豐富，具有很好的通用性，其主要技術(shù)優(yōu)點是高性能、低價格、低功耗，可以廣泛的應(yīng)用于各個領(lǐng)域，因此將ARM應(yīng)用于機械臂控制系統(tǒng)不失為一種好的策略。

1機械臂功能設(shè)計

本文主要研究的是單臂式鉆孔機械臂，這種機械臂需要完成的動作有：前行、后行、左行、右行、上行、下行。這些動作相互結(jié)合，完成相應(yīng)的動作安排。根據(jù)上述動作要求，工藝流程如下：(1)本文研究的機器臂主要由底座(或軀干)、機械臂構(gòu)成。底座的主要任務(wù)是支撐和完成手臂上下左右的移動，實現(xiàn)機械臂在工作空間中的活動；(2)機械臂的底座固定不動，機械臂的Y軸由伺服電機驅(qū)動在平行于底座的平面進(jìn)行前后運動，即是在Y軸平面中的運動；(3)X軸在上位機對伺服驅(qū)動器發(fā)出指令后和Y軸同時移動，進(jìn)行左右的運動，即在X軸平面中的運動，同時運動就可以實現(xiàn)機械臂在X-Y平面上的精確定位；(4)在X軸上安裝一個氣動式動力頭，當(dāng)在X-Y平面上精確定位之后，處理器通過控制電磁閥動力頭進(jìn)給，帶動鉆頭旋轉(zhuǎn)進(jìn)行既定的鉆孔?？偨Y(jié)歸納可知，X-Y軸用于機械臂鉆孔的定位，Z軸做往復(fù)運動進(jìn)行鉆孔；(5)機械臂完成上位機發(fā)出的脈沖指令，回到機械原點，等待下一次的指令。

工作過程如下：上位機對控制機發(fā)出脈沖指令，電機控制系統(tǒng)從控制器中獲取指令數(shù)據(jù)，傳感器系統(tǒng)檢測在機械臂工作的范圍之內(nèi)有無障礙物，確定無障礙后開始動作，在系統(tǒng)運行中與電機同軸度編碼器實時反饋機械臂所到達(dá)的位置，以判斷是否完成規(guī)定動作。當(dāng)控制器接受編碼器反饋的數(shù)據(jù)判斷出規(guī)定動作完成后系統(tǒng)暫停動作，等待下一次指令。為了使機械臂在接受到指令后高速準(zhǔn)確的完成動作，本設(shè)計在硬件上采用了伺服驅(qū)動系統(tǒng)，軟件上采用模糊控制算法。電機驅(qū)動系統(tǒng)由ARM處理器及其相關(guān)外圍硬件和電機驅(qū)動器組成，ARM處理器發(fā)出指令脈沖下達(dá)給伺服驅(qū)動器，電機驅(qū)動器驅(qū)動電機運轉(zhuǎn)，運行期間，ARM處理器根據(jù)編碼器反饋的信息判斷機械臂的運動狀態(tài)，實現(xiàn)實時跟蹤定位和位置定位。

2模糊控制算法在ARM控制系統(tǒng)中的實現(xiàn)

2.1輸入量模糊化

模糊控制算法用在ARM中,則需使用在ARM中可以運行的軟件實現(xiàn)模糊控制，這樣就把能將原來的數(shù)字控制器改成模糊控制器，從而構(gòu)成了一個基于ARM的模糊控制系統(tǒng)。由此可見，這種模糊控制器在本質(zhì)上只是一種控制算法與硬件的結(jié)合，與其它的模糊算法的差別在于用ARM的語言來實現(xiàn)模糊化、模糊推理決策以及反模糊化過程。這種模糊控制器的優(yōu)點是資源消耗少，靈活性高，通用性強，應(yīng)用范圍廣等。必須注意的是設(shè)計過程中要考慮到ARM的內(nèi)存空間，運算速度，以及模糊算法的執(zhí)行效率和系統(tǒng)的實時性要求。在模糊控制器中，給定目標(biāo)為r，將光電編碼器檢測到的電機轉(zhuǎn)速作為反饋輸入。然后計算得到轉(zhuǎn)速偏差e(k)和轉(zhuǎn)速偏差變化率Δe(k)，量化和模糊化后作為模糊控制器的兩個輸入信號，反模糊后得到精確的PID參數(shù)，經(jīng)過PID運算得到電機控制信號，此控制信號經(jīng)過進(jìn)一步的轉(zhuǎn)換，可得到PWM控制寄存器的設(shè)定值，寫入PWM寄存器后，從ARM的PWM輸出端口將得到相應(yīng)的PWM控制信號，經(jīng)過驅(qū)動器驅(qū)動伺服電機，使鉆孔機械臂達(dá)到計算機的控制運動要求。在機械臂硬件平臺控制系統(tǒng)中,計算機通過串口與ARM處理器通信,發(fā)送控制命令控制機械臂的運動狀態(tài)。用編碼器檢測電機的旋轉(zhuǎn)速度。

電機轉(zhuǎn)速的誤差:式中：n是當(dāng)前電機轉(zhuǎn)速；n0是t0時刻對應(yīng)的電機轉(zhuǎn)速;當(dāng)上次的電機轉(zhuǎn)速為e(k-1)時，當(dāng)前電機轉(zhuǎn)速的誤差變化為：根據(jù)e(k),Δe(k)的隸屬度函數(shù)可知，我們必須把由上式計算得到的誤差和誤差變化率進(jìn)行處理,使他們的值落在[-3,3]區(qū)間,再進(jìn)行模糊化處理,才能進(jìn)行模糊控制器運算。經(jīng)過反復(fù)的試驗,可以得到e(k),Δe(k)的最大值,分別為em,Δem由此我們進(jìn)行歸一化公式:當(dāng)出現(xiàn)測量值大于我們的最大值時，我們就將其視為最大值em的值，所以以上公式是普適用的。

2.2建立機械臂模糊控制規(guī)則表

模糊控制規(guī)則在模糊控制系統(tǒng)中，是一種根據(jù)控制量偏差和控制量偏差變化率而推斷出輸出量的推理規(guī)則。這些規(guī)則是由誤差和誤差變化率狀態(tài)的不同而形成的一系列條件語句。在模糊控制器選用單變量二維最常見的結(jié)構(gòu)形式，設(shè)定誤差e,誤差變化ec及控制量輸出u的模糊子集為｛負(fù)大,負(fù)中,負(fù)小,零,正小,正中,正大｝，并簡記為{NB,NM,NS,Z,PS,PM,PB}，論域均定為[-3,3],模糊子集NB,PB分別選為Z型隸屬函數(shù)和S型隸屬函數(shù)，其余選為靈敏度高且在論域范圍內(nèi)均勻分布，等距離的三角形隸屬函數(shù)。由于三角形隸屬函數(shù)簡單易行，計算效率高，且僅與直線的形狀有關(guān)，適合于實時控制和在線調(diào)整的控制，因此，本模糊控制器的輸入輸出隸屬度函數(shù)曲線如圖1所示。

3鉆孔機械臂控制系統(tǒng)硬件設(shè)計與實現(xiàn)

3.1LPC2138處理器

ARM內(nèi)核采用精簡指令集計算機（RISC）體系結(jié)構(gòu)，具有大量的通用寄存器，指令格式使用統(tǒng)一和長度固定，尋址方式簡單，內(nèi)含2套指令系統(tǒng)（ARM指令集和Thumb指令集）。極低的功耗，適合對功耗要求較高的應(yīng)用，如便攜式產(chǎn)品。能夠提供0.9MIPS/MHz的三級流水線結(jié)構(gòu)。

3.2傳感器模塊

本課題研究的鉆孔機械臂是一個用于加工的機械裝備，當(dāng)上位機設(shè)定好要加工的參數(shù)且啟動機械臂臂進(jìn)行加工時，為了防止有意外的發(fā)生，需要加一些傳感器進(jìn)行保護(hù)，當(dāng)檢測到有人或物進(jìn)入到機械臂加工的范圍之內(nèi)時，傳感器將檢測到的信號反饋給處理器，進(jìn)行相應(yīng)的動作。

（1）位置傳感器：即行程開關(guān)，在X軸和Y軸上都裝有3個行程開關(guān)，在Z軸的上下位置也裝有兩個行程開關(guān)，本系統(tǒng)中選用無觸點感應(yīng)式行程開關(guān)，兩線制傳感器，型號為TL-05MD1。原理：無觸點行程開關(guān)又稱接近開關(guān)，它可以代替有觸頭行程開關(guān)來完成行程控制和限位保護(hù)，還可用于高頻計數(shù)、測速、液位控制、零件尺寸檢測、加工程序的自動銜接等的非接觸式開關(guān)。由于它具有非接觸式觸發(fā)、動作速度快、可在不同的檢測距離內(nèi)動作、發(fā)出的信號穩(wěn)定無脈動、工作穩(wěn)定可靠、壽命長、重復(fù)定位精度高以及能適應(yīng)惡劣的工作環(huán)境等特點，所以在機床、紡織、印刷、塑料等工業(yè)生產(chǎn)中應(yīng)用廣泛。無觸點行程開關(guān)分為有源型和無源型兩種，多數(shù)無觸點行程開關(guān)為有源型，主要包括檢測元件、放大電路、輸出驅(qū)動電路3部分，一般采用5V～24V的直流電流，或220V交流電源等。當(dāng)被控物體到位,電子行程開關(guān)動作，常開組導(dǎo)通(閉合)常閉組截止,(斷開)。完成相應(yīng)的動作。

（2）光電編碼器：由伺服電機驅(qū)動器獨立控制。

（3）紅外光柵傳感器又稱為安全性光柵安全性光柵是一種保護(hù)各種危險機械裝備周圍工作人員的先進(jìn)技術(shù)。同傳統(tǒng)的安全措施，比如機械柵欄、滑動門、回拉限制等來相比，安全性光柵更自由，更靈活，并且可以降低操作者疲勞程度。通過合理地減少對實體保護(hù)的需求，安全性光柵簡化了那些常規(guī)任務(wù)，如設(shè)備的安裝、維護(hù)以及維修。

4總結(jié)

本文在分析機械臂嵌入式控制體系的基礎(chǔ)上，進(jìn)行了以LPC2138為主控制器的嵌入式系統(tǒng)硬件平臺設(shè)計。合理規(guī)劃機械臂的任務(wù)模塊，設(shè)計應(yīng)用程序，實現(xiàn)對各功能子系統(tǒng)的數(shù)據(jù)通信、控制管理。本文只對機械臂底層控制系統(tǒng)進(jìn)行研究設(shè)計并介紹。因此，真正的實現(xiàn)伺服電機的精確控制還需要進(jìn)一步要有專業(yè)人員研究。