3740.懸掛運動控制系統(tǒng)

1、懸掛運動控制系統(tǒng)摘要：本設計采用一塊凌陽單片機spce061a作為懸掛物體的控制和檢測核心，懸掛物體在傾斜（仰角不大于100度）的板上可以進行任意軌跡的運動，包括直線運動、圓周運動、任意曲線運動等。系統(tǒng)能通過鍵盤輸入自行設定的坐標點參數，物體可根據給定的坐標位置作定點運動和自行設定的曲線運動，在運動的過程中能在板上畫出運動軌跡，并能沿任意給定的用黑線標識的曲線軌跡運動。本系統(tǒng)同時具有顯示當前物體位置坐標的功能。系統(tǒng)采用反射式光電傳感器感知與坐標紙顏色有很大差異的黑色引導線，使用兩個步進四相電機，電機驅動采用集成芯片l293d，通過單片機給定的控制信號進行換相，可靈活方便地對步進電機的速度和轉向

2、進行控制。關鍵字：懸掛物體，光電傳感器，雙步進電機，spce061a，l293d 1. 系統(tǒng)設計1.1 設計要求1.1.1 基本要求（1） 控制系統(tǒng)能夠通過鍵盤或其他方式任意設定坐標點參數；（2） 控制物體在80cm100cm的范圍內作自行設定的運動，運動軌跡長度不小于100cm，物體在運動時能夠在板上畫出運動軌跡，限300秒內完成；（3） 控制物體作圓心可任意設定、直徑為50cm的圓周運動，限300秒內完成；（4） 物體從左下角坐標原點出發(fā)，在150秒內到達設定的一個坐標點(兩點間直線距離不小于40cm)。 1.1.2 發(fā)揮部分（1） 能夠顯示物體中畫筆所在位置的坐標；（2） 控制物體沿板上

3、標出的任意曲線運動(見示意圖)，曲線在測試時現(xiàn)場標出，線寬1.5cm1.8cm，總長度約50cm，顏色為黑色；曲線的前一部分是連續(xù)的，長約30cm；后一部分是兩段總長約20cm的間斷線段，間斷距離不大于1cm；沿連續(xù)曲線運動限定在200秒內完成，沿間斷曲線運動限定在300秒內完成；（3） 其他。 1.2 總體設計方案1.2.1 系統(tǒng)總體方案懸掛運動控制系統(tǒng)總體方框圖如圖1.2.1所示。系統(tǒng)包括控制器模塊、光電檢測模塊、電機驅動模塊、鍵盤顯示模塊四個部分。 圖1.2.1懸掛運動控制系統(tǒng)總體方框圖 1.2.2 方案論證與比較（1）控制器模塊的設計方案論證與選擇方案一：采用fpga（現(xiàn)場可編輯門列陣

4、）作為系統(tǒng)控制器。fpga可以實現(xiàn)各種復雜的邏輯功能，規(guī)模大，集成度高，體積小，穩(wěn)定性好，并且可利用eda軟件進行仿真和調試。fpga采用并行工作方式，提高了系統(tǒng)的處理速度，常用于大規(guī)模實時性要求較高的系統(tǒng)。在本設計中，fpga的高速處理能力得不到充分發(fā)揮。方案二：采用凌陽spce061a單片機作為系統(tǒng)控制器。單片機spce061a的晶振頻率為32.768khz，有32k的flash，3.3v供電，32位可編程并行i/o口，兩個十六位可編程定時/計數器，可以自動設置預設初值，具有運行/睡眠方式下的看門狗維護功能。按照題目要求，控制器主要接收和辨識傳感器來的信號，控制兩個電機的動作，控制顯示物體

5、當前所在位置的坐標值等。綜上所述，采用方案二。（2）光電檢測模塊的設計方案論證與選擇光電檢測模塊可以實現(xiàn)懸掛物體沿著板上標出的黑色曲線運動，且不能偏離軌跡。此時軌跡是一條黑線，周圍是淺色坐標紙，可以利用傳感器來感知軌跡。方案一：采用光電傳感器檢測。當光線照射到滑塊運動的表面上時會發(fā)生反射，由于黑線和白紙的反射系數不同，光電傳感器可根據接收到的反射光強弱來判斷是否偏離黑線。使用五個集成的反射式光電傳感器，一個固定在懸掛物體的中間，其余四個分別位于物體的四邊上，中間的傳感器可以起到主控作用，引起中斷。當物體運動時，若中間傳感器的狀態(tài)沒變化，則周圍四個傳感器的狀態(tài)變化不會引起運動的變化，而繼續(xù)原來的

