基于AT89C51單片機的四自由度機械手設計

張小波，潘振，李宜汀，楊肖委

(1.貴州虹山虹飛軸承有限責任公司，貴州安順561000；2.貴州大學，貴州貴陽550000)

?

基于AT89C51單片機的四自由度機械手設計

張小波1，潘振2，李宜汀2，楊肖委2

(1.貴州虹山虹飛軸承有限責任公司，貴州安順561000；2.貴州大學，貴州貴陽550000)

摘要：在介紹了機械手應用前景的基礎上，著重的進行了四自由度機械手控制系統(tǒng)的軟、硬件設計，其控制核心是AT89C51單片機。由于51單片機的經(jīng)濟靈活性[1]，使機械手控制系統(tǒng)的后期修改維護更加方便快捷。

關(guān)鍵詞:機械手AT89C51單片機四自由度舵機光電傳感器

0引言

機械手是一種模仿人手動作，并按設定程序、軌跡和要求代替人手抓取、搬運工件的自動化裝置[2]。近年來，我國工業(yè)自動化水平不斷提高，工業(yè)機械手以其作業(yè)準確、較高的環(huán)境適應能力以及替代人工繁重勞動的能力等特點，廣泛的應用于機械制造、電子、輕工等企業(yè)[3]。機械手的運用涉及到機械原理、計算機控制、傳感器技術(shù)等領域，其核心部分是機械手的控制系統(tǒng)[4]。目前市場上控制系統(tǒng)一般最常采用的是繼電器控制、PLC控制等，繼電器控制系統(tǒng)因設計復雜、可靠性差等問題逐漸被淘汰，而PLC控制系統(tǒng)相對來說成本高，且PLC體系結(jié)構(gòu)是封閉的，各PLC廠家的硬件體系互不兼容，編程語言及指令也各異，不利于機械手的后期維護[5]。而采用AT89C51單片機作為機械手的核心控制系統(tǒng)，既可以保證機械手可靠穩(wěn)定的運作，又可以降低設備成本。

1四自由度機械手結(jié)構(gòu)及控制要求

圖1　四自由度機械手

四自由度機械手結(jié)構(gòu)如圖1所示，四自由度分別是指舵機1控制的機械手整體的旋轉(zhuǎn)(-90°～+90°)，舵機2控制的短臂的旋轉(zhuǎn)(短臂擺長88 mm，旋轉(zhuǎn)132°)，舵機3控制的長臂的旋轉(zhuǎn)(長臂擺長92 mm，旋轉(zhuǎn)132°)，舵機4控制的爪子的夾持(夾持寬39 mm)。擺臂展開全長220 mm。系統(tǒng)控制要求：機械手將A點的工件搬運到B點，A點處有一個紅外光電傳感器，當光電傳感器沒有檢測到A點處有工件時，機械手保持在設定好的初始位置，當光電傳感器檢測到工件時，機械手從初始位置運動到A點，將工件夾持起來后搬運到B點，在接收到光電傳感器再次發(fā)送檢測到工件的信號之前，機械手恢復到初始位置，等待下一次光電傳感器發(fā)送動作信號。

2控制系統(tǒng)硬件設計

四自由度機械手控制系統(tǒng)核心采用AT89C51單片機，AT89C51是一種帶4 K字節(jié)FLASH存儲器(FPEROM—Flash Programmable and Erasable Read Only Memory)的低電壓、高性能CMOS 8位微處理器[6]，128字節(jié)內(nèi)部RAM，32 個I/O 口線，兩個16位定時/計數(shù)器，一個5向量兩級中斷結(jié)構(gòu)，一個全雙工串行通信口，片內(nèi)含有振蕩器及時鐘電路[7]。與工業(yè)標準的MCS-51指令集和輸出管腳相兼容[8]。由于將多功能8位CPU和閃速存儲器組合在單個芯片中，ATMEL的AT89C51是一種高效微控制器[9]。

