《電子技術(shù)應(yīng)用》
您所在的位置:首頁(yè) > 嵌入式技術(shù) > 設(shè)計(jì)應(yīng)用 > 基于STM32的新型光耦電機(jī)定位技術(shù)
基于STM32的新型光耦電機(jī)定位技術(shù)
2018年電子技術(shù)應(yīng)用第5期
楊曉昆,張正平,,張 燦,趙 麒
貴州大學(xué) 大數(shù)據(jù)與信息工程學(xué)院,,貴州 貴陽(yáng)550000
摘要: 在機(jī)械控制領(lǐng)域,電機(jī)已成為與機(jī)電控制密不可分的重要組成部分,,因此電機(jī)的運(yùn)動(dòng)控制與精確定位成為了該領(lǐng)域的一個(gè)重要研究方向?,F(xiàn)今大部分電機(jī)采用的定位方法多是根據(jù)多光耦限位的思想來(lái)完成的,而本文利用遲滯比較器,,從另一個(gè)角度出發(fā),,提出一種新的光耦電機(jī)定位技術(shù),在不改變電機(jī)定位效果的前提下,,減少光耦數(shù)量來(lái)實(shí)現(xiàn)光耦電機(jī)的定位,。
中圖分類(lèi)號(hào): TP271+.4
文獻(xiàn)標(biāo)識(shí)碼: A
DOI:10.16157/j.issn.0258-7998.174340
中文引用格式: 楊曉昆,張正平,,張燦,,等. 基于STM32的新型光耦電機(jī)定位技術(shù)[J].電子技術(shù)應(yīng)用,2018,,44(5):60-62,,66.
英文引用格式: Yang Xiaokun,Zhang Zhengping,,Zhang Can,,et al. A new localization technique for optocoupler motor based on STM32[J]. Application of Electronic Technique,2018,,44(5):60-62,,66.
A new localization technique for optocoupler motor based on STM32
Yang Xiaokun,Zhang Zhengping,,Zhang Can,,Zhao Qi
College of Big Data and Information Engineering,,Guizhou University,Guiyang 550000,,China
Abstract: The motor has become an important and inseparable part of the electromechanical control in the field of mechanical control,therefore making the motor run and stop precisely has becomes a major research direction. Nowdays,most motor positioning algorithms are based on the optocouplers to complete.However,this article puts forward a new algorithm for motor positioning based on optocouplers and hysteresis comparator which starts from another point of view. Without changing the effect of motor positioning,,the number of optocouplers can be reduced.
Key words : electromechanical control,;optocoupler;hysteresis comparator,;algorithm for motor positioning

0 引言

    隨著精工技術(shù)的不斷發(fā)展,,越來(lái)越多的儀器設(shè)備對(duì)數(shù)據(jù)精密度的要求不斷提高[1-2]。本實(shí)驗(yàn)室參與的工程項(xiàng)目——納米量子點(diǎn)蛋白質(zhì)芯片關(guān)鍵技術(shù)及產(chǎn)品研發(fā)所采用的微型移動(dòng)平臺(tái),,經(jīng)過(guò)幾代的技術(shù)改進(jìn),,不斷將控制平臺(tái)微型化,對(duì)儀器平臺(tái)精密定位的要求也在不斷提高,。此時(shí)前幾代所使用的傳統(tǒng)中小型移動(dòng)平臺(tái)的多光耦定位電機(jī)已無(wú)法達(dá)到工作需求,。所以,實(shí)驗(yàn)組在逐步縮小光耦體積,、減少光耦數(shù)量的同時(shí),,采用一種新型定位技術(shù),以便更進(jìn)一步提高平臺(tái)精準(zhǔn)度,。

1 總體結(jié)構(gòu)與電機(jī)驅(qū)動(dòng)