6、運動。只有當中間傳感器的狀態(tài)發(fā)生變化時，才看周圍的四個傳感器是否有狀態(tài)變化，根據最先變化的傳感器來確定物體運動偏離的方向，然后單片機控制電機調整懸掛物體的運動，直至中間的傳感器恢復原狀態(tài)為止。方案二：采用攝像頭把板上的信息收集起來再用單片機對其進行分析。此種方法，對信息的處理會很準確，但成本很高，并且要將其裝在懸掛物體上，必須要集成化，更增加了軟硬件的要求，在短時間內很難做出實物來，所以不大可取。綜上所述，選擇方案一。（3）電機驅動模塊的設計方案論證與選擇步進電機是數字控制電機，適合于單片機控制。其驅動電路根據控制信號工作，控制信號控制步進電機的換相順序、轉向和速度。方案一：采用集成芯片l29

7、3d的驅動電路。l293d可以驅動兩相或四相步進電機，可以直接用單片機的i/o口提供控制信號，通過l293d控制電機的轉向和速度。該驅動電路接線很簡單，也很容易控制，使用很方便。一個l293d驅動一個電機的工作，本設計中要用到兩個l293d。驅動電路的四個輸入引腳分別接單片機的四個i/o端口，當輸入腳為高電平時，相應的輸出就是高電平，四個輸出端口則會驅動四相電機的換相動作。引腳高低電平轉化的頻率會直接影響電機的轉速。高低電平的變化即方波的產生有兩種方法，一種是給端口一個高電平并延時一段時間，之后再給一個低電平，這樣電機的速度就由延時的時間決定。這種方法比較簡單，在實時性要求不高的系統(tǒng)中不失為一

8、種好方法，但本設計中涉及兩個電動機，并且兩個電動機的速度不一定時時都相等，會出現(xiàn)同一時刻需要兩個不同的延時程序的情況，這樣系統(tǒng)處理的延時會更大，甚至影響電機的工作。另外一種方法就是用計數器來取代延時程序，給定一個計數值，當計數器溢出時則會響應中斷，給相應端口的電平取反。這種方法的延時很小，適用于實時性好的系統(tǒng)。凌陽spce061a單片機中已有兩個定時計數器:timera和timerb，用計數器來實現(xiàn)計數可以充分利用系統(tǒng)的資源。方案二：使用多個功率放大器驅動電機。通過使用不同的放大電路和不同參數的器件，可以達到不同的放大要求，放大后能夠得到較大的功率。但是由于使用的是四相步進電機，就需要對四路信

9、號分別進行放大，由于放大電路很難做到完全一致，當電機的功率較大時運行起來會不穩(wěn)定，而且電路的制作會比較復雜。綜上所述，選擇方案一。(4)鍵盤顯示模塊的設計方案論證與選擇在控制懸掛物體的運動過程中，系統(tǒng)需要按鍵輸入設定物體的坐標值，并顯示運動物體的位置坐標值，考慮有三種方案：方案一：使用16位字符型液晶（lcd）顯示。液晶顯示屏具有低功耗、平面直角顯示、影像穩(wěn)定不閃爍、可視面積大、畫面效果好、分辨率高、抗干擾能力強等特點。液晶以點陣的模式顯示各種符號，需要利用控制芯片創(chuàng)建字符庫，編程工作量大。液晶動態(tài)顯示功能強大，可以實現(xiàn)歡迎信息的顯示，并提供了一個友好的用戶界面，使系統(tǒng)更加直觀，更趨智能化和人

10、性化。直接使用單片機上的三個按鍵，并與液晶結合就可以實現(xiàn)多項功能。方案二：使用傳統(tǒng)的數碼管顯示及鍵盤輸入。數碼管采用bcd編碼顯示數字，編程容易，硬件電路調試簡單。但其顯示的信息容量小，功耗較大，而且一般芯片上會有六位數碼管，使用時片選信號和段選信號會占用十六個i/o端口，若同時使用鍵盤輸入，單片機端口資源開銷太大。方案三：采用以hd7279為核心的鍵盤顯示模塊。hd7279是一種具有串行接口，可同時驅動8位共陰式數碼管的智能顯示驅動芯片，并可連接多達64按鍵的鍵盤矩陣。這樣8位數碼管顯示只需要占用3個接口線，而4個接口線就可驅動8位數碼管和64按鍵的鍵盤。大大減少了占用的單片機端口數，而且不