四自由度機械手控制系統(tǒng)電源VCC 為+5 V 直流電源，紅外光電傳感器選擇的型號為E18-D80NK(檢測角度小于等于15°，有效距離30 mm～800 mm可調(diào))，舵機選擇銀燕ES08DE的微型數(shù)字舵機(扭力2.7×10-3kgf·m，速度0.08 Sec/60°)。選擇數(shù)字舵機的優(yōu)點是，在通電的情況下，即使沒有PWM信號輸入，舵機也會保持原始位置不變并且具有自鎖功能。選擇好舵機和光電傳感器以后，利于PROTUSE軟件設計控制系統(tǒng)電路并導入事先編寫好的程序進行電路仿真，通過電路仿真的結(jié)果驗證了電路設計和編寫的程序的正確性。系統(tǒng)的電路圖如圖2所示。

圖2　控制系統(tǒng)電路原理圖

3控制系統(tǒng)程序設計

本文四自由度機械手的控制系統(tǒng)主要由主程序、延時子程序、定時器初始化子程序、機械手動作子程序、報警子程序和定時中斷子程序組成。

圖3　定時器0中斷子程序

其中，報警子程序的功能是在機械手因為外界干擾導致程序運行錯誤時，發(fā)出蜂鳴聲自動報警。定時子程序的功能最為關(guān)鍵(圖3)，它的主要功能是設定PWM周期信號的脈沖寬度，從而調(diào)節(jié)舵機的轉(zhuǎn)角，可以通過改變a的值就可以調(diào)節(jié)脈沖寬度，a的取值范圍為500～2 500，對應控制舵機的脈沖信號寬度范圍0.5 ms～2.5 ms。銀燕ES08DE微型數(shù)字舵機的脈沖寬度調(diào)節(jié)范圍為0.5 ms～2.5 ms ，分別比例的對應舵機-90°到+90°的轉(zhuǎn)角，脈沖信號的周期為20 ms。型號為E18-D80NK的光電傳感器在檢測到工件時，信號端輸出低電平，當沒有檢測到工件時，信號端保持高電平。舵機M1、M2、M3、M4信號端分別連接單片機P0.0、P0.1、P0.2、P0.3的I/O口，光電傳感器信號端連接P0.7的I/O口。

圖4　控制舵機速度的For循環(huán)

值得注意的一點，由于舵機響應速度很快(0.08 Sec/60°)，為避免機械手動作速度過快，由于慣性作用甩飛工件或者破壞機械手的結(jié)構(gòu)，必須在編寫程序的時候注意控制機械手的響應速度，在保證工作效率的基礎上盡量使機械手慢慢的勻速動作。可以通過在機械手的動作子程序中間加一個for循環(huán)控制舵機的響應速度(圖4)。

單片機通電以后，程序首先對單片機初始化，然后定時器0初始化，并且給定時器0賦初值，此時定時器0開始計數(shù)，定時器0溢出后進入中斷子程序，在中斷子程序中再次給定時器0賦值，定時器0開始計數(shù)到定時器0溢出的時間間隔即為PWM周期信號的脈沖寬度，在光電傳感器檢測到工件之前(光電傳感器信號端保持高電平)的該脈沖寬度的PWM信號控制四個舵機使機械手處于初始位置。一旦光電傳感器檢測到工件時，光電傳感器的信號端輸出低電平，單片機P0.7口電平跳變成低電平，此時單片機控制四個舵機做相應的動作，使機械手把工件從A點搬運到B點。搬運完成以后機械手恢復到初始位置，等待光電傳感器發(fā)出下一步的動作信號。在整個程序的運行過程中，因為外界的干擾而使機械手程序運行出錯時，單片機會發(fā)出蜂鳴聲，做出警告。流程圖如圖5所示。

4程序調(diào)試

程序設計完成以后，首先將程序?qū)氲絇ROTUSE的仿真電路中的AT89C51單片機中，通過調(diào)節(jié)四個舵機PWM信號的脈沖寬度(即定時器0計數(shù)數(shù)值)，改變a的參數(shù)來慢慢調(diào)試機械手舵機的轉(zhuǎn)角，當四個舵機都調(diào)試到預定的轉(zhuǎn)角以后，程序初步調(diào)試完成。然后通過KEIL軟件把程序下載到組裝好的機械手的單片機中。安裝好機械手各個零部件，正確的將四個舵機和光電傳感器連接到單片機的I/O口上。一切準備就緒后，給單片機通+5 V的直流電，首先檢查光電傳感器和四個舵機是否能正常工作，保證正常工作以后，再慢慢調(diào)節(jié)PWM信號的脈沖寬度，避免調(diào)節(jié)舵機轉(zhuǎn)角過大而破壞機械手的結(jié)構(gòu)。使四個舵機的轉(zhuǎn)角能夠帶動機械手運動到滿足要求的位置，程序調(diào)試完成。

