《電子技術(shù)應(yīng)用》
您所在的位置:首頁 > 嵌入式技術(shù) > 設(shè)計應(yīng)用 > 基于自由擺的平板控制系統(tǒng)設(shè)計
基于自由擺的平板控制系統(tǒng)設(shè)計
來源:微型機(jī)與應(yīng)用2012年第18期
楊苗軍,,胡佳文,金華園,,熊 雕
(浙江海洋學(xué)院,,浙江 舟山316000)
摘要: 采用重力加速度傳感器及線性電阻角度傳感器來檢測擺動時平板及擺桿角度的變化,利用撥碼開關(guān)可控制預(yù)設(shè)功能,,單片機(jī)根據(jù)擺桿與重垂線之間的擺角計算出平板的旋轉(zhuǎn)方向及角度,,從而控制步進(jìn)電機(jī)實現(xiàn)對平板運(yùn)動狀態(tài)的精確控制,很好地實現(xiàn)了硬幣在擺桿擺動過程中保持穩(wěn)定疊放狀態(tài)及激光筆對靶紙預(yù)設(shè)位置的動態(tài)跟蹤照射等設(shè)計功能,。
Abstract:
Key words :

摘  要: 采用重力加速度傳感器及線性電阻角度傳感器來檢測擺動時平板及擺桿角度的變化,,利用撥碼開關(guān)可控制預(yù)設(shè)功能,單片機(jī)根據(jù)擺桿與重垂線之間的擺角計算出平板的旋轉(zhuǎn)方向及角度,,從而控制步進(jìn)電機(jī)實現(xiàn)對平板運(yùn)動狀態(tài)的精確控制,,很好地實現(xiàn)了硬幣在擺桿擺動過程中保持穩(wěn)定疊放狀態(tài)及激光筆對靶紙預(yù)設(shè)位置的動態(tài)跟蹤照射等設(shè)計功能。
關(guān)鍵詞: 重力加速度傳感器,;角度傳感器,;單片機(jī);控制

1 系統(tǒng)方案
1.1 系統(tǒng)設(shè)計總方案

    為了實現(xiàn)運(yùn)動擺的控制功能,,采用了如圖1所示的設(shè)計方案,。通過對平板上的重力加速度傳感器及擺桿上線性角度傳感器的檢測,利用高速單片機(jī)運(yùn)算,,計算出擺的擺角及平板的當(dāng)前狀態(tài),,根據(jù)控制的要求對步進(jìn)電機(jī)進(jìn)行精密調(diào)整控制,從而實現(xiàn)對運(yùn)動狀態(tài)中的平板上的硬幣的平衡控制及激光筆對靶紙的瞄準(zhǔn)控制,。

1.2 系統(tǒng)組成模塊方案
1.2.1 電機(jī)驅(qū)動模塊方案

    分析可知,,系統(tǒng)設(shè)計的關(guān)鍵在于實現(xiàn)步進(jìn)電機(jī)的精確控制,,故選擇正確的步進(jìn)電機(jī)驅(qū)動電路是成功實現(xiàn)功能的關(guān)鍵。一般步進(jìn)電機(jī)驅(qū)動電路方案如下:
    方案1:采用分立元件組成平衡式H橋驅(qū)動電路,,可由單片機(jī)直接對其進(jìn)行操作,,但由于分立元件占用空間較大,考慮到擺桿的承重問題和模塊固定問題,,安裝焊接復(fù)雜,、調(diào)試費(fèi)時,故此方案不夠理想,。
    方案2:利用集成電路芯片組成H橋驅(qū)動電路,,避免了分立元件帶來的過重、體積過大問題,,調(diào)試方便,。一般采用此方案較多。具體實現(xiàn)方案有以下幾種:
    (1)采用單片L298N芯片組成驅(qū)動電路[1],,由單片機(jī)產(chǎn)生四相驅(qū)動信號輸送至L298N驅(qū)動電機(jī)轉(zhuǎn)動,。此方案占用體積較小、自重較小,,但占用單片機(jī)I/O口較多,,加重了單片機(jī)的運(yùn)算負(fù)擔(dān),不利于功能拓展,。
    (2)采用L298N+L297組成步進(jìn)電機(jī)驅(qū)動電路,。利用L297芯片產(chǎn)生的四相驅(qū)動信號,用半步(8拍)和全步(4拍)等方式驅(qū)動單片機(jī)控制兩相雙極或四相單極步進(jìn)電機(jī)[2],。該芯片內(nèi)部的PWM斬波器允許在關(guān)模式下控制步進(jìn)電機(jī)繞組電流,。只需要時鐘、方向和模式信號就能控制步進(jìn)電機(jī),,可減輕處理器和程序設(shè)計的負(fù)擔(dān),。但占用體積較L298單芯片大。經(jīng)實際測試,,步進(jìn)電機(jī)在調(diào)整平板角度過程中引起的震動較大,,硬幣容易震落,無法達(dá)到既定要求,。
    (3)采用TB6560AHQ單芯片組成步進(jìn)電機(jī)驅(qū)動電路,。與方案(2)L297+L298N相比,解決了步進(jìn)電機(jī)精細(xì)控制的問題,,具有整步,、1/2細(xì)分、1/8細(xì)分、1/16細(xì)分運(yùn)行方式可供選擇,。且內(nèi)置溫度保護(hù)及過流保護(hù),,外圍電路更為簡單,集成度較高,,能基本滿足控制要求,,故本次設(shè)計采用此方案,。