1.1 模塊化項(xiàng)目結(jié)構(gòu)

    納米量子點(diǎn)蛋白質(zhì)芯片關(guān)鍵技術(shù)及產(chǎn)品研發(fā)項(xiàng)目設(shè)備總體結(jié)構(gòu)如圖1所示,,因?qū)嶒?yàn)項(xiàng)目采用的是模塊化工程模式,即不同的實(shí)驗(yàn)組負(fù)責(zé)各自的模塊,,其中主要分為結(jié)構(gòu)搭配與設(shè)計(jì)組,、上位機(jī)軟件工程組和下位機(jī)硬件工程組3個(gè)方向。本實(shí)驗(yàn)組隸屬于下位機(jī)硬件工程組,,在總體結(jié)構(gòu)中,,實(shí)驗(yàn)組沒(méi)有直接參與或負(fù)責(zé)的部分已用虛線框注明。

qrs5-t1.gif

1.2 電機(jī)的驅(qū)動(dòng)

    在實(shí)際工程中,,需同時(shí)考慮產(chǎn)品最優(yōu)化性能,、維護(hù)成本及可操作性等因素,所以選用由微型四相電機(jī)所組成的xy軸單光耦十字移動(dòng)工作滑臺(tái),。因?yàn)樗x用的移動(dòng)平臺(tái)是由四相永磁式步進(jìn)電機(jī)和光耦共同搭建完成的,,此電機(jī)在通常情況下可以由電壓直接驅(qū)動(dòng),但考慮到重定義相位,、電機(jī)功率等原因,,采用市面上已經(jīng)非常成熟的A4988芯片對(duì)電機(jī)進(jìn)行驅(qū)動(dòng)[3]和保護(hù)。

    滑臺(tái)電機(jī)的轉(zhuǎn)動(dòng)方向與STM32電機(jī)方向引腳的高低電平有關(guān),。實(shí)驗(yàn)組根據(jù)電機(jī)實(shí)際情況,,將輸出方向與電壓的關(guān)系建立如下公式:

     qrs5-gs1.gif

式中,,x為STM32下位機(jī)方向引腳輸出電壓。

    同時(shí),,電機(jī)轉(zhuǎn)動(dòng)的速度是通過(guò)改變STM32下位機(jī)速度引腳的脈沖頻率來(lái)控制的,,速度引腳所產(chǎn)生的脈沖頻率越高,電機(jī)所對(duì)應(yīng)的移動(dòng)速度越快,。

    因?qū)嶋H電機(jī)受到靈敏度限制,,只能識(shí)別一定范圍內(nèi)的脈沖頻率,所以實(shí)驗(yàn)組根據(jù)頻率要求將電機(jī)速度分為25個(gè)擋位,,并通過(guò)部分源碼簡(jiǎn)介電機(jī)速度與脈沖頻率間的關(guān)系[4-5],。

    以下為電機(jī)控制部分一個(gè)周期脈沖所對(duì)應(yīng)的C語(yǔ)言程序源碼:

    PWM_X_ON;

    OSTimeDly(1),;

    PWM_X_OFF,;

    OSTimeDly(Pulse_X_Time);

    經(jīng)頭文件及宏定義之后,,第1行源碼的效果是拉高x軸速度引腳電平,;第2行源碼將速度引腳高電平延遲一個(gè)節(jié)拍(1 ms);隨后,,通過(guò)第3行源碼拉低x軸速度引腳電平,;第4行源碼將此時(shí)狀態(tài)維持,并等待下一個(gè)脈沖周期,。此時(shí),,電機(jī)會(huì)相應(yīng)的移動(dòng)一個(gè)位置,這里將移動(dòng)路程記做1,。

    由上述C語(yǔ)言程序源碼和周期條件可得出電機(jī)速度與周期頻率的關(guān)系如下:

    qrs5-gs2.gif

式中,,n為第4行源碼中所接收的上位機(jī)Pulse_X_Time參數(shù)所代表?yè)跷弧?/p>

