基于FPGA的高可靠全自動(dòng)加樣器

　　1 系統(tǒng)方案

　　智能加樣器系統(tǒng)以FPGA為控制核心，通過(guò)控制步進(jìn)電機(jī)的運(yùn)動(dòng)，結(jié)合到位傳感器，控制整個(gè)設(shè)備機(jī)械平臺(tái)的正常運(yùn)轉(zhuǎn);通過(guò)處理液位傳感器信號(hào)和控制泵閥一體模塊，實(shí)現(xiàn)加樣功能;同時(shí)，采用無(wú)線網(wǎng)絡(luò)與安卓手機(jī)通訊，將安卓手機(jī)作為無(wú)線控制終端和數(shù)據(jù)顯示平臺(tái)。系統(tǒng)的設(shè)計(jì)方案如圖1所示。

　　為了提高系統(tǒng)加樣速率與效率，設(shè)計(jì)了以試管架作為加樣單位的加樣方式。如圖2所示，系統(tǒng)由步進(jìn)電機(jī)帶動(dòng)機(jī)械推臂和行車(chē)，實(shí)現(xiàn)試管架在進(jìn)樣倉(cāng)、加樣區(qū)與出樣倉(cāng)之間的推動(dòng)轉(zhuǎn)移，并在加樣區(qū)實(shí)現(xiàn)對(duì)試管的依次加樣。這種新型的加樣方式在進(jìn)行大批量加樣時(shí)具有顯著優(yōu)勢(shì)，便于操作和試管的置取。

　　2 電機(jī)控制

　　電機(jī)平穩(wěn)、流暢的運(yùn)行是保證系統(tǒng)可靠、自動(dòng)化運(yùn)行的基礎(chǔ)，為了更好的進(jìn)行電機(jī)的控制與精準(zhǔn)的位置調(diào)整，結(jié)合電機(jī)的步進(jìn)角、轉(zhuǎn)矩、動(dòng)力能力和工作頻率，選用STH-39D型兩相混合步進(jìn)電機(jī)，最小步進(jìn)角為1.8°，帶動(dòng)機(jī)械行車(chē)前進(jìn)最小距離為3mm，充分滿(mǎn)足設(shè)計(jì)要求。

　　為了確保電機(jī)運(yùn)行的速度與平穩(wěn)度，選用THB6128專(zhuān)用電機(jī)驅(qū)動(dòng)芯片為電機(jī)提供驅(qū)動(dòng)動(dòng)力，該芯片僅需輸入Step信號(hào)即可實(shí)現(xiàn)步進(jìn)勵(lì)磁。在FPGA中設(shè)計(jì)了步進(jìn)電機(jī)控制模塊，模塊框圖如圖3所示。電機(jī)控制模塊的主要功能是輸出使能和步進(jìn)脈沖信號(hào)，分別控制系統(tǒng)的5個(gè)電機(jī)實(shí)現(xiàn)加減速運(yùn)動(dòng)。

　　為了確保電機(jī)的流暢運(yùn)行，選擇經(jīng)典的7段式S型運(yùn)動(dòng)曲線如圖4所示，控制加速度連續(xù)變化，從而避免步進(jìn)電機(jī)在啟停階段的沖擊過(guò)大，防止步進(jìn)電機(jī)的卡頓和丟步現(xiàn)象。

　　3 液位探測(cè)

　　自動(dòng)液位探測(cè)是系統(tǒng)自動(dòng)化和精確加樣的保證。在加樣針的尖端設(shè)置電容式液位傳感器。當(dāng)針尖接觸到液面時(shí)，電容值發(fā)生將發(fā)生跳變，利用555振蕩器將電容值的變化轉(zhuǎn)化為輸出的脈沖信號(hào)周期的變化。將脈沖信號(hào)輸入FPGA的液位傳感器信號(hào)處理模塊，進(jìn)行濾波處理與跳變判斷，從而實(shí)現(xiàn)液位探測(cè)。

　　液位探測(cè)信號(hào)處理模塊使用均值濾波的方法過(guò)濾干擾，設(shè)置采樣周期為T(mén)(1)、T(2)…T(n)，將連續(xù)5點(diǎn)的均值作為當(dāng)前環(huán)境值T’(i)，如下式所示：