趙志強(qiáng) , 廖 程 , 沈 巍 , 鄭國維
(1.重慶郵電大學(xué) 生物醫(yī)學(xué)研究中心,重慶 400065;2.重慶醫(yī)科大學(xué) 附屬第二醫(yī)院,重慶 400010)
隨著我國臨床醫(yī)學(xué)的發(fā)展,手術(shù)動力裝置成為臨床手術(shù)中重要的器械之一。一般要求手術(shù)動力裝置需具有尺寸小,轉(zhuǎn)矩脈動小,轉(zhuǎn)速精確可調(diào)等優(yōu)點。手術(shù)動力裝置所選用電機(jī)與動力設(shè)備匹配之前,都需經(jīng)過測功機(jī)進(jìn)行動力測試,因手術(shù)動力裝置的微型電機(jī)要求轉(zhuǎn)速高而轉(zhuǎn)矩精確等特點,市場上沒有適合手術(shù)動力裝置微型電機(jī)的測功機(jī),所以對手術(shù)動力裝置微型電機(jī)的測功機(jī)研究就顯得尤為重要。
手術(shù)動力裝置微電機(jī)的測功機(jī)由被測電機(jī)、加載器、多種傳感器、單片機(jī)、上位機(jī)及驅(qū)動電路等組成。其中,加載器是一臺他勵直流電機(jī);被測電機(jī)與加載器用聯(lián)軸器相連;數(shù)據(jù)采集采用STC12C5A60S2單片機(jī),它采集被測電機(jī)和加載器的信號,并傳遞給計算機(jī),并接受計算機(jī)處理之后信號用以驅(qū)動被測電機(jī)和加載器;上位機(jī)應(yīng)用程序完成啟動、停止整個系統(tǒng)、處理和傳遞參數(shù)給單片機(jī),以及模糊控制PID算法的運(yùn)行[1-2]。模糊PID控制算法克服了模糊控制精度不高和存在靜態(tài)余差的缺點,達(dá)到良好的控制效果。
整個系統(tǒng)硬件結(jié)構(gòu)如圖1所示,系統(tǒng)主要包括STC12C5 A60S2單片機(jī)最小系統(tǒng)、電子負(fù)載加載電路、電機(jī)驅(qū)動電路、倍頻電路、放大電路、電壓處理電路和串口通信電路等。
圖1 系統(tǒng)硬件結(jié)構(gòu)圖Fig.1 Hardware structure of the system
為了實現(xiàn)自動測試采用自動加載模塊,它主要給被測電機(jī)自動加負(fù)載,具體采用電樞外接電阻的自動調(diào)節(jié)模塊。此時勵磁磁場不變,改變電樞外接電阻來調(diào)節(jié)電樞電流,從而達(dá)到改變電機(jī)負(fù)載轉(zhuǎn)矩的目的。為了實現(xiàn)自動調(diào)節(jié),負(fù)載使用電子可調(diào)電阻,采用PWM控制。
轉(zhuǎn)矩測量采用定子轉(zhuǎn)矩法,即把電機(jī)的定子和轉(zhuǎn)子同時架空,電機(jī)旋轉(zhuǎn)時,電磁力對轉(zhuǎn)子產(chǎn)生一個旋轉(zhuǎn)的力矩,同時也向定子施加一個大小相等,且方向相反的反作用力矩。通過力傳感器測得定子的受力,就能計算出轉(zhuǎn)子所受到的力矩了。根據(jù)測試電機(jī)的力矩范圍,這里選取6 kg的力傳感器,并用集成運(yùn)放AD620對其輸出信號進(jìn)行放大。
轉(zhuǎn)速測量采用的是WTK-10凹槽型光電傳感器,傳感器的相關(guān)電路在內(nèi)部,直接開關(guān)量輸出,檢測頻率為1 kHz,測速采用6縫隙測速碼盤[3]。
其中被測無刷直流電機(jī)型號是portescap生產(chǎn)的B0610-024A-R00電機(jī),此電機(jī)轉(zhuǎn)子的材料為永磁磁鋼,電樞繞組放置在定子上。通過永磁磁場和電樞磁場之間的作用,從而產(chǎn)生連續(xù)的轉(zhuǎn)矩來保證電機(jī)的連續(xù)工作。其中永磁磁場由轉(zhuǎn)子磁鋼定子產(chǎn)生,電樞磁場由定子繞組產(chǎn)生。電機(jī)的電子換相部分采用繞組導(dǎo)通120°電角度、三相橋式控制方式,電機(jī)本體的定子采用星型連接方式的系統(tǒng)比較合適。電路圖如圖2所示。
圖2 無刷直流電機(jī)三相全控電路圖Fig.2 Brushless dc motor three-phase all control circuit diagram
多路開關(guān)采用CD4051,電壓處理電路采用AD620運(yùn)算放大器對信號進(jìn)行處理。
系統(tǒng)的設(shè)計目的要求不僅是對外界參數(shù)進(jìn)行實時測量,在一定時間內(nèi)完成對數(shù)據(jù)的采集和處理,而且還必須對相應(yīng)的轉(zhuǎn)速、轉(zhuǎn)矩、電壓、電流、功率等進(jìn)行實時控制。系統(tǒng)的主要任務(wù)有4個:通過串口進(jìn)行數(shù)據(jù)通信任務(wù)、發(fā)送加載器及電機(jī)驅(qū)動任務(wù)、數(shù)據(jù)采集任務(wù)、數(shù)據(jù)分析顯示。測功機(jī)系統(tǒng)的軟件設(shè)計包括兩部分,上位機(jī)應(yīng)用程序設(shè)計和單片機(jī)軟件設(shè)計。
上位機(jī)主要任務(wù)是:串口通信、數(shù)據(jù)分析顯示和發(fā)送任務(wù)。上位機(jī)利用Visual C++6.0作為開發(fā)工具,實現(xiàn)與單片機(jī)的通信,通信采用MFC的MSComm控件。上位機(jī)可以提供如下功能:被測電機(jī)參數(shù)設(shè)置(轉(zhuǎn)矩和轉(zhuǎn)速)、參數(shù)實時監(jiān)測(其中包括轉(zhuǎn)速、轉(zhuǎn)矩、電流、功率等參數(shù))和控制策略的實現(xiàn)。具體的流程框圖如圖3(a)所示。
單片機(jī)信息采集控制系統(tǒng)是一個多輸入多輸出的測控系統(tǒng),主要任務(wù)有:數(shù)據(jù)采集任務(wù)、串口通信任務(wù)和發(fā)送電流加載任務(wù),實時性要求較高。由于單片機(jī)內(nèi)存資源有限,應(yīng)盡量減少任務(wù)個數(shù),即減少任務(wù)堆棧個數(shù)將相近的功能整合到一個任務(wù)中;同時中斷有關(guān)的任務(wù)要注意保護(hù),避免反復(fù)響應(yīng)和進(jìn)入中斷,導(dǎo)致系統(tǒng)負(fù)荷過大,實時性受影響;還應(yīng)把計算量較大的任務(wù)給上位機(jī)來運(yùn)行,保證實時性和穩(wěn)定性[4-6]。具體的流程框圖如圖3(b)所示。
圖3 上位機(jī)和單片機(jī)程序流程圖Fig.3 PC and MCU program flow chart
目前,工業(yè)過程中廣泛采用PID控制,不同的對象要用不同的PID參數(shù),而且調(diào)整不方便,抗干擾能力差,超調(diào)量大。因此采用模糊控制系統(tǒng)對模型進(jìn)行控制。
模糊PID控制器是模糊控制器與傳統(tǒng)PID控制器的結(jié)合,它的設(shè)計思想是:先找出PID參數(shù)與期望值與實際輸出的偏差E和偏差變化EC之間的模糊關(guān)系,在運(yùn)行中通過不斷檢測E和EC,再根據(jù)模糊控制原理對3個參數(shù)進(jìn)行在線整定,傳統(tǒng) PID控制器在獲得新的 Kp,Ki,Kd后,對控制對象輸出控制量。模糊PID控制器原理圖如圖4所示。
圖4 模糊PID控制器原理圖Fig.4 Fuzzy PID controller principle diagram
模糊控制系統(tǒng)是2輸入3輸出系統(tǒng)。根據(jù)掌握的經(jīng)驗,共分7個等級。 模糊控制器的設(shè)計必須通過多次修改模糊推理規(guī)則進(jìn)行優(yōu)化設(shè)計,并進(jìn)行在線、離線的反復(fù)調(diào)試才能最后確定。經(jīng)過長期人工操作經(jīng)驗的總結(jié),并作出Kp、Ki、Kd的模糊推理表。
模糊推理設(shè)計采用Mamdani方法,分別用max和min實現(xiàn)OR和AND算子,用min實現(xiàn)蘊(yùn)含關(guān)系,用max實現(xiàn)合成規(guī)則。清晰化方法采用重心法。通過重心法解模糊處理,得到量化值輸出 ΔKp,ΔKi,ΔKd,實現(xiàn) PID 3 個參數(shù)的在線整定。
圖5 傳統(tǒng)PID控制器仿真圖Fig.5 Traditional PID controller simulation diagram
圖6 模糊PID控制器仿真圖Fig.6 Fuzzy PID controller simulation diagram
根據(jù)實驗室現(xiàn)有的設(shè)備,選用一臺他勵直流額定轉(zhuǎn)速為25 000 r/min、額定功率為24 W的他勵直流電機(jī)為測功機(jī),圖7為上位機(jī)采集到的數(shù)據(jù)。
圖7 上位機(jī)程序Fig.7 PC program
經(jīng)試驗數(shù)據(jù)驗證,測試結(jié)果與實際相符,測功機(jī)使用模糊控制PID算法使得響應(yīng)迅速,不僅體積小、價格低、功能全、使用維護(hù)方便,無需人手操作,也可用于其它各種機(jī)械傳動裝置的轉(zhuǎn)矩轉(zhuǎn)速測量,為研究手術(shù)動力裝置微電機(jī)提供了良好的條件。
[1]尚靜,張斌,陸永平,等.基于TMS320LF2407A DSP的感應(yīng)電動機(jī)轉(zhuǎn)矩轉(zhuǎn)速特性測定系統(tǒng)[J].電子器件2007,30(2):530-533.SHANG Jing,ZHANG Bin,LU Yong-ping,et al.Measurement system of torque-speed characteristic for induction motor based on DSP[J].Chinese Journal of Electron Devices,2007,30(2),530-533.
[2]尹大勇,盧青春.聶圣芳.基于實時嵌入式操作系統(tǒng)的電渦流測功機(jī)控制器開發(fā)[J].內(nèi)燃機(jī)工程,2005,26(4):77-80.YIN Da-yong,LU Qing-chun,NIE Sheng-fang.Development of control system for eddy current dynamometer based on embedded RTOS[J].Chinese Internal Combustion Engine Engineering,2005,26(4):77-80.
[3]王寶軍,丁軼成.智能化電機(jī)測功機(jī)實驗裝置的研制[J].實驗室研究與探索,2003,22(4):91-93.WANG Bao-jun,DING Yi-cheng.Development of the experimental set for measuring torque of motor[J].Research and Exploration in Laboratory,2003,22(4):91-93.
[4]王學(xué)之,王明渝.能量回饋式異步電力測功機(jī)系統(tǒng)的研究[J].微電機(jī),2010,33(4):87-90.WANG Xue-zhi,WANG Ming-yu.Research on energy-cycle power asynchronous dynamometer system[J].Micro-motor,2010,33(4):87-90.
[5]秦現(xiàn)生,白晶,李盤靖,等.交流數(shù)字測功機(jī)設(shè)計與實現(xiàn)[J].中國機(jī)械工程, 2007,18(13):1551-1555.QIN Xian-sheng,BAI Jing,LI Pan-jing,et al.Design and realization of AC chassis dynamometer system[J].The Chinese Mechanical Engineering,2007,18(13):1551-1555.
[6]吳新華,曾虹,張翔.基于嵌入式操作系統(tǒng)的測功機(jī)系統(tǒng)的開發(fā)[J].杭州電子科技大學(xué)學(xué)報,2007,27(6):59-63.WU Xin-Hua,ZENG Hong,ZHANG Xiang.Development of system for dynamometer on embedded RTOS[J].Journal of Hangzhou Dianzi University,2007,27(6):59-63.