1.2.2 角度傳感器方案
    采用角位移傳感器獲取代表擺桿與豎直線之間的夾角α量的電壓值,,送單片機(jī)運(yùn)算得出水平線與平板之間的夾角θ。此方案對單片機(jī)運(yùn)算速度要求較高,,但電路簡單,、數(shù)據(jù)穩(wěn)定。
2 理論分析與計算
2.1 平板狀態(tài)測量方法

    設(shè)擺桿長度=l,;電機(jī)軸半徑+底板厚度+激光筆軸半徑=h,;擺桿與垂線夾角為α;激光與水平線夾角為θ,。經(jīng)運(yùn)動分析可得圖2所示幾何關(guān)系,。



3.2 步進(jìn)電機(jī)驅(qū)動電路
    TB6560AHQ單芯片步進(jìn)電機(jī)驅(qū)動電路如圖6所示。因電機(jī)采用24 V電壓,,故本模塊采用光電耦合器隔離驅(qū)動芯片與單片機(jī)控制信號[4],,起電氣隔離作用,防止高壓對單片機(jī)控制系統(tǒng)的影響,。
3.3 角度傳感模塊電路
3.3.1 擺桿與豎直線之間的夾角?琢的檢測

    采用WDY-32E-1精密角度傳感器與擺桿相連,,利用擺桿帶動角度傳感器轉(zhuǎn)動,引起角度傳感器內(nèi)可變電阻的變化,,使得輸出端的電壓發(fā)生變化,,經(jīng)單片機(jī)ADC端口讀入并計算得出角度變化量。圖7所示為角度傳感器機(jī)械結(jié)構(gòu)圖,。

3.3.2 激光與水平線夾角α的檢測

 


    采用LSM303DLH三軸電子羅盤模塊,,利用地磁場角度進(jìn)行夾角測算,采用I2C通信協(xié)議,,與模塊單片機(jī)進(jìn)行通信,,處理后輸出數(shù)字量,實現(xiàn)檢測功能,。
4 系統(tǒng)主要程序設(shè)計
    本系統(tǒng)主要由平板轉(zhuǎn)動程序,、平板調(diào)節(jié)防落程序、平板調(diào)節(jié)激光指向程序等三大程序模塊組成,,流程框圖如圖8所示,。
    本設(shè)計主要采用重力加速度傳感器及線性電阻角度傳感器來檢測擺動時平板及擺桿角度的變化,利用撥碼開關(guān)可控制預(yù)設(shè)功能,單片機(jī)根據(jù)擺桿與重垂線之間的擺角計算出平板的旋轉(zhuǎn)方向及角度,,從而控制步進(jìn)電機(jī)實現(xiàn)對平板運(yùn)動狀態(tài)的精確控制,。經(jīng)過多次調(diào)試,該系統(tǒng)能很好地實現(xiàn)既定目的,,即硬幣在擺桿擺動過程中能在平板上保持穩(wěn)定疊放狀態(tài)以及平板上的激光筆能對靶紙上的預(yù)設(shè)位置進(jìn)行跟蹤照射,。
參考文獻(xiàn)
[1] 黃智偉.全國大學(xué)生電子設(shè)計競賽制作實訓(xùn)[M].北京:北京航空航天大學(xué)出版社,2007.
[2] 郭天祥.51單片機(jī)C語言教程—入門,、提高,、開發(fā)、拓展全攻略[M].北京:電子工業(yè)出版社,,2009.
[3] 樓然苗.51系列單片機(jī)設(shè)計實例[M].北京:航空航天大學(xué)出版社,,2002.
[4] 康華光.電子技術(shù)基礎(chǔ)·模擬部分[M].北京:高等教育出版社,2006.

此內(nèi)容為AET網(wǎng)站原創(chuàng),,未經(jīng)授權(quán)禁止轉(zhuǎn)載,。