2 光耦的原理及使用

    光耦的全稱為光耦合器,是誕生于20世紀(jì)70年代的一種新型器件,,因其優(yōu)秀的抗干擾能力,、工作穩(wěn)定性、持久性等特性在實(shí)際工業(yè)生產(chǎn)中有著非常廣泛的應(yīng)用,。

    原光耦理想電路如圖2所示,,因其簡(jiǎn)單結(jié)構(gòu)無(wú)法滿足電路的安全與功能需求,所以在光耦電路的接收和發(fā)送端分別接入了保護(hù)電阻[6],。

qrs5-t2.gif

    將接入保護(hù)電阻的光耦結(jié)構(gòu)通電后接入示波器,,令電機(jī)以式(2)中v(0)速度運(yùn)行,其示波器中顯示的電壓與時(shí)間關(guān)系如圖3所示,。

qrs5-t3.gif

    從圖3中結(jié)果可以看出光耦的輸出電壓并非理想的跳變,,這是由于光耦的結(jié)構(gòu)特性所決定的。

    光耦的接收端是由光敏電阻所構(gòu)成的,其阻值會(huì)隨著光強(qiáng)度變化而發(fā)生改變,,而當(dāng)光耦滑臺(tái)產(chǎn)生移動(dòng)時(shí),,滑臺(tái)所配套的遮光擋板處于勻速運(yùn)動(dòng),以至于無(wú)法在短時(shí)間內(nèi)完全阻擋發(fā)射光線,,因此才會(huì)出現(xiàn)圖3所示現(xiàn)象,。

    光耦電壓的這種不確定性,使得STM32電壓接收引腳無(wú)法準(zhǔn)確對(duì)其進(jìn)行捕獲,,以至于無(wú)法對(duì)距離進(jìn)行準(zhǔn)確的把握,。

    針對(duì)光耦的這一非理想因素,實(shí)驗(yàn)組最終提出將光耦電路輸出端接入遲滯比較器的解決方案[7],。遲滯比較器的作用是當(dāng)光耦輸入電壓大于一定范圍時(shí)遲滯比較器輸出高電平,光耦輸入電壓小于某一范圍時(shí)遲滯比較器將輸出低電平,。

    此時(shí),,光耦結(jié)構(gòu)完整電路如圖4所示,并通過(guò)設(shè)置與實(shí)際測(cè)量,,最終得到遲滯比較器輸出電壓與光耦輸入電壓間的關(guān)系如式(3)所示:

     qrs5-gs3.gif

式中,,x代表光耦的輸入電壓。

qrs5-t4.gif

    將完善后的電路圖并入實(shí)際工作電路,,經(jīng)過(guò)示波器實(shí)際測(cè)量,,光耦輸出電壓與時(shí)間的關(guān)系如圖5所示。

qrs5-t5.gif

    最后,,實(shí)驗(yàn)組得出準(zhǔn)確STM32輸出脈沖次數(shù)與電機(jī)移動(dòng)距離關(guān)系,,如式(4)所示:

    qrs5-gs4.gifqrs5-gs4.gif

式中,x為STM32下位機(jī)輸出的脈沖次數(shù),,經(jīng)計(jì)算最大脈沖數(shù)值為4 439,。

3 光耦電機(jī)結(jié)構(gòu)與新型定位技術(shù)

    針對(duì)前幾代雙光耦電機(jī)因體積原因無(wú)法準(zhǔn)確定位的缺陷,實(shí)驗(yàn)組在進(jìn)一步將電機(jī)微型化的條件下,,構(gòu)建了微型xy軸單光耦十字移動(dòng)工作滑臺(tái),。并采用了一種新型的定位技術(shù)——數(shù)值邊界定位算法,有效克服了只能適用于中小型移動(dòng)平臺(tái)的雙光耦電機(jī)所存在的缺點(diǎn)[8],。

    xy軸單光耦十字移動(dòng)工作滑臺(tái)其結(jié)構(gòu)分為x,、y兩軸,每一個(gè)軸分別由對(duì)應(yīng)的電機(jī),、光耦和遮光擋板所構(gòu)成,。在這里,只單例出其中x軸來(lái)進(jìn)行分析,,y軸同理,。其x軸的結(jié)構(gòu)如圖6所示。