11、需要對數碼管進行顯示控制，節(jié)省單片機資源。綜上所述，本設計采用了方案一，使用凌陽公司的splc501液晶顯示。 1.2.3 系統(tǒng)組成經過反復比較與論證，最終確定的系統(tǒng)方框圖如圖1.2.2所示。 圖1.2.2 系統(tǒng)基本框圖 2.單元電路設計2.1 光電檢測電路的設計題目要求運動物體要沿著劃出的黑線運動，但在運動過程中，物體不可避免地會偏離運動軌跡，為了能使物體在偏離后可以自動調整方向，重新回到運動軌跡上，系統(tǒng)需要將物體的運動狀態(tài)及時地以電信號的形式反饋到控制部分，控制部分控制兩個電機的正轉或反轉，使物體重新回到軌跡上。本設計中共使用五個集成的反射式光電傳感器，分別裝在物體的中間和四周。當物體向左

12、偏出軌跡時，中間的傳感器將不被黑線遮蔽，輸出由高電平變?yōu)榈碗娖?，且右側的傳感器進入黑線內，輸出由低電平變?yōu)楦唠娖?。該狀態(tài)變化會引起系統(tǒng)中斷，控制兩個電機正轉或反轉，通過控制兩邊線長的變化使物體重新運動回軌跡上。具體電路如圖2.2.1所示。集成反射式光電傳感器的電壓驅動為4.5v-5v。當發(fā)射二極管導通時，發(fā)出紅外光線，使接收管的集電極和發(fā)射極間電阻變小，輸出端接一上拉電阻，輸出為低電平。當紅外光線照射到黑色線上時，反射光較少，接收管集電極和發(fā)射極間的電阻增大，輸出被上拉電阻拉至高電平。在信號和地之間接一個電容，可以減小電路中的毛刺干擾。 圖2.2.1 光電檢測電路 2.2 電機驅動電路的設計電

13、機驅動電路采用芯片l293d控制，一個芯片可驅動一個四相步進電機。具體電路如圖2.2.2所示。芯片的4個輸入端接單片機的4個i/o端口，控制電機的轉向和速度。每個端口的高低電平轉換，通過單片機內部計數器的設置，以控制電機的轉速。 圖2.2.2 l293d電機驅動電路 2.3 控制電路的設計單片機接收從傳感器檢測電路輸入的信號，并將輸入的信號進行處理運算，以控制電流或控制電壓的方式輸出給被控制的單元電路，完成各項任務要求。單片機spce061a外接液晶顯示電路、光電檢測電路、電機驅動電路。光電傳感器的輸出接單片機的端口iob2、iob0、iob1、iob8、iob10。其中物體中間的光電傳感器接

14、單片機的外部中斷口iob2。單片機的定時器中斷a、b分別調用步進電機換相子程序實現(xiàn)步進電機驅動電路的工作。通過傳感器檢測，單片機控制電機的轉向和轉速。兩個電機控制分別由ioa4，ioa5，ioa6，ioa7和iob4，iob5，iob6，iob7輸出。液晶顯示中，數據傳輸線輸出接ioa的高八位。三個鍵盤使用ioa0、ioa1、ioa2三個端口。片選信號cs接iob9， ao 接iob11。讀寫控制信號r/w接iob12。ep接iob13。 3. 軟件設計系統(tǒng)的軟件設計采用c語言和匯編語言混合編程，在凌陽unsp ide平臺上完成了單片機系統(tǒng)的開發(fā)，實現(xiàn)了各項設計功能和指標要求。3.1 光電傳感

15、器檢測子程序光電檢測子程序流程圖為圖3.1.1所示： 圖3.1.1 光電檢測子程序 3.2 電機驅動子程序四相四拍步進電機驅動子程序如圖3.2.1所示： 圖3.2.1 電機驅動子程序圖3.2.2 中斷服務子程序 3.3 鍵盤設定坐標值子程序鍵盤設定坐標值子程序流程圖如圖3.3.1所示。 圖3.3.1鍵盤輸入子程序流程圖 3.4 液晶顯示子程序根據用戶的選擇執(zhí)行不同的功能（如在菜單中選擇畫圖，則在畫圖菜單中輸入x, y 坐標即可）。子程序流程圖如圖3.4.1所示. 圖3.4.1 lcd子程序流程圖 3.5 定點運動子程序（從當前位置x0,y0移動到任意位置x,y），其設計思想原理圖如圖所示3.5

