張友方，蔣 一，王 銳，曹 燕

陸軍軍官學(xué)院，安徽合肥 230031

0 引言

系統(tǒng)要求設(shè)計并制作一個自由擺上的平板控制系統(tǒng)，要求控制電機使平板可以隨著擺桿的擺動而旋轉(zhuǎn)，擺桿在300～450之間自由擺動過程中，要求平板上的一到八枚硬幣在5個擺動周期中不滑落，并保持疊放狀態(tài)。發(fā)揮部分則要求在平板上固定的激光筆在擺桿自由擺動過程中使光斑始終照射在靶紙的某一條線上。

該控制系統(tǒng)是一個動態(tài)自平衡測試系統(tǒng)，主要由三部分構(gòu)成：1）擺架系統(tǒng)：支架，擺桿，底座，和位于擺桿底部固定在電機上的平板；2）驅(qū)動控制系統(tǒng)：控制器通過對傳感器輸出信號的分析發(fā)出控制信號，經(jīng)功率放大后控制電機的轉(zhuǎn)動，帶動平板盡快恢復(fù)平衡狀態(tài)；3）檢測系統(tǒng)：通過傳感器檢測出平板的角度變化，通過串口送給控制器。

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

1.1 自由擺控制系統(tǒng)的原理與組成

自由擺運動可以近似認(rèn)為是一種規(guī)律性的簡諧振動，在一個周期內(nèi)分為變加速(T1)—變減速(T2)——反向變加速(T3)—反向變減速(T4)四個運動過程。T1（T2）和T3（T4）運動規(guī)律對稱，T1(T3)和T2(T4)運動規(guī)律對稱，因此可以僅對四分之一周期進(jìn)行分析。我們采用微分中“以直代曲”的思想，在Δt時間內(nèi)可以近似認(rèn)為是在Δl的直線(弧度）上做勻加速運動，采用Δt時間內(nèi)加速度的平均值作為該段的加速度，求取各個細(xì)分段點的線速度值，與采用能量守恒的方式求得的各個細(xì)分段點的線速度值比較，通過數(shù)據(jù)分析，當(dāng)擺桿最大角度為45°，小段時間內(nèi)轉(zhuǎn)動最小角度時，該近似計算和根據(jù)能量轉(zhuǎn)換計算出的最大速度誤差控制在以內(nèi)，因此，在一個周期內(nèi)可以通過這種近似計算，分析平板在某一位置的狀態(tài)值。

1.2 方案設(shè)計

考慮到電機帶動平板運動和自由擺的運動相互獨立，可以通過傾角傳感器的實時反饋得出任意時刻平板相對于地面的角度，直接將其值發(fā)送至單片機，從而控制步進(jìn)電機轉(zhuǎn)動相應(yīng)角度而重新回到水平。

1）擺架框架的選擇

方案一：采用木板做擺桿，材料方便，制作簡單，但木板孔的摩擦力較大，不利于擺桿做簡諧振動，硬度大，易損壞，不易搬運。

方案二：采用鐵板做擺桿，相對于木板來說，鐵板在擺動過程受空氣阻力的

影響較小，從而能夠較好的保持在一個平面內(nèi)，不會產(chǎn)生前后晃動的現(xiàn)象，為更好保持穩(wěn)定，減少系統(tǒng)本身可能導(dǎo)致的誤差，本設(shè)計采用鐵板作擺桿。

2）傳感器的選擇

方案一：采用兩軸傾角傳感器，只能夠檢測出水平和橫向傾角，刷新率低，輸出信息量少，不能提供擺桿角速度和角加速度的變化，無法提供平板的運動姿態(tài)信息，步進(jìn)電機不能實時追隨平板的變化。

方案二：采用AHRS系列傳感器，它體積小，精度高，3個陀螺儀、3個加速度計與3個磁場計?？梢詫崟r測量軸向的角速度，加速度和磁場強度。通過內(nèi)部微處理器的處理，輸出無漂移姿態(tài)和航信息，以及較核過的三維加速度、三維角速度、三維地磁場。

考慮到題目只需測出白板的水平傾角，同時要有較快的響應(yīng)速度和高采樣速率，同時傳感器要安裝方便，采用方案二。

2 硬件設(shè)計

2.1 主控模塊

主控模塊包括微處理器及周邊電路，微處理器采用STM32F103VB單片機，STM32F103VB是意法半導(dǎo)體(ST)公司推出的基于ARM32位CORTEX2M3CPU，是目前性能比較突出的微處理器之一，豐富的內(nèi)置功能模塊可大大簡化周邊電路設(shè)計，同時也提高了系統(tǒng)本身的抗干擾能力。

2.2 步進(jìn)電機驅(qū)動系統(tǒng)

本系統(tǒng)采用四線兩相混合式57BYG系列步進(jìn)電機，步進(jìn)角為1.8。選用A3987集成芯片做驅(qū)動芯片，A3987 是一款完全的微步電動機驅(qū)動器，帶有內(nèi)置轉(zhuǎn)換器，易于操作。該產(chǎn)品可在完整、1/2、1/4 及 1/16 步進(jìn)模式時操作雙極步進(jìn)電動機，輸出驅(qū)動容量為 50V及 1.5A。為保證電機能夠?qū)崟r跟蹤角度傳感器的變化量，避免因電機的抖動使硬幣滑落，本系統(tǒng)采用1/16細(xì)分模式，使步進(jìn)電機步進(jìn)角變?yōu)?.1125°。驅(qū)動板見圖1。

圖1 步進(jìn)電機驅(qū)動板

圖2 傾角傳感器

2.3 數(shù)據(jù)采集部分

傳感器采用的是FY-AHRS-1200B。如圖2所示，它是一款高性能的捷聯(lián)慣導(dǎo)系統(tǒng)，可以在3D空間中測量任何機車和載體的姿態(tài)角和方位角，對于靜止或帶角速度的任何運動物體可以進(jìn)行高精度的姿態(tài)定位，內(nèi)置傳感器自動校正功能，能對傳感器的溫飄、噪聲、外部干擾自動補償校正。

3 軟件設(shè)計

系統(tǒng)采用模塊化設(shè)計思想，單片機軟件設(shè)計主要包括主程序、初始化程序、數(shù)據(jù)采集程序和步進(jìn)電機控制子程序等。

4 結(jié)論

本文以控制理論的知識為基礎(chǔ)，利用角度傳感器配合單片機完成了對步進(jìn)電機的實時控制，同時對測控系統(tǒng)的原理和組成做了詳細(xì)的分析，確定了設(shè)計方案，以意法半導(dǎo)體新推出的32位微控制器STM32F103VB處理器芯片為核心，完成了各硬件模塊的功能，還完成相關(guān)的分析計算和應(yīng)用程序的設(shè)計。較好的實現(xiàn)了對自由擺上平板的平衡控制。

[1]周航慈.單片機應(yīng)用程序設(shè)計[M].北京航空航天大學(xué)出版社，2006.

[2]高吉祥.全國大學(xué)生電子設(shè)計競賽培訓(xùn)教程[M].模擬電子線路設(shè)計，2007.

[3]全國大學(xué)生電子設(shè)計競賽組委會編《全國大學(xué)生電子設(shè)計競賽獲獎作品匯編》[M].北京理工大學(xué)出版社，2006.