qrs5-t6.gif

    因?yàn)閤y軸單光耦十字移動(dòng)工作滑臺(tái)是一個(gè)微型平臺(tái),即使選配體積極小的光耦和遮光擋板,,仍然會(huì)占據(jù)大量空間,,所以,光耦的跳變對(duì)輸出有了不同的意義:當(dāng)遮光擋板進(jìn)入光耦時(shí),,光耦會(huì)輸出一個(gè)低電平,,并始終保持;當(dāng)遮光擋板離開(kāi)光耦時(shí),,光耦的輸出電平會(huì)被拉高,,并始終保持直到遮光擋板再次進(jìn)入光耦,電平拉低,。所以,,新的光耦輸出電壓與電機(jī)移動(dòng)距離關(guān)系如圖7所示。

qrs5-t7.gif

    在此,,重新定義STM32所輸出的一個(gè)脈沖,,對(duì)應(yīng)電機(jī)移動(dòng)距離為單位1。

    因此,,本文提出的數(shù)值邊界定位技術(shù),,通過(guò)多次實(shí)驗(yàn)分別測(cè)得圖6中的X_Left和X_Right距離所需的脈沖次數(shù),再?gòu)膹?fù)以上實(shí)驗(yàn)步驟,,多次測(cè)量得到X_Left+X_Right的總長(zhǎng)脈沖次數(shù)記做XY_Test(因?yàn)閷?shí)際工程中存在X,、Y相同的兩個(gè)電機(jī))。以上數(shù)據(jù)對(duì)y軸電機(jī)同樣適用,。通過(guò)多次的實(shí)驗(yàn)測(cè)量和計(jì)算分別得出X_Left=2 034,、X_Righ=2 445、XY_Test=4 439,。

    在啟動(dòng)系統(tǒng)之前,,因?yàn)闊o(wú)法得知電機(jī)所在位置,所以需要對(duì)整體結(jié)構(gòu)進(jìn)行初始化[9],,以下為針對(duì)此電機(jī)的初始化算法步驟:

    (1)判斷光耦輸出端的電平,,如果是低電平,即說(shuō)明遮光擋板位于光耦內(nèi),,給予電機(jī)一個(gè)向右移動(dòng)的命令,;如果是高電平,說(shuō)明遮光擋板位于光之外,,給予電機(jī)一個(gè)向左移動(dòng)的命令,。

    (2)電機(jī)向左移動(dòng)離開(kāi)光耦時(shí),光耦電平由低變高,,電機(jī)向右移動(dòng)進(jìn)入光耦時(shí),,光耦電平被拉低。所以,無(wú)論遮光擋板是離開(kāi)還是進(jìn)入光耦,,都會(huì)產(chǎn)生一個(gè)跳變信號(hào),。若已捕獲到這一跳變信號(hào),則說(shuō)明電機(jī)遮光擋板已經(jīng)運(yùn)行至臨界點(diǎn),。

    (3)給予電機(jī)一個(gè)向右的方向和X_Right的距離,,此時(shí)遮光擋板運(yùn)行至電機(jī)起點(diǎn)位置。

    光耦電機(jī)初始化流程如圖8所示,。

qrs5-t8.gif

    當(dāng)電機(jī)x,、y軸同時(shí)運(yùn)動(dòng)時(shí),此技術(shù)仍然適用,,只需要添加對(duì)二者邊界的判決條件,,構(gòu)造如下函數(shù):

    qrs5-gs5.gif

式中,i表示次電機(jī)上電后所運(yùn)行的次數(shù),,di(x1)由式(1)定義為電機(jī)第i次運(yùn)動(dòng)方向,,si(x2)由式(4)定義為電機(jī)第i次運(yùn)行距離的絕對(duì)值。

    因此,,若想要時(shí)刻得到電機(jī)的絕對(duì)位置并判斷是否越過(guò)邊界條件則需要公式如下:

    qrs5-gs6.gif