16、.1： 圖3.5.1 定點運動原理圖 定點運動子程序流程圖如圖3.5.2所示 圖3.5.2 定點運動子程序流程圖 3.6 系統(tǒng)主程序流程圖系統(tǒng)主程序流程圖如圖示： 圖3.6.1系統(tǒng)總程序流程圖 4. 系統(tǒng)測試為了確定系統(tǒng)與題目要求的復合程度，我們對系統(tǒng)中的關鍵部分進行了實際的測試。 4.1 測試儀器測試使用的儀器如表4.1.1所示。 表4.1.1 測試使用的儀器設備序號 名稱、型號、規(guī)格 數量 備注 1 雙蹤示波器： 1 2 秒表精度0.01 1 3 uni-t數字萬用表 1 勝利公司 4 10米卷尺 1 4.2指標測試和測試結果4.2.1 定點運動的測試我們最初實現(xiàn)的是物體在紙板上的定點運動

17、，即把物體放在原點處，通過鍵盤輸入物體將要到達的點的坐標值，開啟電源，讓物體開始運動。記錄物體從原點到達目的點所經歷的時間和偏差，記錄如下：第一次：輸入坐標為(80,100) 歷時時間為10s 偏差為0.5 cm第二次：輸入坐標為(70，40) 歷時時間為8s 偏差為0.8 cm第三次：輸入坐標為(50,60) 歷時時間為10s 偏差為1.0 cm 在走定點運動時我們讓電機的轉速加快，所以速度比較快，時間上比起其它運動會短很多，并且準確率很高。 4.2.2 圓周運動部分測試將物體用手放于圓心任意設定（可通過按鍵輸入圓點坐標），半徑為25cm的圓周上，開啟電源，讓物體作圓周運動，記錄全程時間，預

18、期軌跡和運動軌跡的偏差。記錄如下：第一次：時間為50s 偏差為0.8cm第二次：時間為 40s 偏差為1.5cm第三次：時間為 45s 偏差為 2.0cm系統(tǒng)單獨實現(xiàn)做圓周運動時，物體運動所需的時間比較短，且誤差比較小，但隨著多個模塊的累積，物體走圓周運動就不如以前好了，偏差比以前明顯大了許多，且圓看起來也不如以前那么平滑了。 4.2.3 光電檢測部分測試反射式光電傳感器的負載電壓是4.5v-5v，在使用時需要接上拉電阻，以能明顯看到傳感器的狀態(tài)變化為基準，其上拉電阻為小于10k為好，我們選用的是5k。在檢測時我們需要調整傳感器離紙板的高度，使其在黑線和白色紙板上反射時能明顯工作于高低電平之間

19、。將傳感器對準黑線時，傳感器輸出應為高電平，當將其離開黑線時，受白色坐標紙反射，輸出變?yōu)榈碗娖?。用示波器來觀察其輸出波形的變化，調整其高度使其變化最敏感。 4.2.4 沿黑線做連續(xù)曲線運動的測試在紙板上任意位置劃一條粗為1.5 cm-1.8 cm的黑線，將物體用手放在黑線的起點，啟動電源，讓物體做沿黑線的運動。記錄全過程所耗時間和預定軌跡和運行軌跡的偏差。記錄如下：第一次：曲線長度：30 cm 時間為 1min 偏差為1.0cm第二次：曲線長度：30 cm 時間為 55s 偏差為1.5cm第三次：曲線長度：30 cm 時間為 1min15s 偏差為2.0cm由于技術不是很精，有時候物體走的路線

20、會偏差很大，一旦偏離黑線很大距離，物體就無法再回到原來的路線繼續(xù)運動，而會一直偏下去。 4.2.5 沿黑線做斷續(xù)曲線運動的測試在紙板上畫出三條粗為1.5 cm-1.8 cm的黑線，形成兩條間斷距離不大于1cm的間斷線段，物體從連續(xù)黑線運動到斷續(xù)處，遇到第一個斷點可斷點順利跨過，繼續(xù)向前運動，遇第二個斷點也順利跨過。記錄其時間和誤差如下：第一次：曲線長度：20 cm 時間為 50s 偏差為：1.0cm 第一次：曲線長度：20 cm 時間為 55s 偏差為：1.5cm第一次：曲線長度：20 cm 時間為 1min 偏差為：1.2cm 4.2.6 系統(tǒng)實現(xiàn)的功能系統(tǒng)實現(xiàn)的功能有：鍵盤輸入坐標值；在紙板范圍內作自行設定的運動；做圓心任意設定的半徑為25 cm的圓