5結(jié)語

程序調(diào)試完畢以后，打開機械手的電源，機械手保持在設定好的初始位置。當A點的傳感器沒有檢測到工件時，機械手保持在初始位置不動，當A點的傳感器檢測到有工件時，機械手立刻從初始位置動作到A點并夾持工件，停頓1 s后機械手夾持著工件運動到B點并放下工件，停頓1 s后機械手返回到初始位置，繼續(xù)等待傳感器發(fā)出下一個動作信號。

通過對四自由度機械手控制系統(tǒng)的研究和調(diào)試，以AT89C51單片機為核心的控制系統(tǒng)完全能夠?qū)崿F(xiàn)對四自由度機械手的動作控制。51單片機由于其原理簡單、性能穩(wěn)定，應用廣泛是實現(xiàn)機械手動作路線及其他復雜運動的有效方法之一，并且使用51單片機作為機械手的控制核心，可以大大節(jié)約開發(fā)成本。51單片機同時支持匯編語言和C語言編程，C語言是一門通用計算機編程語言，編程簡單，應用廣泛。本文以C語言作為編程語言方便后期修改控制方案和程序，大大簡化機械手的設計過程。

綜上所述，本文設計的四自由度機械手經(jīng)過調(diào)試以后完全能夠?qū)崿F(xiàn)預定的動作路線，動作順暢，工件能夠準確到達指定位置。在程序中加入了控制舵機響應速度的FOR循環(huán)程序有效的避免了工件在機械手的搬運過程中出現(xiàn)掉落或者甩飛的情況。利用AT89C51單片機作為機械手的控制核心完全滿足設計要求，能夠?qū)崿F(xiàn)對機械手的動作控制。

參考文獻

[1]黃海松.基于單片機的物料搬運機械手的控制系統(tǒng)研究[J].機電工程技術(shù),2007,36(11):21-23.

[2]陳林祥,王正初.基于51單片機的三自由度氣動機械手控制系統(tǒng)的設計[J].機電產(chǎn)品開發(fā)與創(chuàng)新,2015,28(1):87-88.

[3]李祥陽,陳萬強,曹海泉,等.基于AT89C51單片機備料機械手單步控制系統(tǒng)的硬件設計[J].工業(yè)儀表與自動化裝置,2012(5)64-66.

[4]郭天祥.新概念51單片機C語言教程[M].北京:電子工業(yè)出版社,2009.

[5]譚孝輝.電路設計與仿真[M].成都:電子科大出版社,2009.

[6]耿洪興,張樂年,譚堅紅，等.基于STC單片機的機械手運動控制研究[J].機械制造與自動化,2010,39(5):150-152.

[7]聞鴻鵬,王勁松,高猛.搬運機械手控制系統(tǒng)的研究[J].機械與電子,2011(9)66-68.

[8]蔡軍,黎蘭萍,王蓓.基于單片機的機械手控制系統(tǒng)研究[J].科技信息,2009(33)424-425.

[9]楊冬進,張燕.基于單片機控制的自動蘋果采摘機設計[J].農(nóng)機化研究,2015(2)28-31.

Design of a four-degree-of-freedom manipulator based on AT89C51 microcontroller

ZHANG Xiaobo，PAN Zhen，LI Yiting，YANG Xiaowei

Abstract:In this paper, we introduced the prospect of the application of manipulators, and focused on the design of the software and hardware of a four-degree-of-freedom manipulator. The control core of the manipulator was AT89C51 microcontroller, which was economic and flexible, and enabled more convenient and efficient modification and maintenance of the control system of the manipulator.

Keywords:manipulator; AT89C51 microcontroller; four degrees of freedom; steering gear; photoelectric sensor

收稿日期：2015-09-08

作者簡介：張小波(1987-)，男，籍貫貴州三都，就職于貴州虹山虹飛軸承有限責任公司，主要從事機械設計制造方面的工作。

中圖分類號：TP241.2

文獻標識碼：A

文章編號：1002-6886(2016)02-0088-04