式中,m,、n分別為x,、y軸當(dāng)前操作電機(jī)的次數(shù),x1,、x2分別為x軸所對(duì)應(yīng)方向電壓和距離,,y1、y2分別為y軸所對(duì)應(yīng)的方向電壓與距離,,f(x,,y)為式(5)所構(gòu)建電機(jī)一次的運(yùn)動(dòng)距離。

    若z值超出了已經(jīng)給定的數(shù)值邊界,,則下位機(jī)將向PC上位機(jī)返回警告信號(hào),。

4 結(jié)論

    與前幾代雙光耦電機(jī)定位技術(shù)的局限性不同,單光耦電機(jī)的數(shù)值邊界定位技術(shù)適用于多種電機(jī)工作平臺(tái),,有較好的可移植性,,尤其在微型電機(jī)平臺(tái)有著顯著的優(yōu)勢(shì)。它可以避免因測(cè)量精確度限制導(dǎo)致的誤差,,并且從軟件方面著手大大減少了硬件工程所需的工作量,。

    但是該技術(shù)也存在的相應(yīng)的缺點(diǎn),電機(jī)的運(yùn)行過(guò)度依賴于軟件的程序,,對(duì)硬件故障無(wú)法及時(shí)地做出反饋,。可能導(dǎo)致的問(wèn)題之一是,如果旋轉(zhuǎn)電機(jī)出現(xiàn)滑絲現(xiàn)象,,單從軟件是無(wú)法得到這一結(jié)論的,。

    所以在后期的工作之中,實(shí)驗(yàn)組將會(huì)系統(tǒng)地對(duì)工程進(jìn)行完善,,將對(duì)硬件的檢測(cè)部分加入到工作內(nèi)容之中,,并且在現(xiàn)有的基礎(chǔ)之上,對(duì)電機(jī)的運(yùn)動(dòng)進(jìn)行維度拓展,,將之后的工作重心轉(zhuǎn)移到第三維度的處理與應(yīng)用,。

參考文獻(xiàn)

[1] FAN Y,ZHANG L,,CHENG M,,et al.Sensorless SVPWM-FADTC of a new flux-modulated permanent-magnet wheel motor based on a wide-speed sliding mode observer[J].IEEE Transactions on Industrial Electronics,2015,,62(5):3143-3151.

[2] 王登貴,,楊中平,胡真明,,等.基于PLC的四相步進(jìn)電機(jī)控制方法及實(shí)現(xiàn)[J].微計(jì)算機(jī)信息,,2015,41(1):21-24.

[3] Chen Chao,,Shi Yunlai,,Zhang Jun,et al.Novel linear piezoelectric motor for precision position stage[J].Chinese Journal of Mechanical Engineering,,2016,,29(2):378-385.

[4] 莫本團(tuán).基于步進(jìn)電機(jī)控制的大空間火災(zāi)精確定位原理設(shè)計(jì)[J].電子測(cè)試,2017(9):34-35.

[5] RAHIDEH A,,KORAKIANITIS T.Analytical open-circuit magnetic field distribution of slotless brushless permanent-magnet machines with rotor eccentricity[J].IEEE Transactions on Magnetics,,2011,47(12):4791-4807.

[6] QIAO Z,,SHI T,,WANG Y,et al.New sliding-mode observer for position sensorless control of permanent-magnet synchronous  motor[J].IEEE Transactions on Industrial Electronics,,2013,,60(2):710-719.

[7] 王洪祥,趙野,,黑勇.一種帶有遲滯比較器的新型RC振蕩器[J].科學(xué)技術(shù)與工程,,2013,13(18):5345-5349.

[8] 章圣焰,,劉小康,,胡水仙.淺談光耦的使用方法[J].航空電子技術(shù),,2015,46(4):51-54.

[9] 賈啟.三自由度永磁同步平面電機(jī)定位控制研究[D].沈陽(yáng):沈陽(yáng)工業(yè)大學(xué),,2013.



作者信息:

楊曉昆,,張正平,張  燦,,趙  麒

(貴州大學(xué) 大數(shù)據(jù)與信息工程學(xué)院,,貴州 貴陽(yáng)550000)

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