喜歡就充值下載吧。。。資源目錄里展示的全都有，，下載后全都有,,請放心下載，原稿可自行編輯修改【QQ：1304139763 可咨詢交流】=====================
喜歡就充值下載吧。。。資源目錄里展示的全都有，，下載后全都有,,請放心下載，原稿可自行編輯修改【QQ：414951605 可咨詢交流】=====================
山西工程技術(shù)學(xué)院
畢業(yè)設(shè)計說明書
畢業(yè)生姓名
：
梁興
專業(yè)
：
機械電子工程
學(xué)號
：
180533006
指導(dǎo)教師
：
張海
所屬系（部）
：
機械電子工程系
二〇二〇年五月 模塊式六自由度機器人控制系統(tǒng)設(shè)計
摘 要
近二十年來，機器人技術(shù)的發(fā)展非常迅速，各種用途機器人在各個領(lǐng)域獲得廣泛應(yīng)用。我國在機器人的應(yīng)用和研究方面與工業(yè)化發(fā)達國家相比還有一定差距，因此設(shè)計和研究各種用途的機器人特別是推廣機器人、工業(yè)機器人的應(yīng)用是有現(xiàn)實的意義。
典型的工業(yè)機器人例如噴裝配機器人、漆機器人、焊接機器人等大多是固定在加工設(shè)備旁邊或生產(chǎn)線作業(yè)的，本論文在參考大量的文獻資料的基礎(chǔ)上，結(jié)合了項目的要求，設(shè)計一種小型的、固定在AGV上的、以實現(xiàn)移動的串聯(lián)六自由度機器人。
首先，針對機器人設(shè)計要求提出了多個方案，并且對其進行分析和比較，選擇其中最優(yōu)的結(jié)構(gòu)設(shè)計方案;然后進行運動學(xué)分析，用D一H方法來建立坐標(biāo)變換矩陣，推算出運動方程的正解和逆解;用矢量積法推導(dǎo)速度雅可比矩陣，并計算包括腕點在內(nèi)的一些點的速度和位移;然后借助坐標(biāo)的變換矩陣進行工作空間的分析。這些工作為移動式機器人的運動控制、結(jié)構(gòu)設(shè)計和動力學(xué)分析提供了依據(jù)。
最后運用已有的六自由度機械手及其手爪的三維造型和裝配，將模型導(dǎo)入proteus中，并進行運動學(xué)仿真對其結(jié)果進行了分析，并且對在機械設(shè)計中使用的虛擬樣機技術(shù)做了嘗試，積累了經(jīng)驗。
關(guān)鍵詞:6自由度機器人；運動學(xué)分析；仿真；步進電動機；單片機；
Control system design of modular 6-DOF robot
Abstract
In the Past twenty years，the robot technology has been developed greatly and used in many different fields. There is a large gap between our country and the developed countries in research and application of the robot technology so that there will be a great value to study，design and applied different kinds of robots，especially industrial robots.
Most typical industrial robots such as welding robot，painting robot and assembly robot are all fixed on the product line or near the machining equipment when they are working. Based on larger number of relative literatures and combined with the need of project，the author have designed a kind of small一size serial robot with 6 degree of freedom which can be fixed on the AGV to construct a mobile robot.
First of all，several kinds of schemes were proposed according to the design demand. The best scheme was chosen after analysis and comparing and the structure was designed. At same time，The kinematics analysis was conducted，coordinate transformation matrix using D一H method was set up，and the kinematics equation direct solution and inverse solution was deduced，the matrix was constructed using vector product method，and the values displacement and velocity of some special point including the wrist point were calculated. Secondly，the working space of the robot was analyzed and the axes section of practical working space was drawn. These works provided a basis to structure design, kinematics and control.
At last do the completion of six degrees of freedom manipulator’s and gripper’s three-dimensional modeling and assembly. models will be imported in proteus, and do the simulation and kinematics, and the simulation result was analyzed. In the experiment，the author tried to use the virtual prototyping technology in mechanism design.
Key words: Six degrees of freedom robot;Kinematics Analysis; simulation;
目 錄
摘 要 I
1 緒論 1
1.1 機器人概述 1
1.2 模塊式六自由度機器人概述 1
1.3 主要研究內(nèi)容 3
2運動學(xué)分析 4
2.1 概述 4
2.2 運動學(xué)分析 4
2.2.1 空間機構(gòu)位置的描述 4
2.2.2 空間機構(gòu)中兩任意坐標(biāo)系的變換關(guān)系 9
2.2.3 工業(yè)機器人運動學(xué)方程 11
2.3 機構(gòu)的運動學(xué)分析 11
2.3.1 機構(gòu)尺寸參數(shù) 11
2.3.2 機構(gòu)的運動學(xué)方程 13
3 模塊式六自由度機器人控制系統(tǒng)硬件設(shè)計 15
3.1 總體控制方案設(shè)計 15
3.2 步進電機選取及控制設(shè)計 15
3.2.1 步進電機原理及控制技術(shù) 15
3.2.2 步進電機的換向控制 17
3.2.3 步進電機的選取 19
3.3 ULN2003驅(qū)動器 20
3.4 單片機的概述 23
3.5 89C51系列控制單片機設(shè)計與選擇 24
3.5.1 AT89C51簡介 27
3.5.2 AT89C51最小系統(tǒng) 31
3.5.3 AT89C51系統(tǒng)設(shè)計 32
4 模塊式六自由度機器人控制系統(tǒng)仿真設(shè)計 35
4.1 仿真軟件概述 35
4.1.1 protues簡介 35
4.1.2 Keil C51簡介 35
4.2 仿真系統(tǒng)設(shè)計 35
4.2.1 仿真系統(tǒng)組成 35
4.2.2 仿真系統(tǒng)程序設(shè)計 35
4.3 運行調(diào)試結(jié)果 36
總 結(jié) 37
參考文獻 38
附錄 40
致 謝 64
5
山西工程技術(shù)學(xué)院----畢業(yè)設(shè)計說明書
1 緒論
1.1 機器人概述
機器人是種能夠進行編程，并在自動控制下執(zhí)行移動作業(yè)任務(wù)或某種操作的機械裝置。
機器人技術(shù)綜合了電子工程、機械工程、人工智能、及計算機技術(shù)等多種科學(xué)的最新研究成果，是典型的機電一體化技術(shù)代表，是在當(dāng)代科技發(fā)展最活躍領(lǐng)域。機器人的制造研究與應(yīng)用正受到越來越多的工業(yè)國家的重視。近十幾年來，工業(yè)機器人技術(shù)發(fā)展非常迅速，各種工業(yè)機器人的在各個領(lǐng)域各種用途中獲得廣泛應(yīng)用。
1.2 模塊式六自由度機器人概述
1.2.1 機器人分類
關(guān)于機器人如何分類，在國際上沒有制定統(tǒng)一標(biāo)準(zhǔn)，有的按控制方式分，有的按負載重量分，有的按應(yīng)用領(lǐng)域分，有的按結(jié)構(gòu)分，有的按自由度分。一般的分類方式：多功能，有幾個自由度，操作型機器人，能自動控制，可固定或運動，可重復(fù)編程，用于相關(guān)自動化系統(tǒng)之中。程控型機器人，按預(yù)先要求的條件及順序，依次控制工業(yè)機器人的機械動作?！笆窘淘佻F(xiàn)型”機器人，可以通過引導(dǎo)或者其它方式，首先教會機器人執(zhí)行動作，輸入工作程序，則機器人可自動重復(fù)進行作業(yè)。感覺控制型機器人，通過傳感器獲取的信息來控制機器人的動作。數(shù)控型的機器人，不必使機器人動作，通過語言、數(shù)值等對機器人進行示教，根據(jù)機器人示教后的信息進行工作。適應(yīng)控制型機器人，機器人能適應(yīng)變化中環(huán)境，控制自身的行動。學(xué)習(xí)控制型機器人，具有一定的學(xué)習(xí)功能，機器人能“體會”工作的經(jīng)驗，并將所“學(xué)”的經(jīng)驗用于作業(yè)中。智能型機器人，以人工智能決定其機器人的行動。
1.2.2 自由度理論概述
自由度的概念:工業(yè)機器人的空間機構(gòu)一般都為多關(guān)節(jié)，其運動副通常有轉(zhuǎn)動副和移動副兩種。移動關(guān)節(jié)是以移動副相連的關(guān)節(jié)。相應(yīng)地，轉(zhuǎn)動關(guān)節(jié)是以轉(zhuǎn)動副相連的關(guān)節(jié)。在這些關(guān)節(jié)之中，單獨驅(qū)動的關(guān)節(jié)被稱為主動關(guān)節(jié)。主動關(guān)節(jié)的數(shù)目就是機器人的自由度。
由機械原理可知，機構(gòu)具有運動確定時必須所給定的獨立運動參數(shù)數(shù)目，稱為機構(gòu)的自由度（degree of freedom of mechanism），其數(shù)目通常表示為F。如果一個構(gòu)件組合體自由度F>0，他就可以稱為一個機構(gòu)，也就是表明各構(gòu)件間可有相對的運動；如果F=0，則表明它是一個結(jié)構(gòu)（structure），即已退化成為一個構(gòu)件。機構(gòu)自由度分為平面的機構(gòu)自由度和空間的機構(gòu)自由度。一個原動件只能提供一個獨立的參數(shù)。
1.2.3 模塊式六自由度機器人的應(yīng)用
六自由度機器人是一種典型工業(yè)機器人，在裝配、自動搬運、噴涂、焊接、等工業(yè)現(xiàn)場中有廣泛應(yīng)用。固高科技GRB系列的六自由度機器人是固高先進的設(shè)計與成熟完備的運動控制技術(shù)和教學(xué)理念有機結(jié)合的產(chǎn)物,它既滿足工業(yè)現(xiàn)場的要求，也是教學(xué)與科研機構(gòu)進行編程系統(tǒng)設(shè)計和運動規(guī)劃的理想對象。?
該機器人采用六關(guān)節(jié)的串聯(lián)結(jié)構(gòu)，各個關(guān)節(jié)以“精密諧波減速器+絕對編碼器電機”為傳動。在小臂處留有氣動工具、安裝攝像頭等外部設(shè)備的接口，并且提供備用的電氣接口，方便用戶進行功能的擴展。?
機器人控制方面，采用集成的PC技術(shù)、邏輯控制、圖像技術(shù)及具有專業(yè)運動控制技術(shù)的VME運動控制器，高速高精度，性能可靠穩(wěn)定。
工業(yè)機器人廣泛應(yīng)用于工業(yè)領(lǐng)域。工業(yè)機器人一般是指在工廠車間的環(huán)境中，配合自動化生產(chǎn)需要，代替人來完成零件或材料的加工、裝配、搬運等操作的一種工業(yè)機器人。工業(yè)機器人定義為:“一種可重復(fù)編程的、自動定位控制、多自由度、多功能的操作機。能搬運零件、材料或操持工具，用以完成各種作業(yè)?！?
操作機被定義為:“具有與人的手臂有相似的動作功能，可以在空間抓放物體或者進行其它操作的機械裝置?！?
一個典型的機器人系統(tǒng)由通訊接口、本體、計算機控制系統(tǒng)、傳感系統(tǒng)、關(guān)節(jié)伺服驅(qū)動系統(tǒng)等部分組成。一般多自由度的串聯(lián)機器人具有4～6個的自由度，其中2～3個自由度用來決定末端執(zhí)行器在空間的位置，其余的2～3個自由度用來決定了末端執(zhí)行器在空間的姿態(tài)。
1.3 主要研究內(nèi)容
通過查閱了大量的文獻資料，并且系統(tǒng)學(xué)習(xí)了機器人的技術(shù)知識，同時對國內(nèi)外的機器人，主要是對六自由度機器人的現(xiàn)狀有了比較詳細了解。在這個基礎(chǔ)上，結(jié)合了作者本人設(shè)想，和設(shè)計工作中需要解決的問題，主要進行以下幾項工作:
(1) 調(diào)研收集分析有關(guān)六自由度機器人的資料，總結(jié)其機構(gòu)與工作特點；
(2) 找到合適六自由度機器人的機構(gòu)方案；
(3) 模塊式六自由度機器人控制系統(tǒng)設(shè)計；
(4) 六自由度機器人運動學(xué)分析與仿真；
(5) 利用動力學(xué)分析軟件proteus對六自由度機器人模型進行運動學(xué)仿真，對在設(shè)計中使用虛擬樣機技術(shù)進行探索和嘗試。
2運動學(xué)分析
2.1 概述
多自由度機器人其實是具有多個關(guān)節(jié)空間機構(gòu)，為了描述在空間中末端執(zhí)行器的姿態(tài)和位置，可以建立一個坐標(biāo)系在每個關(guān)節(jié)上，利用坐標(biāo)系之間的關(guān)系去描述末端執(zhí)行器的位姿。
建立坐標(biāo)系的方法有很多種，常用的有D一H法(四參數(shù)法)和矩陣變換法及五參數(shù)法等。
D一H法(四參數(shù)法)是由Denavit和Hartenberg1955年提出的一種建立相對的位姿的矩陣方法。它用齊次變換來描述各個連桿相對于固定的參考系空間幾何關(guān)系，用一個4x4齊次變換矩陣來描述相臨兩連桿的空間關(guān)系，從而推導(dǎo)出了“基坐標(biāo)系”相對于“末端執(zhí)行器坐標(biāo)系”的等價齊次坐標(biāo)變換矩陣，它把一個矢量從一個坐標(biāo)系中轉(zhuǎn)換到另一個坐標(biāo)系中，每一個矩陣可以同時實現(xiàn)以下兩個作用：平移和旋轉(zhuǎn)。建立操作臂運動方程。本文中用的D一H法來建立坐標(biāo)系并且推導(dǎo)該機器人的運動方程。
2.2 運動學(xué)分析
2.2.1 空間機構(gòu)位置的描述
1.點的位置描述
空間任一點P的位置在直角坐標(biāo)系｛A｝中可用（3ⅹ1）的位置矢量Ap來表示如圖2-1為:
圖2-1 點的位置描述
點P的三個位置坐標(biāo)分量分別是Px、Py、Pz?。
2.點的齊次坐標(biāo)
上述坐標(biāo)用（4ⅹ1）列陣表示，被稱為三維空間點P的齊次坐標(biāo)，比如:
齊次坐標(biāo)是并不唯一的，當(dāng)列陣每一項分別去乘以一個非零因子ω都表示P點。
3.坐標(biāo)軸方向的描述
在直角坐標(biāo)系中，x,y,z軸的單位向量可用 、 、 表示，則用齊次坐標(biāo)描述x、y、z軸的方向：
規(guī)定：以列陣
且a2+b2+c2=1表示某矢量的方向。如列中的第四個元素不為零，則表示空間某點的位置。
如圖2-2中矢量 的方向可表示為：
其中a=cosα，b=cosβ，c=cosγ。
圖2-2 坐標(biāo)軸方向的描述
v點坐標(biāo)為：
4.動坐標(biāo)系位姿的描述
用位姿矩陣對坐標(biāo)系各軸方向和動坐標(biāo)系原點位置進行描述，例如原始的直角坐標(biāo)系可以描述為：
如描述一個任意的坐標(biāo)系R，則利用其三個坐標(biāo)軸x R 、y R 、z R在原始的坐標(biāo)系中表示矢量齊次列陣與列陣[0 0 0 1]T組成。
5.剛體位姿的描述
機器人的每一個連桿都可以看做一個剛體。當(dāng)給定剛體上某一點位置與該剛體在空中的姿態(tài)，于是剛體在空間上的位姿便是唯一確定的了，可用唯一一個位姿矩陣來描述。如圖2-3剛體o’x’y’z’是固連于剛體上的一個坐標(biāo)系，稱為動坐標(biāo)系。
剛體Q在固定坐標(biāo)系OXYZ中位置的齊次坐標(biāo)形式為：
圖2-3 剛體的位置和姿態(tài)描述
、 、 分別為x’,y’,z’坐標(biāo)軸的單位向量：
剛體的位姿表示為齊次矩陣：
6.手部位姿的描述
如圖2-4機器人手的位姿可用固連于手的坐標(biāo)系{B}的位姿表示
圖2-4 機器人手部的位置和姿態(tài)描述
（1）原點：手部中心點為原點OB
（2）接近矢量：關(guān)節(jié)軸方向的單位向量
（3）姿態(tài)矢量：手指連線方向的矢量
（4）法相矢量：
即法向矢量同時垂直于姿態(tài)矢量和接近矢量。手部位置矢量為從固定參考坐標(biāo)系OXYZ原點指向手部坐標(biāo)系{B}原點矢量P，手部的位姿矩陣為：
7.目標(biāo)物位姿的描述
任何一種物體在空間中的位置和姿態(tài)都可以用齊次矩陣表示。圖2-5楔塊Q的情況可用6個點來描述：
使Q ①繞z軸旋轉(zhuǎn)90°：Rot（z，90°）
②再繞y軸旋轉(zhuǎn)90°：Rot（y，90°）
③再沿x軸方向平移4：Trans（4，0，0）
楔塊變?yōu)閳D（b）狀態(tài)。
圖2-5 目標(biāo)物的位置和姿態(tài)描述
2.2.2 空間機構(gòu)中兩任意坐標(biāo)系的變換關(guān)系
剛體的旋轉(zhuǎn)、平移運動均可由齊次變換矩陣來表示，剛體變換后的位姿由其原始描述矩陣乘以齊次變換矩陣而得到。
1.平移的齊次變換
如圖2-6，A點（x，y，z）平移至A’（x’，y’，z’）
即：
記為：
其中 稱為平移算子。
圖2-6 點的平移變換
2. 旋轉(zhuǎn)的齊次變換
如圖2-7，A點繞z軸旋轉(zhuǎn) 角后移至A’，即
圖2-7 點的旋轉(zhuǎn)變換
推導(dǎo)：設(shè)A點在xoy平面上投影的長度為r，與x軸夾角為α。
則
即 z坐標(biāo)未變，故z’=z寫成矩陣形式為
記為
同理：
圖2-8中 為任意過原點的單位矢量，其在三個坐標(biāo)軸上分量為kx，ky，kz，且 。若A點繞 旋轉(zhuǎn)θ角，則可以證明，其旋轉(zhuǎn)齊次變換矩陣為
Rot（k,θ）
圖2-8 點的一般旋轉(zhuǎn)變換
2.2.3 工業(yè)機器人運動學(xué)方程
齊次變換矩陣Ai表示可連桿i坐標(biāo)系相對于連桿坐標(biāo)系i-1位姿變換矩陣。例如A1表示連桿1相對連桿0（基座），A2矩陣表示連桿1坐標(biāo)系相對于連桿1坐標(biāo)系的位姿變換。連桿2相對固定坐標(biāo)系的位姿可用A2 和A1 的乘積表示T2=A1A2
依此類推, 對于六連桿機器人，于是有下列矩陣：T6=A1A2A3A4A5A6，上述等式稱為機器人的運動學(xué)方程。Ｔ６表示手部坐標(biāo)相對于固定參考系的位姿。
或前三列表示手部的姿態(tài)；
或第四列表示手部中心點的位置。
2.3 機構(gòu)的運動學(xué)分析
2.3.1 機構(gòu)尺寸參數(shù)
機構(gòu)模型如圖2-9、圖2-10所示：
圖2-9 機構(gòu)模型
圖2-10 機構(gòu)模型
根據(jù)模型尺寸，姿態(tài)連桿長度分別為49、50、123。位置的初始值為：
設(shè)兩個移動裝置的傳動比為；所有傳動機構(gòu)的傳動比為。各個電機的轉(zhuǎn)角位。
2.3.2 機構(gòu)的運動學(xué)方程
前三個關(guān)節(jié)確定了末端的主要位置。以初始狀態(tài)的小臂方向為軸正方向；大臂伸長方向為軸正方向，建立空間坐標(biāo)系。
則初始狀態(tài)位置方程為：
位姿方程為：
第四關(guān)節(jié)的旋轉(zhuǎn)齊次變換矩陣為：
第四關(guān)節(jié)的移動變換矩陣為：
第五關(guān)節(jié)的旋轉(zhuǎn)齊次變換矩陣中設(shè)為旋轉(zhuǎn)的環(huán)繞單位矢量，、、分別為、、軸的三個分量。則：，，。
所以：
第六關(guān)節(jié)的移動矩陣：
3 模塊式六自由度機器人控制系統(tǒng)硬件設(shè)計
3.1 總體控制方案設(shè)計
如前所述，該機器人可用于制造車間的物流系統(tǒng)中工件的裝夾、搬運和日常生活中的看護、持物等。要求工作范圍大，動作靈活，被夾持物應(yīng)具有多種多樣姿態(tài)，自由度為6個，重量輕，結(jié)構(gòu)緊湊。則本設(shè)計方案如圖3-1所示：
圖3-1 總體方案
3.2 步進電機選取及控制設(shè)計
步進電機是一種進行精確的步進運動的機電執(zhí)行元件，它可廣泛應(yīng)用于工業(yè)機械中的數(shù)字控制，為使系統(tǒng)的通用性、可維護性、可靠性以及性價比最優(yōu)，根據(jù)控制系統(tǒng)功能的要求及步進電機的應(yīng)用環(huán)境，確定了設(shè)計系統(tǒng)的硬件與軟件的功能劃分，從而實現(xiàn)了基于8051 單片機的四相步進電機的開環(huán)控制系統(tǒng)。
3.2.1 步進電機原理及控制技術(shù)
步進電機是種將電脈沖信號轉(zhuǎn)換成了直線或角位移的執(zhí)行元件，它是不能直接接到交直流電源上的，而必須使用專業(yè)的設(shè)備——步進電機控制驅(qū)動器，典型的步進電機控制系統(tǒng)：控制器可以發(fā)出從幾赫茲到幾千赫茲可以連續(xù)變化的脈沖頻率脈沖信號，它為環(huán)形分配器來提供脈沖序列，環(huán)形分配器的功能主要是把來自控制環(huán)節(jié)的脈沖按一定的規(guī)律分配后，經(jīng)過功率放大器放大加到步進電機的驅(qū)動電源各項輸入端，用以驅(qū)動步進電機的轉(zhuǎn)動，環(huán)形的分配器主要有兩大類：一類用計算機軟件設(shè)計的方法實現(xiàn)環(huán)形分配器的要求功能，通常稱為軟環(huán)形分配器。另一類則是用硬件構(gòu)成的環(huán)形分配器，通常稱為硬環(huán)形分配器。功率放大器主要是對環(huán)形分配器的較小輸出信號進行放大，以達到驅(qū)動步進電動機的目的，步進電機基本控制包括速度控制和轉(zhuǎn)向控制兩個方面。從結(jié)構(gòu)上來看，步進電機分為三相六拍、三相單三拍和三相雙三拍3種，其基本原理如下：
（1）換相順序的控制
通電換相這一過程被稱為脈沖分配。例如，三相步進電動機在單三拍工作方式下，其各相通電的順序為 A→B→C→A，通電控制脈沖必須嚴格的按照這一順序，分別控制 A、B、C 相的通斷。三相六拍的通電順序為A→AB→B→BC→C→CA→A，三相雙三拍通電順序為 AB→BC→CA→AB。
（2）步進電機的換向控制
如果給定的工作方式正序換相通電，則步進電機正轉(zhuǎn)。若步進電機勵磁方式為三相六拍，也就是 A→AB→B→BC→C→CA→A。如果是按反序通電換相，則A→AC→C→CB→B→BA→A，電機就反轉(zhuǎn)。其他方式的情況類似。
（3）步進電機的速度控制
如果給步進電機發(fā)送一個控制脈沖，它就會轉(zhuǎn)一步，再發(fā)送一個脈沖，它就會再轉(zhuǎn)一步。兩個脈沖間隔越短，步進電機就轉(zhuǎn)動得越快。調(diào)整送給步進電動機的脈沖頻率，就能夠?qū)Σ竭M電機進行調(diào)試。
（4）步進電機的起?？刂?
由于步進電機的電氣特性，運轉(zhuǎn)時就會有步進感。為了使電動機轉(zhuǎn)動平滑，減小振動，則可在步進電機控制脈沖上升沿和下降沿采用細分梯形波，可以減小步進電機步進角，跳過電動機運行的平穩(wěn)性。則在步進電機停轉(zhuǎn)時，為防止因慣性而使電機軸來產(chǎn)生順滑，則需要采用合適的鎖定波形，來產(chǎn)生鎖定磁力矩和鎖定步進電機的轉(zhuǎn)軸，促使步進電機轉(zhuǎn)軸不能自由的轉(zhuǎn)動。
（5）步進電機的加減速控制
通過實驗發(fā)現(xiàn)，在步進電機控制系統(tǒng)中，如果信號變化的太快，步進電機則由于慣性而跟不上電信號變化，這時就會產(chǎn)生堵轉(zhuǎn)與失步現(xiàn)象。所有的步進電機在啟動時，必須具有加速過程，在停止時波形時有減速過程。理想加速曲線一般是指數(shù)曲線，步進電機的整個降速過程的頻率變化規(guī)律是整個加速過程的頻率變化規(guī)律逆過程。選定的曲線符合步進電機的升降過程的運行規(guī)律，并且能充分利用步進電機快速響應(yīng)性好，有效轉(zhuǎn)矩，縮短了升降速的時間，并且可防止過沖和失步現(xiàn)象。在一個實際的控制系統(tǒng)之中，要根據(jù)負載情況來選擇步進電機。步進電機能夠響應(yīng)而不失步的最高步進頻率被稱為“啟動頻率”，于此類似的“停止頻率”則是指系統(tǒng)控制信號的突然關(guān)斷，步進電機不能沖過目標(biāo)位置最高步進頻率。電機的輸出轉(zhuǎn)矩、停止頻率和啟動頻率都要與負載的轉(zhuǎn)動慣量相適應(yīng)，擁有了這些數(shù)據(jù)，才能有效對電機進行加減速的控制。加速過程有突然的施加脈沖啟動頻率。步進電機最高啟動頻率（突跳頻率）一般為 0.1KHz 到 3~4KHz之間，而最高運行頻率則可達到 N*102KHz，如果超過最高啟動頻率直接啟動，則會產(chǎn)生堵轉(zhuǎn)和失步現(xiàn)象。
3.2.2 步進電機的換向控制
步進電機在換向時，一定要在電機降到突跳頻率范圍之內(nèi)或降速停止再換向，以免產(chǎn)生較大沖擊而損壞電機。換向的信號一定要在前一個方向最后一個脈沖結(jié)束后，下一個方向第一個脈沖前發(fā)出。對于脈沖設(shè)計主要的要求其有一定的脈沖序列、脈沖寬度的均勻度與高低電平方式。在某一高速下正、反向切換實質(zhì)包含降速、換向、加速這3 個過程。
3.2.3 典型的步進電動機控制系統(tǒng)
如圖3-2所示
圖3-2步進電動機控制框圖
3.2.3 硬件設(shè)計
步進電機驅(qū)動器系統(tǒng)電路原理如圖3-3所示
圖3-3 步進電機驅(qū)動器系統(tǒng)電路原理圖
AT89C51將控制脈沖從P1口的P1.4～P1.7輸出，經(jīng)74LS14反相后進入9014，經(jīng)9014放大后控制光電開關(guān)，光電隔離后，由功率管TIP122將脈沖信號進行電壓和電流放大，驅(qū)動步進電機的各相繞組。使步進電機隨著不同的脈沖信號分別作正轉(zhuǎn)、反轉(zhuǎn)、加速、減速和停止等動作。圖中L1為步進電機的一相繞組。AT89C2051選用頻率22MHz的晶振，選用較高晶振的目的是為了在方式2下盡量減小AT89C2051對上位機脈沖信號周期的影響。
圖4-3中的RL1～RL4為繞組內(nèi)阻，50Ω電阻是一外接電阻，起限流作用，也是一個改善回路時間常數(shù)的元件。D1～D4為續(xù)流二極管，使電機繞組產(chǎn)生的反電動勢通過續(xù)流二極管(D1～D4)而衰減掉，從而保護了功率管TIP122不受損壞。
在50Ω外接電阻上并聯(lián)一個200μF電容，可以改善注入步進電機繞組的電流脈沖前沿，提高了步進電機的高頻性能。與續(xù)流二極管串聯(lián)的200Ω電阻可減小回路的放電時間常數(shù)，使繞組中電流脈沖的后沿變陡，電流下降時間變小，也起到提高高頻工作性能的作用。
3.2.3 步進電機的選取
本系統(tǒng)設(shè)計選用57BYGH803B系列下的57BYGH803B四相5線步進電機。電機的功能主要分為三部分，第一部分由三個電機控制，包括從基座開始的一個轉(zhuǎn)動副和兩個移動副，實現(xiàn)整個機器人的位置控制。第二部分由兩個轉(zhuǎn)動副構(gòu)成，負責(zé)控制機械手的姿態(tài)。第三部分負責(zé)控制末端機械手夾持裝置。
圖3-2 步進電機
電機參數(shù)如下：
步距角：Step Angle 1.8deg
環(huán)境溫度：Ambient Temperature -10~+55℃
絕緣等級：Insulation Class B
圖3-3 步進電機接線圖
圖3-4 步進電機尺寸圖
3.3 ULN2003驅(qū)動器
ULN2003是美國Texas Instruments公司與Sprague公司開發(fā)高壓的大電流達林頓晶體管陣列的電路。它的組成是由7對NPN達林頓管，它的高電壓輸出特性與陰極箝位二極管可以轉(zhuǎn)換感應(yīng)的負載。單個達林頓對集電極電流是500mA。達林頓管的并聯(lián)可以承受更大電流。此電路主要應(yīng)用于字錘驅(qū)動器，燈驅(qū)動器，繼電器驅(qū)動器，線路驅(qū)動器，邏輯緩沖器和顯示驅(qū)動器（LED氣體放電）。具有帶負載能力強、溫度范圍寬、工作電壓高、電流增益高等特點,適于各類要求高速大功率驅(qū)動系統(tǒng)。其各項的參數(shù)如下所示：
圖3-5 ULN2003驅(qū)動器
圖3-6 ULN2003驅(qū)動器邏輯框圖
引出段序號
符號
功能
引出端序號
符號
同意功能
1
1B
輸入
9
COM
公共端
2
2B
輸入
10
7C
輸出
3
3B
輸入
11
6C
輸出
4
4B
輸入
12
5C
輸出
5
5B
輸入
13
4C
輸出
6
6B
輸入
14
3C
輸出
7
7B
輸入
15
2C
輸出
8
E
發(fā)射極
16
1C
輸出
表3-1 引出端功能符號
極限參數(shù)
參數(shù)
符號
參數(shù)范圍
單位
集電極和發(fā)射極之間的電壓
VCE
50
V
輸入電壓
VI
30
A
集電極電流峰值
IO
500
mA
總的發(fā)射端電流
IOK
500
mA
功率消耗
Pd
950Tamb=25
mV
工作溫度
TOPr
-20+85
oC
儲存溫度
Tstg
-65+150
0C
表3-2 ULN2003驅(qū)動器極限參數(shù)
3.4 單片機的概述
單片機（single-chip microcomputer）是把微型計算機主要部分集成在一塊芯片上的單芯片微型計算機。單片機的芯片上集成了中央處理單元CPU，只讀存儲器ROM,定時/計數(shù)器，并行和穿行輸入/輸出接口等。由于單片機的高度集成化，縮短了系統(tǒng)內(nèi)部的信號傳送距離，優(yōu)化了結(jié)構(gòu)配置，大大提高了系統(tǒng)的可靠性及運行速度，同時它的指令系統(tǒng)又很適合于工業(yè)控制要求，所以單片機在工業(yè)控制及設(shè)備控制中得到可廣泛的應(yīng)用。
目前，單片機正朝著高性能和多品種方向發(fā)展趨勢將是進一步向著CMOS化、低功耗、小體積、大容量、高性能、低價格和外圍電路內(nèi)裝化等幾個方面發(fā)展。下面是單片機的主要發(fā)展趨勢。
CMOS化? CMOS電路的特點是低功耗、高密度、低速度、低價格。采用雙極型半導(dǎo)體工藝的TTL電路速度快，但功耗和芯片面積較大。隨著技術(shù)和工藝水平的提高，又出現(xiàn)了HMOS（高密度、高速度MOS）和CHMOS工藝。
低功耗化? 單片機的功耗已從Ma級，甚至1uA以下；使用電壓在3~6V之間，完全適應(yīng)電池工作。低功耗化的效應(yīng)不僅是功耗低，而且?guī)砹水a(chǎn)品的高可靠性、高抗干擾能力以及產(chǎn)品的便攜化。
低電壓化? 幾乎所有的單片機都有WAIT、STOP等省電運行方式。允許使用的電壓范圍越來越寬，一般在3~6V范圍內(nèi)工作。低電壓供電的單片機電源下限已可達1～2V。目前0.8V供電的單片機已經(jīng)問世。
低噪聲與高可靠性? 為提高單片機的抗電磁干擾能力，使產(chǎn)品能適應(yīng)惡劣的工作環(huán)境，滿足電磁兼容性方面更高標(biāo)準(zhǔn)的要求。
大容量化? 以往單片機內(nèi)的ROM為1KB～4KB，RAM為64～128B。但在需要復(fù)雜控制的場合，該存儲容量是不夠的，必須進行外接擴充。為了適應(yīng)這種領(lǐng)域的要求，運用新的工藝，使片內(nèi)存儲器大容量化。目前，單片機內(nèi)ROM最大可達64KB，RAM最大為2KB。
高性能化? 主要是指進一步改進CPU的性能，加快指令運算的速度和提高系統(tǒng)控制的可靠性。采用精簡指令集（RISC）結(jié)構(gòu)和流水線技術(shù)，可以大幅度提高運行速度。
小容量、低價格化? 與上述相反，以4位、8位機為中心的小容量、低價格化也是發(fā)展動向之一。這類單片機的用途是把以往用數(shù)字邏輯集成電路組成的控制電路單片化，可廣泛用于家電產(chǎn)品。
外圍電路內(nèi)裝化? 這也是單片機發(fā)展的主要方向。隨著集成度的不斷提高，有可能把眾多的各種外圍功能器件集成在片內(nèi)。除了一般必須具有的CPU、ROM、RAM、定時器/計數(shù)器等以外，片內(nèi)集成的部件還有模/數(shù)轉(zhuǎn)換器、DMA控制器、聲音發(fā)生器、監(jiān)視定時器、液晶顯示驅(qū)動器、彩色電視機和錄像機用的鎖相電路等。
串行擴展技術(shù)? 在很長一段時間里，通用型單片機通過三總線結(jié)構(gòu)擴展外圍器件成為單片機應(yīng)用的主流結(jié)構(gòu)。隨著低價位OTP（One Time Program）及各種類型片內(nèi)程序存儲器的發(fā)展，加之外圍接口不斷進入片內(nèi)，推動了單片機“單片”應(yīng)用結(jié)構(gòu)的發(fā)展。特別是I C、SPI等串行總線的引入，可以使單片機的引腳設(shè)計得更少，單片機系統(tǒng)結(jié)構(gòu)更加簡化及規(guī)范化。
3.5 89C51系列控制單片機設(shè)計與選擇
選擇ATMEL公司的AT89C2051單片機
1. AT89C2051性能及特點
AT89C2051（以下簡稱 2051）是一種低功耗、高性能的8位CMOS微控制器芯片，片內(nèi)帶2KB的快閃可編程及可擦除只讀存儲器（FPEROM）。它與MCS－51指令系統(tǒng)兼容，片內(nèi)FPEROM允許對程序存儲器在線重新編程，也可用常規(guī)的EPROM編程器編程。ATMEL的205l將具有多種功能的8位CPU與FPEROM結(jié)合在同一芯片上，為很多嵌入式控制應(yīng)用提供了高度靈活且價格適宜的方案。
2051還增加了在零頻下工作的靜態(tài)邏輯方式及兩種軟件可選的省電模式。其中，在閑置模式下，CPU停止工作，但RAM、定時器／計數(shù)器、串行口和中斷系統(tǒng)仍然在工作。在掉電模式下，只保存RAM的內(nèi)容，振蕩器停振，關(guān)閉芯片的所有其他功能，直到下一次硬件復(fù)位為止。
2. AT89C2051主要性能
（1）與MCS－5l產(chǎn)品兼容。
（2）2KB的在線可重復(fù)編程快閃存儲器，壽命可達1000次寫／擦除周期。
（3）寬工作電壓范圍：2.7V～6V。
（4）全靜態(tài)工作方式：0Hz～24MHz。
（5）兩級程序存儲器加密。
（6）128×8位SRAM。
（7）15條可編程I／O線。
（8）2個16位定時器／計數(shù)器。
（9）5個中斷源。
（10）可編程串行通道。
（11）可直接驅(qū)動LED。
（12）有片內(nèi)精密模擬比較器，具備低功耗的閑置與掉電模式。
3. 內(nèi)部結(jié)構(gòu)及引腳
2051的內(nèi)部結(jié)構(gòu)如圖2-3所示，引腳分布如圖2-4所示。引腳功能說明如下：
Vic —— 供電電源。
GND —— 電路地。
P1口 —— 為雙向8位I／O端口。P1.2～P1.7引腳有內(nèi)部上拉電阻，P1.0和P1.1需要外部上拉電阻。P1.0和P1.l還作為模擬比較的正輸入端和負輸入端，與片內(nèi)精密模擬比較器相連。P1口輸出緩沖器能吸收20mA灌入電流并可直接驅(qū)動LED顯示器。當(dāng)向端口P1寫入電平“1”時，可作為輸入引腳。因為P1.2～P1.7有內(nèi)部上拉的作用，此時若有外電路作為輸入，引腳會向外灌電流（IIL）。P1口在快閃編程與校驗功能中還承擔(dān)數(shù)據(jù)代碼接收任務(wù)。
P3口 —— P3口只有7位P3.0～P3.5和P3.7（其中P3.7引腳具有內(nèi)部上拉電路）。P3.6為內(nèi)部比較器輸出，無外部引腳。2051無RD和WR控制信號，P3.7為一般I／O線。P3口輸出緩沖器能吸收20mA灌入電流，當(dāng)向端口P3寫入電平“1”時，可用作輸入端口。因為內(nèi)部上拉作用當(dāng)P3口有外部低電平做輸入時，引腳向外產(chǎn)生灌電流（IIL）。P3口也提供2051的第二功能，如表2-2所示。P3在快閃編程與校驗功能中還可接收某些控制信號。
圖2-3 AT89C2051的內(nèi)部結(jié)構(gòu)圖
圖2-4 AT89C2051封裝引腳配置圖
表2-2 P口提供的第二功能3
P3口線
第二功能
P3.0
RXD(串口輸入)
P3.1
TXD(串口輸出)
P3.2
INT0(外部中斷0)
P3.3
INT1(外部中斷1)
P3.4
T0(外部定時輸入0)
P3.5
T1(外部定時輸入1)
RST —— 復(fù)位輸入端。振蕩器工作時，該引腳上兩個機器周期的高電平可復(fù)位2051。每個機器周期為12個振蕩周期（或稱時鐘周期）。
XTAL1 —— 振蕩器反相放大器內(nèi)部工作時鐘電路輸入端。
XTAL 2 —— 振蕩器反相放大器的輸出端。
3.5.1 AT89C51簡介
AT89C51單片機是一種集成電路的芯片，是采用超大規(guī)模的集成電路技術(shù)把有數(shù)據(jù)處理能力中央處理器CPU、只讀存儲器ROM、隨機存儲器RAM、定時器/計時器、多種I/O口和中斷系統(tǒng)等功能（可能還包括脈寬調(diào)制電路、顯示驅(qū)動電路、A/D轉(zhuǎn)換器等電路、模擬多路轉(zhuǎn)換器）集成到一塊硅片上構(gòu)成一個小而完善微型計算機系統(tǒng)，在工業(yè)控制領(lǐng)域上有廣泛的應(yīng)用。
AT89C51是一種低功耗、高性能的片內(nèi)含有4KB快閃可編程／擦除只讀存儲器(FPEROM-Flash Programmable and Erasable Read Only Memory) 8位CMOS微控制器，使用高密度、非易失存儲技術(shù)制造，并且與80C51引腳和指令系統(tǒng)完全兼容。芯片上的FPEROM允許在線編程或采用通用的非易失存儲編程器對程序存儲器重復(fù)編程。AT89C51（以下簡稱 89C51）將具有多種功能的8位 CPU與FPEROM結(jié)合在一個芯片上，為很多嵌入式控制應(yīng)用提供了非常靈活而又價格適宜的方案，其性能價格比較高。
1.89C51性能及特點
89C51的主要性能包括：
（1）與MCS－51微控制器產(chǎn)品系列兼容。
（2）片內(nèi)有4KB可在線重復(fù)編程的快閃擦寫存儲器（Flash Memory）。
（3）存儲器可循環(huán)寫入／擦除1000次。
（4）存儲數(shù)據(jù)保存時間為10年。
（5）寬工作電壓范圍：Vic可為2.7V～6V。
（6）全靜態(tài)工作：可從0Hz至16MHz。
（7）程序存儲器具有3級加密保護。
（8）128×8位內(nèi)部RAM。
（9）32條可編程I／O線。
（10）兩個16位定時器／計數(shù)器。
（11）中斷結(jié)構(gòu)具有5個中斷源和2個優(yōu)先級。
（12）可編程全雙工串行通道。
（13）空閑狀態(tài)維持低功耗和掉電狀態(tài)保存存儲內(nèi)容。
2 .片內(nèi)快閃存儲器 （Flash Memory）
表2-1幾種典型EEPROM芯片主要性能
號型
2816
2816A
1287
2817A
2864A
取數(shù)時間/ms
250
200/250
250
200/250
250
擦/寫電壓/V
21
5
21
5
5
字節(jié)擦除時間/ms
10
9~15
10
10
10
寫入時間/ms
10
9~15
10
10
10
由于EEPROM具有在線改寫，并在掉電后仍能保存數(shù)據(jù)的特點，可為用戶的特殊應(yīng)用提供便利。但是，擦除和寫入對于要求數(shù)據(jù)高速吞吐的應(yīng)用還顯得時間過長，這是EEPROM芯片的主要缺陷。表2-1列出了幾種典型EEPROM芯片的主要性能數(shù)據(jù)。
3. AT89C51硬件結(jié)構(gòu)及引腳
圖2-1 AT89C51內(nèi)部結(jié)構(gòu)圖
AT89C51的內(nèi)部硬件結(jié)構(gòu)如圖2-1所示。除程序存儲器由FPEROM取代了80C5l的EPROM外，其余部分完全相同。
AT89C51的引腳與80C51的引腳也是完全兼容的，其引腳配置如圖2-2所示。各引腳對應(yīng)的功能簡要介紹如下：
圖2-2 AT89C51的引腳
Voss —— 接地。
Vic —— 電源端，接＋５Ｖ。
P0.0～0.7 —— P0口是開漏雙向口可以寫為1使其狀態(tài)為懸浮用作高阻輸入，P0也可以在訪問外部程序存儲器時作地址的低字節(jié)，在訪問外部數(shù)據(jù)存儲器時作數(shù)據(jù)總線，此時通過內(nèi)部強上拉輸出1。P0口每位可以能驅(qū)動８個ＬＳ型ＴＴＬ負載。
P1.0～1.7 —— P1口是帶內(nèi)部上拉的雙向I/O口，向P1口寫入1時P1口被內(nèi)部上拉為高電平，可用作輸入口。當(dāng)作為輸入腳時被外部拉低的P1口會因為內(nèi)部上拉而輸出電流。P１口每位可以能驅(qū)動４個ＬＳ型ＴＴＬ負載。
P2.0～2.7 —— P2口是帶內(nèi)部上拉的雙向I/O口，向P2口寫入1時P2口被內(nèi)部上拉為高電平，可用作輸入口。當(dāng)作為輸入腳時，被外部拉低的P2口會因為內(nèi)部上拉而輸出電流。在訪問外部程序存儲器和外部數(shù)據(jù)時分別作為地址高位字節(jié)和16位地址，此時通過內(nèi)部強上拉傳送1。當(dāng)使用8位尋址方式訪問外部數(shù)據(jù)存儲器時，P２口每位可以能驅(qū)動４個ＬＳ型ＴＴＬ負載。
P3.0～3.7 —— P3口是帶內(nèi)部上拉的雙向I/O口，向P3口寫入1時P3口被內(nèi)部上拉為高電平，可用作輸入口。當(dāng)作為輸入腳時被外部拉低的P3口，會因為內(nèi)部上拉而輸出電流。P３口每位可以能驅(qū)動４個ＬＳ型ＴＴＬ負載。P3 口還具有以下特殊功能：
Red(p3.0) —— 串行輸入口
Tad(P3.1) —— 串行輸出口
INT0(P3.2) —— 外部中斷0
INT1(P3.3) —— 外部中斷
T0(P3.4) —— 定時器0 外部輸入
T1(P3.5) —— 定時器1 外部輸入
WR(P3.6) —— 外部數(shù)據(jù)存儲器寫信號
RD(P3.7) —— 外部數(shù)據(jù)存儲器讀信號
RST —— 復(fù)位。當(dāng)晶振在運行中只要復(fù)位管腳出現(xiàn)2個機器周期高電平，即可復(fù)位內(nèi)部。有擴散電阻連接到Voss，僅需要外接一個電容到Vic即可實現(xiàn)上電復(fù)位。
ALE —— 地址鎖存使能。在訪問外部存儲器時，輸出脈沖鎖存地址的低字節(jié)，在正常情況下，ALE 輸出信號恒定為1/6 振蕩頻率并可用作外部時鐘或定時。
PSEN —— 程序存儲使能。當(dāng)執(zhí)行外部程序存儲器代碼時，PSEN每個機器周期被激活兩次。在訪問外部數(shù)據(jù)存儲器時，PSEN無效。訪問內(nèi)部程序存儲器時，PSEN無效。
EA/App. —— 外部尋址使能/編程電壓。在訪問整個外部程序存儲器時EA必須外部置低，如果EA為高時將執(zhí)行內(nèi)部程序，除非程序計數(shù)器包含大于片內(nèi)FLASH的地址。該引腳在對FLASH編程時，接5V/12V編程電壓(App)，如果保密位1已編程，EA在復(fù)位時由內(nèi)部鎖存。
XTAL1 —— 反相振蕩放大器輸入和內(nèi)部時鐘發(fā)生電路輸入。
XTAL2 —— 反相振蕩放大器輸出。
3.5.2 AT89C51最小系統(tǒng)
單片機是最小系統(tǒng),或者稱為最小的應(yīng)用系統(tǒng),是指用最少元件組成的單片機能夠工作的系統(tǒng).?對于51系列單片機來說,最小的系統(tǒng)一般應(yīng)該包括:電源、單片機、復(fù)位電路、晶振電路。如圖3-8所示：
1、 單片機：89C51單片機一片。
2、 電源：5V直流電源1個。
3、 晶振電路：包括12MHz晶振1只、30pF瓷片電容2只。
4、復(fù)位電路：10uF電解電容1只，4k7電阻1只。
圖3-8 電路圖
（注：上圖中/EA（31引腳）也可直接連接電源VCC，2k電阻可去除）
3.5.3 AT89C51系統(tǒng)設(shè)計
對于本系統(tǒng)的設(shè)計主要控制對象是ULN2003與四相步進電機。采用的是手動按鍵控制。其中的6個步進電機與6個控制器，分別需要12個按鍵來實現(xiàn)正反轉(zhuǎn)的控制。但是由于51點評及管腳限制，所以按鍵應(yīng)采用分狀態(tài)設(shè)計。如圖3-10所示：
圖3-9 時鐘電路
圖3-10 分狀態(tài)設(shè)計圖
圖3-11 復(fù)位電路
圖3-12 驅(qū)動器控制電路
4 模塊式六自由度機器人控制系統(tǒng)仿真設(shè)計
4.1 仿真軟件概述
4.1.1 protues簡介
Protues軟件是英國的Labcenter electronics公司出版的EDA工具軟件。它不只具有其它EDA工具軟件仿真功能，并且能仿真單片機及外圍器件。Proteus是世界上著名EDA工具(仿真軟件)，從代碼調(diào)試、原理圖布圖到單片機和外圍電路的協(xié)同仿真，一鍵切換到了PCB設(shè)計，真正實現(xiàn)從概念到產(chǎn)品完整設(shè)計。在編譯的方面，它也支持Keil、MATLAB和IAR等多種編譯。
4.1.2 Keil C51簡介
keil uvision2 C51軟件是目前功能最強大單片機的c語言集成開發(fā)環(huán)境。Keil C51是美國的Keil Software公司出品51系列兼容單片機C語言軟件開發(fā)的系統(tǒng)，與匯編相比，C語言在結(jié)構(gòu)性、功能上、可維護性、可讀性上有明顯優(yōu)勢，。Keil C51軟件能提供豐富的庫函數(shù)與功能強大集成開發(fā)調(diào)試的工具，全Windows界面。
4.2 仿真系統(tǒng)設(shè)計
4.2.1 仿真系統(tǒng)組成
基于protues的單片機仿真系統(tǒng)主要由兩部分組成：程序、硬件系統(tǒng)。程序部分默認讀取格式為ASM。但本設(shè)計采用C環(huán)境下的51單片機編程控制。所以在Keil C51中生成*.HEX文件。將HEX結(jié)果文件燒錄仿真系統(tǒng)中，實現(xiàn)仿真控制。
4.2.2 仿真系統(tǒng)程序設(shè)計
本設(shè)計程序分為三部分。
第一部分第一各個需要的頭文件和宏。四個數(shù)組分別代表了51單片機控制四相步進電機需要的四種不同的正反轉(zhuǎn)時序。
第二部分為定義延時函數(shù)，程序代碼如下：
第三部分是主函數(shù)，程序代碼如下：
主函數(shù)在大循環(huán)while中不斷判斷按鍵狀態(tài)，如果滿足相應(yīng)的狀態(tài)則進入電機運行程序。并且不斷循環(huán)，直到監(jiān)測按鍵狀態(tài)變化。
4.3 運行調(diào)試結(jié)果
運行調(diào)試結(jié)果如圖4-1所示，在位置狀態(tài)下控制6個按鍵分別調(diào)整位置的各個參數(shù)。當(dāng)狀態(tài)變換到姿態(tài)下時，6個按鍵中四個控制姿態(tài)。兩個控制夾持電機的正反轉(zhuǎn)。
圖4-1 運行調(diào)試結(jié)果
總 結(jié)
本文閱讀了大量的文獻資料，從我國六自由度機器人的研究運用現(xiàn)狀出發(fā)，結(jié)合已有的六自由度機器人的本體結(jié)構(gòu)，進行了運動學(xué)分析，軌跡規(guī)劃，仿真分析，控制系統(tǒng)四個方面做了比較詳細的研究。全文結(jié)論如下：
1. 分析了國內(nèi)六自由度機器人的發(fā)展現(xiàn)狀和研究方向，以及我國發(fā)展六自由度機器人的必要性。
2. 根據(jù)六自由度機器人的本體結(jié)構(gòu)，利用D-H表示法對六自由度機器人進行了運動學(xué)分析，在此基礎(chǔ)上建立了六自由度機器人的變換矩陣，推導(dǎo)出機器人運動學(xué)的正逆解，并根據(jù)機器人的結(jié)構(gòu)，推出機器人關(guān)節(jié)空間的運動范圍，給出機器人的工作空間。
3. 在protues環(huán)境下，建立了機器人仿真模型，進行了運動學(xué)仿真，對正逆解的有效性進行了驗證。并給出了機器人在空間中繪制矩形的仿真實例。
參考文獻
1. 模塊化機器人的設(shè)計方案及開發(fā)[J]. 左啟鑫,彭琴,馬強. 電子世界. 2015(21)
2. 模塊化自主變形機器人設(shè)計探索[J]. 毛昕,陳汗青,朱延河,王愛紅. 設(shè)計. 2019(06)
3. 基于PLC的工業(yè)機器人控制系統(tǒng)關(guān)鍵技術(shù)研究[J]. 陸雪影. 科技創(chuàng)新與應(yīng)用. 2018(12)
4. 周潤景,張麗娜丁,莉.基于PROTEUS的電路及單片機設(shè)計與仿真.北京：北京航空航天大學(xué)出版社，2010.1
5. 一種六自由度串聯(lián)機器人的運動學(xué)與動力學(xué)仿真分析[D]. 徐有勝.深圳大學(xué) 2018
6. 張繼春，楊建國. 裝配設(shè)計與運動仿真及Pro/E實現(xiàn)[M].北京：國防工業(yè)出版 社，2006.1
7. 劉廣瑞. 機器人創(chuàng)新制作[M].西安：西北工業(yè)大學(xué)出版社，2007.02
8. 機器人發(fā)展引發(fā)的技術(shù)倫理問題探究[D]. 趙玉群.渤海大學(xué) 2017
9. 周伯英.工業(yè)機器人設(shè)計-機械工業(yè)出版社，1995
10. [孫迪生，王炎.機器人控制技術(shù).機械工業(yè)出版社，1998
11. 基于Arduino平臺的六足仿生機器人控制系統(tǒng)設(shè)計[J]. 王康南,王利霞. 物聯(lián)網(wǎng)技術(shù). 2018(01)
12. 基于工程教育認證的單片機PBL教學(xué)模式探索與實踐[J]. 趙宇洋,李爭,王春梅. 高教學(xué)刊. 2019(02)
13. 模塊化協(xié)作機器人運動特性分析及動力學(xué)仿真研究[J]. 馬國慶,劉麗,于正林,曹國華. 長春理工大學(xué)學(xué)報(自然科學(xué)版). 2018(02)
14. Development and implementation of a real-time open-architecture control system for industrial robot systems[J] . J.S. G,C.W. Silva. Engineering Applications of Artificial Intelligence . 2004 (5)
15. 《單片機原理與應(yīng)用》課程教學(xué)改革與實踐[J]. 黃茂飛,劉湘黔,劉先智. 科技創(chuàng)新導(dǎo)報. 2019(05)
16. Integrated architecture for industrial robot programming and control[J] .. Robotics and Autonomous Systems . 1999 (4)
17. Optimal Motion Planning for Robotic Manipulators[J] . Li Advanced Materials Research . 2014 (902)
18. 王衛(wèi)忠.可重構(gòu)模塊化機器人系統(tǒng)關(guān)鍵技術(shù)研究[D].哈爾濱:哈爾濱工業(yè)大學(xué),2007.
19. Mode