護(hù)調(diào)控系統(tǒng)：從滴速檢測(cè)到PID閉環(huán)控制)
1. 為什么要自己搭一套智能輸液監(jiān)護(hù)系統(tǒng)從醫(yī)院場(chǎng)景倒推出來(lái)的需求做嵌入式這幾年我陸陸續(xù)續(xù)接觸過(guò)不少醫(yī)療電子相關(guān)的項(xiàng)目但真正讓我下定決心把整套智能輸液監(jiān)護(hù)調(diào)控系統(tǒng)開(kāi)源出來(lái)的其實(shí)是一次去醫(yī)院的陪護(hù)經(jīng)歷。當(dāng)時(shí)隔壁床一位老人輸液藥液快滴完時(shí)家屬?zèng)]注意護(hù)工又忙不過(guò)來(lái)最后是靠鄰床提醒才叫來(lái)護(hù)士換藥。那一刻我就在想輸液監(jiān)護(hù)這件事表面上是個(gè)盯著吊瓶的小事實(shí)際上牽扯到患者安全、護(hù)士工作量、家屬焦慮感一堆問(wèn)題而市面上多數(shù)輸液泵的價(jià)格又讓很多基層醫(yī)療機(jī)構(gòu)和家庭場(chǎng)景望而卻步。正好那段時(shí)間我在做STM32相關(guān)的項(xiàng)目手頭有F103C8T6的板子又剛研究了步進(jìn)電機(jī)驅(qū)動(dòng)和多種傳感器融合的方案于是就有了這套智能輸液監(jiān)護(hù)調(diào)控系統(tǒng)升級(jí)版。所謂的升級(jí)版是相對(duì)于我上一版只做監(jiān)測(cè)報(bào)警來(lái)說(shuō)的——上一版只能檢測(cè)滴速異常和液位過(guò)低然后報(bào)警這一版加上了自動(dòng)調(diào)控的能力也就是說(shuō)系統(tǒng)不僅能發(fā)現(xiàn)問(wèn)題還能在安全范圍內(nèi)做初步處理比如暫停輸液、調(diào)整滴速甚至可以和上位機(jī)聯(lián)動(dòng)由醫(yī)護(hù)人員遠(yuǎn)程確認(rèn)后執(zhí)行操作。整個(gè)項(xiàng)目全部開(kāi)源包含三樣?xùn)|西完整可編譯的STM32工程代碼、Altium Designer繪制的原理圖、Proteus仿真工程。也就是說(shuō)你有三種方式來(lái)使用這套項(xiàng)目手上只有開(kāi)發(fā)板想快速驗(yàn)證邏輯可以直接看代碼和仿真工程想做一塊正經(jīng)的PCB原型機(jī)可以直接參考原理圖甚至改版想把它做成畢業(yè)設(shè)計(jì)、競(jìng)賽作品或者產(chǎn)品原型這套項(xiàng)目提供了完整的基線(xiàn)版本。項(xiàng)目的主要功能和性能指標(biāo)我先放在這兒方便你判斷這套東西是否值得深入看功能模塊具體能力實(shí)現(xiàn)方式滴速檢測(cè)紅外對(duì)管遮擋計(jì)數(shù)實(shí)時(shí)計(jì)算滴速滴/分鐘外部中斷 定時(shí)器窗口統(tǒng)計(jì)液位檢測(cè)輸液管末段液位傳感器低于閾值報(bào)警數(shù)字IO輪詢(xún) 消抖處理自動(dòng)調(diào)控步進(jìn)電機(jī)驅(qū)動(dòng)蠕動(dòng)泵PID閉環(huán)調(diào)節(jié)滴速增量式PID PWM細(xì)分驅(qū)動(dòng)人機(jī)交互OLED顯示實(shí)時(shí)參數(shù)按鍵設(shè)置目標(biāo)滴速I(mǎi)2C驅(qū)動(dòng)SSD1306 GPIO按鍵掃描報(bào)警系統(tǒng)聲光報(bào)警異常狀態(tài)分級(jí)提示蜂鳴器 LED 串口上報(bào)上位機(jī)通信串口協(xié)議上報(bào)數(shù)據(jù)和接收指令USART1中斷收發(fā) 自定義幀協(xié)議這套系統(tǒng)最能打的一點(diǎn)是它把監(jiān)測(cè)和調(diào)控這兩件事同時(shí)給做了。很多開(kāi)源項(xiàng)目只做監(jiān)測(cè)數(shù)據(jù)報(bào)了就不管了也有很多項(xiàng)目只做調(diào)控但不檢測(cè)實(shí)際效果。這套系統(tǒng)是先把滴速的實(shí)際值測(cè)準(zhǔn)然后用PID去逼近目標(biāo)值形成了一個(gè)完整的閉環(huán)控制鏈路。2. 系統(tǒng)硬件設(shè)計(jì)原理圖里的每一路信號(hào)都是有講究的2.1 主控選型STM32F103C8T6為什么是剛剛好的選擇主控我用了STM32F103C8T6這顆芯片在嵌入式圈子里幾乎人手一塊某寶上幾塊錢(qián)就能買(mǎi)到Flash雖然只有64KB但跑這套邏輯綽綽有余。選它有幾個(gè)具體考慮第一外設(shè)夠用且不浪費(fèi)。系統(tǒng)需要的核心外設(shè)是外部中斷、定時(shí)器、I2C、USART、GPIO、ADCF103C8T6全都具備而且數(shù)量正好匹配滴速檢測(cè)用PA0的外部中斷液位傳感器用PB0~PB3的數(shù)字輸入步進(jìn)電機(jī)用TIM2輸出PWM驅(qū)動(dòng)OLED走PB6/PB7的I2C1串口用PA9/PA10。資源表排得滿(mǎn)滿(mǎn)當(dāng)當(dāng)?shù)植痪o張這種剛剛好的感覺(jué)實(shí)際開(kāi)發(fā)中非常舒服。第二3.3V供電體系統(tǒng)一。整塊板子使用3.3V作為主邏輯電壓傳感器模塊、OLED模塊都能直接由板載LDO供電不需要額外電平轉(zhuǎn)換電路。這大大簡(jiǎn)化了原理圖的設(shè)計(jì)也降低了新手焊接時(shí)的出錯(cuò)概率。第三生態(tài)成熟調(diào)試工具鏈完備。無(wú)論是用標(biāo)準(zhǔn)外設(shè)庫(kù)還是HAL庫(kù)網(wǎng)上都有海量參考資料。我自己用標(biāo)準(zhǔn)外設(shè)庫(kù)寫(xiě)的這套代碼底層寄存器操作比較直觀(guān)也方便你移植到寄存器版或者HAL版。2.2 電源設(shè)計(jì)與隔離模擬和數(shù)字部分為什么必須分開(kāi)先說(shuō)一個(gè)很多人會(huì)忽略的問(wèn)題這套系統(tǒng)里既有傳感器的小信號(hào)紅外對(duì)管的微弱電流變化又有步進(jìn)電機(jī)的驅(qū)動(dòng)電流瞬時(shí)電流可能到幾百毫安甚至1A如果電源不處理好會(huì)出現(xiàn)一個(gè)非常典型的現(xiàn)象——電機(jī)一轉(zhuǎn)滴速檢測(cè)值就開(kāi)始亂跳。原因很簡(jiǎn)單電機(jī)啟動(dòng)時(shí)拉低電源電壓導(dǎo)致紅外對(duì)管的發(fā)射管光強(qiáng)閃爍接收端的信號(hào)就出現(xiàn)了毛刺。解決方案是在原理圖里做了模擬電源和數(shù)字電源的分區(qū)處理輸入電源先經(jīng)過(guò)一個(gè)SS34肖特基二極管做反接保護(hù)然后進(jìn)入AMS1117-3.3穩(wěn)壓輸出3.3V主電源模擬部分紅外對(duì)管接收端、液位傳感器的比較器供電通過(guò)一個(gè)磁珠L(zhǎng)1從3.3V分出VCC_ANA數(shù)字部分MCU、OLED、蜂鳴器、電機(jī)驅(qū)動(dòng)邏輯側(cè)直接接VCC_3V3模擬地AGND和數(shù)字地GND單點(diǎn)連接在電路板的電源入口處匯合。這么做的好處是電機(jī)和蜂鳴器工作時(shí)的電流波動(dòng)主要影響數(shù)字電源而模擬電源被磁珠的高頻阻抗擋在外面紅外對(duì)管接收端的信號(hào)穩(wěn)定性顯著提升。實(shí)測(cè)下來(lái)電機(jī)工作時(shí)滴速檢測(cè)值的波動(dòng)從原來(lái)的±5滴/分鐘降到了±1滴/分鐘以?xún)?nèi)這個(gè)改進(jìn)對(duì)PID控制至關(guān)重要——你給PID的反饋數(shù)據(jù)如果本身就不準(zhǔn)后面調(diào)得再辛苦也是白搭。2.3 紅外對(duì)管滴速檢測(cè)電路一個(gè)下拉電阻的坑我踩了整整一下午滴速檢測(cè)的原理不復(fù)雜輸液滴壺兩側(cè)分別放紅外發(fā)射管和接收管液滴落下時(shí)會(huì)短暫遮擋紅外光接收管的狀態(tài)就會(huì)從導(dǎo)通變到截止用一個(gè)上/下拉電阻把這個(gè)變化轉(zhuǎn)成電平跳變MCU就能通過(guò)外部中斷捕捉到每一次滴落。但這套方案里有個(gè)很隱蔽的坑就是接收管的偏置電阻怎么選。我給的是10K下拉電阻信號(hào)接到比較器的同相輸入端。一開(kāi)始為了省事我沒(méi)用比較器直接把接收管的分壓信號(hào)送進(jìn)MCU的GPIO結(jié)果發(fā)現(xiàn)信號(hào)邊緣特別軟滴速快了之后經(jīng)常丟中斷。后來(lái)查了邏輯分析儀才知道紅外管的光電響應(yīng)不是瞬間完成的分壓信號(hào)上升沿有幾十毫秒的斜坡MCU的施密特觸發(fā)雖然能處理一定的邊沿抖動(dòng)但高速滴落時(shí)連續(xù)兩個(gè)脈沖間隔太短信號(hào)還沒(méi)恢復(fù)到閾值就又掉下去了就會(huì)漏檢。最終的電路改成了LM393比較器整形接收管信號(hào)經(jīng)過(guò)10K/10K分壓后進(jìn)比較器的同相端反相端接一個(gè)可調(diào)電位器提供參考電壓。調(diào)整電位器可以設(shè)置觸發(fā)閾值保證滴落瞬間比較器快速翻轉(zhuǎn)輸出方波直接進(jìn)MCU的外部中斷引腳。這個(gè)方案的抗干擾能力比直接接GPIO強(qiáng)很多測(cè)試中在每分鐘20滴到200滴的范圍內(nèi)都能穩(wěn)定計(jì)數(shù)。2.4 步進(jìn)電機(jī)與蠕動(dòng)泵驅(qū)動(dòng)為什么我不建議你用直流電機(jī)自動(dòng)調(diào)控的核心執(zhí)行機(jī)構(gòu)是蠕動(dòng)泵——一根軟管被滾輪反復(fù)擠壓推動(dòng)液體往前流動(dòng)。蠕動(dòng)泵的流量和轉(zhuǎn)速近似線(xiàn)性所以用步進(jìn)電機(jī)驅(qū)動(dòng)比直流電機(jī)有天然優(yōu)勢(shì)精確控制步進(jìn)電機(jī)按固定角度走可以精確控制擠壓頻率從而實(shí)現(xiàn)精確的滴速控制保持力矩步進(jìn)電機(jī)在停止?fàn)顟B(tài)下也有保持力矩可以防止蠕動(dòng)泵在停止時(shí)由于液體壓力產(chǎn)生倒流無(wú)需編碼器開(kāi)環(huán)就能達(dá)到流量控制精度降低系統(tǒng)復(fù)雜度和成本。電機(jī)驅(qū)動(dòng)我選了ULN2003這是最經(jīng)典的達(dá)林頓管陣列芯片5線(xiàn)四相步進(jìn)電機(jī)28BYJ-48的標(biāo)準(zhǔn)搭配。原理圖里每一相都串了限流電阻并且在電機(jī)電源端加了100uF電解電容和104陶瓷電容做去耦。關(guān)于電機(jī)驅(qū)動(dòng)我的建議是如果你要做一個(gè)真正的產(chǎn)品級(jí)原型建議把ULN2003換成A4988或者DRV8825驅(qū)動(dòng)板。前者電流能力弱噪音大力矩也一般但用在Demo和畢設(shè)場(chǎng)景完全夠用且極便宜。后者支持細(xì)分驅(qū)動(dòng)噪音小很多但需要額外的邏輯電源和電機(jī)電源分離設(shè)計(jì)。這也是為什么我在原理圖里保留了電機(jī)供電接口的獨(dú)立性方便你后續(xù)替換驅(qū)動(dòng)方案。2.5 完整BOM和成本估算整套硬件做下來(lái)大約多少錢(qián)我把原理圖里所有器件整理一下給你做個(gè)成本參考按某寶零售價(jià)估算不含PCB打樣費(fèi)器件型號(hào)/規(guī)格數(shù)量參考單價(jià)小計(jì)主控STM32F103C8T616元6元紅外對(duì)管紅外發(fā)射/接收一體或分體2組1元2元比較器LM39310.5元0.5元穩(wěn)壓AMS1117-3.310.3元0.3元OLED屏SSD1306 0.96寸 I2C115元15元步進(jìn)電機(jī)28BYJ-48 ULN200318元8元蜂鳴器有源蜂鳴器11元1元按鍵輕觸開(kāi)關(guān)40.2元0.8元電阻電容各種規(guī)格若干-約3元PCB打樣嘉立創(chuàng)5片包郵1次約20元20元傳感器管子輸液管液位檢測(cè)附件1套約10元10元大約66.6元。這個(gè)成本做出來(lái)的東西功能上對(duì)標(biāo)幾千塊的輸液泵的監(jiān)測(cè)和基礎(chǔ)調(diào)控能力性?xún)r(jià)比是碾壓級(jí)的。當(dāng)然電機(jī)力矩、控制精度、安全認(rèn)證這些和醫(yī)療級(jí)設(shè)備肯定是沒(méi)法比的所以這個(gè)項(xiàng)目的定位很明確教學(xué)演示、原理驗(yàn)證、原型開(kāi)發(fā)、個(gè)人學(xué)習(xí)而不是臨床使用。3. 核心代碼與軟件邏輯從滴速計(jì)算到PID閉環(huán)控制3.1 工程代碼的整體架構(gòu)和文件劃分代碼我基于標(biāo)準(zhǔn)外設(shè)庫(kù)寫(xiě)的工程結(jié)構(gòu)嚴(yán)格按照模塊化思想劃分。你下載下來(lái)用Keil5打開(kāi)就能直接編譯不需要額外配置路徑。主目錄如下SmartInfusion/ ├── User/ │ ├── main.c // 主邏輯循環(huán) │ ├── stm32f10x_it.c // 中斷服務(wù)函數(shù) │ └── system_stm32f10x.c // 系統(tǒng)時(shí)鐘配置 ├── App/ │ ├── droplet_detect.c/h // 滴速檢測(cè)模塊 │ ├── liquid_level.c/h // 液位檢測(cè)模塊 │ ├── motor_control.c/h // 步進(jìn)電機(jī)控制模塊 │ ├── pid.c/h // PID算法模塊 │ ├── oled_display.c/h // OLED屏顯示模塊 │ ├── key_scan.c/h // 按鍵掃描模塊 │ └── alarm.c/h // 報(bào)警模塊 ├── BSP/ │ ├── usart.c/h // 串口初始化與收發(fā) │ ├── i2c.c/h // I2C軟件模擬 │ └── timer.c/h // 定時(shí)器初始化 └── Hardware/ ├── stm32f10x_conf.h └── stm32f10x.h這種分層的好處是App層的每個(gè)模塊只做自己的事通過(guò)接口函數(shù)互相調(diào)用不直接操作寄存器。比如滴速檢測(cè)模塊對(duì)外暴露一個(gè)DropletDect_GetSpeed()函數(shù)主循環(huán)只用調(diào)這個(gè)函數(shù)拿結(jié)果至于內(nèi)部是外部中斷計(jì)數(shù)還是定時(shí)器計(jì)算完全不用關(guān)心。你要改成HAL庫(kù)只需要把BSP層重寫(xiě)一遍App層代碼幾乎不用動(dòng)。3.2 滴速檢測(cè)的算法細(xì)節(jié)怎么把兩次滴落間隔換算成滴/分鐘滴速檢測(cè)的核心是外部中斷定時(shí)器窗口統(tǒng)計(jì)。我在EXTI0_IRQHandler中斷服務(wù)函數(shù)里做兩件事第一讀取當(dāng)前系統(tǒng)滴落計(jì)數(shù)器的值g_dropletCount加1 第二判斷如果當(dāng)前處于統(tǒng)計(jì)窗口內(nèi)定時(shí)器每5秒觸發(fā)一次窗口更新就記錄兩次滴落的時(shí)間戳計(jì)算出當(dāng)前滴速。// App/droplet_detect.c 核心片段 volatile uint32_t g_dropletCount 0; volatile uint32_t g_lastTick 0; volatile uint16_t g_speedDropletsPerMin 0; static uint32_t s_windowStartTick 0; static uint32_t s_windowDropletCount 0; void EXTI0_IRQHandler(void) { if (EXTI_GetITStatus(EXTI_Line0) ! RESET) { uint32_t now TIM2-CNT; // 如果兩次滴落間隔太短判定為抖動(dòng)忽略 if (now - g_lastTick 10) { g_dropletCount; g_lastTick now; } EXTI_ClearITPendingBit(EXTI_Line0); } } void DropletDect_UpdateSpeed(void) { uint32_t now TIM2-CNT; uint32_t elapsed now - s_windowStartTick; if (elapsed 5000) // 5秒統(tǒng)計(jì)窗口 { uint32_t dropletsInWindow g_dropletCount - s_windowDropletCount; // 換算為每分鐘滴速 g_speedDropletsPerMin (uint16_t)((float)dropletsInWindow * 12.0f); s_windowStartTick now; s_windowDropletCount g_dropletCount; } }這里有個(gè)容易被新手忽略的細(xì)節(jié)為什么統(tǒng)計(jì)窗口是5秒而不是1秒或者10秒如果窗口太短比如1秒那么滴速慢時(shí)比如每分鐘20滴一次滴落間隔是3秒一個(gè)1秒窗口內(nèi)可能一次滴落都沒(méi)有測(cè)出來(lái)的速度就是0滴/分鐘這顯然不對(duì)窗口太長(zhǎng)比如10秒系統(tǒng)對(duì)滴速變化的實(shí)時(shí)性就差。5秒是一個(gè)折中——對(duì)于每分鐘12滴以上的輸液速度臨床上常見(jiàn)范圍是20~60滴/分鐘5秒窗口至少能捕捉到1~5個(gè)脈沖換算成滴/分鐘誤差可控。實(shí)際測(cè)試中這個(gè)窗口下穩(wěn)態(tài)誤差在±2滴以?xún)?nèi)對(duì)PID控制來(lái)說(shuō)是夠用的。另外注意代碼里有個(gè)抖動(dòng)過(guò)濾兩次中斷間隔小于10ms就忽略。因?yàn)榧t外對(duì)管在液滴落下的瞬間可能出現(xiàn)回彈液滴表面張力導(dǎo)致光線(xiàn)多次遮擋不處理就會(huì)一次滴落記成多次。3.3 PID調(diào)參實(shí)戰(zhàn)記錄從發(fā)散到穩(wěn)定的完整過(guò)程PID是這套系統(tǒng)里最硬核的部分也是很多人在畢設(shè)或競(jìng)賽里最容易翻車(chē)的地方。我把實(shí)際調(diào)參過(guò)程記錄下來(lái)因?yàn)檫@比單純貼代碼有用得多。首先明確被控對(duì)象和控制量被控對(duì)象蠕動(dòng)泵的滴速單位滴/分鐘執(zhí)行器步進(jìn)電機(jī)的轉(zhuǎn)速單位拍/秒對(duì)應(yīng)相序脈沖頻率反饋量紅外對(duì)管測(cè)得的實(shí)際滴速我最初寫(xiě)的PID參數(shù)是理論值P1.0I0.1D0.0想著反正系統(tǒng)慣量不大先跑起來(lái)看看。結(jié)果一跑電機(jī)瘋狂振蕩滴速在目標(biāo)值上下大幅擺動(dòng)有時(shí)還沖出安全范圍觸發(fā)報(bào)警。用串口把數(shù)據(jù)導(dǎo)出來(lái)畫(huà)圖就是那種經(jīng)典的等幅振蕩曲線(xiàn)。后來(lái)我系統(tǒng)地做了調(diào)整第一步把I和D先設(shè)0只留P。從P0.1開(kāi)始往上漲每次跑30秒看響應(yīng)曲線(xiàn)。發(fā)現(xiàn)P0.3時(shí)系統(tǒng)已經(jīng)能接近目標(biāo)值但有穩(wěn)態(tài)誤差P0.5時(shí)就開(kāi)始出現(xiàn)輕微過(guò)沖P0.8時(shí)明顯振蕩。于是把P定在0.35。第二步加I消除穩(wěn)態(tài)誤差。I0.05觀(guān)察系統(tǒng)能不能緩慢逼近目標(biāo)值。發(fā)現(xiàn)響應(yīng)偏慢調(diào)到0.08后穩(wěn)態(tài)誤差基本消除但出現(xiàn)了一點(diǎn)低頻波動(dòng)。又調(diào)回0.06波動(dòng)消失。第三步加D抑制過(guò)沖。目標(biāo)值從30滴突變?yōu)?0滴時(shí)純PI會(huì)產(chǎn)生約15%的過(guò)沖。D0.2時(shí)過(guò)沖減小到5%以?xún)?nèi)但響應(yīng)速度略有下降。最后D取0.15過(guò)沖約3%調(diào)節(jié)時(shí)間約10秒各項(xiàng)指標(biāo)都滿(mǎn)足需求。最終參數(shù)// App/pid.c 最終調(diào)參結(jié)果 PID_TypeDef g_pid { .targetValue 40.0f, // 目標(biāo)滴速 .kp 0.35f, // 比例系數(shù) .ki 0.06f, // 積分系數(shù) .kd 0.15f, // 微分系數(shù) .outputLimit 1000.0f, // 輸出限幅步進(jìn)電機(jī)最高脈沖頻率 };關(guān)于PID有個(gè)非常重要但經(jīng)常被忽略的點(diǎn)輸出限幅。步進(jìn)電機(jī)的脈沖頻率不是可以無(wú)限大的超出電機(jī)響應(yīng)能力后脈沖再多也是白搭反而會(huì)讓電機(jī)丟步。我把輸出限幅設(shè)為1000PPS對(duì)應(yīng)蠕動(dòng)泵最高流速約每分鐘120滴這個(gè)值在醫(yī)療輸液場(chǎng)景下已經(jīng)非常高了。還有一個(gè)工程技巧積分分離。當(dāng)實(shí)際滴速和目標(biāo)值偏差超過(guò)設(shè)定范圍時(shí)我設(shè)為20滴把積分項(xiàng)清零防止積分飽和導(dǎo)致系統(tǒng)過(guò)沖。這個(gè)邏輯用代碼寫(xiě)很簡(jiǎn)單但對(duì)控制效果的提升非常明顯。float PID_Calculate(PID_TypeDef *pid, float currentValue) { float error pid-targetValue - currentValue; float proportional pid-kp * error; float integral pid-integral; if (error 20.0f) // 積分分離偏差過(guò)大時(shí)關(guān)閉積分 { integral pid-ki * error; pid-integral integral; } else { pid-integral 0.0f; } float derivative pid-kd * (error - pid-lastError); pid-lastError error; float output proportional integral derivative; // 輸出限幅 if (output pid-outputLimit) output pid-outputLimit; if (output -pid-outputLimit) output -pid-outputLimit; return output; }3.4 串口協(xié)議設(shè)計(jì)自定義幀格式 握手應(yīng)答機(jī)制上位機(jī)通信的串口協(xié)議我設(shè)計(jì)成一個(gè)簡(jiǎn)單的自定義幀幀頭 設(shè)備地址 命令字 數(shù)據(jù)長(zhǎng)度 數(shù)據(jù)域 校驗(yàn)字節(jié)。校驗(yàn)采用異或和夠簡(jiǎn)單也夠用。// 協(xié)議幀格式 // | 0xAA | 0x5A | ADDR | CMD | LEN | DATA... | XOR_CHECK |命令分為三類(lèi)0x01 查詢(xún)命令上位機(jī)請(qǐng)求設(shè)備狀態(tài)設(shè)備回復(fù)當(dāng)前滴速、液位狀態(tài)、報(bào)警狀態(tài)0x02 控制命令上位機(jī)設(shè)置目標(biāo)滴速、啟動(dòng)/暫停電機(jī)0x03 主動(dòng)上報(bào)設(shè)備在滴速異常、液位過(guò)低時(shí)主動(dòng)上報(bào)報(bào)警事件。握手流程是設(shè)備上電后每2秒發(fā)送一次心跳幀上位機(jī)收到后如果設(shè)備地址匹配就回復(fù)ACK之后進(jìn)入正常工作模式。這個(gè)握手機(jī)制解決了一個(gè)很實(shí)際的痛點(diǎn)如果上位機(jī)軟件沒(méi)打開(kāi)或者串口被占用設(shè)備會(huì)一直嘗試連接但不會(huì)誤動(dòng)作。有人可能會(huì)問(wèn)為什么不用Modbus這樣現(xiàn)成的協(xié)議因?yàn)轫?xiàng)目定位是輕量級(jí)教學(xué)/原型Modbus雖然規(guī)范但幀結(jié)構(gòu)較復(fù)雜在小資源MCU上跑起來(lái)有點(diǎn)大材小用。自己定義協(xié)議幀的好處是代碼量小、邏輯直觀(guān)而且上位機(jī)這邊我用Python的pyserial寫(xiě)了個(gè)簡(jiǎn)單的調(diào)試工具幾行代碼就能解析幀并實(shí)時(shí)顯示數(shù)據(jù)。4. 仿真工程與實(shí)物聯(lián)調(diào)Proteus仿真能驗(yàn)證什么不能驗(yàn)證什么4.1 仿真工程的搭建細(xì)節(jié)Proteus仿真工程里我把硬件設(shè)計(jì)等比例映射進(jìn)去STM32F103C8T6模型、LM393比較器模型、紅外對(duì)管可以用開(kāi)關(guān)信號(hào)發(fā)生器模擬、步進(jìn)電機(jī)用仿真模型、OLED用I2C顯示模型。你在Proteus里打開(kāi)工程就能直接跑程序燒到虛擬MCU里OLED會(huì)顯示仿真滴速和狀態(tài)。仿真工程的價(jià)值主要在邏輯驗(yàn)證階段。比如我想測(cè)試目標(biāo)滴速?gòu)?0變成80時(shí)PID如何響應(yīng)在實(shí)物上需要手動(dòng)調(diào)整吊瓶高度或者更換泵管在仿真里只需要改一個(gè)參數(shù)就行。這種改參秒級(jí)驗(yàn)證的效率優(yōu)勢(shì)在開(kāi)發(fā)初期非常明顯。4.2 仿真和實(shí)物最大的差異信號(hào)完整性但必須坦白講仿真不能替代實(shí)物驗(yàn)證最大的原因在于信號(hào)完整性。Proteus里的紅外對(duì)管不會(huì)受到電機(jī)電源波動(dòng)的影響LM393的輸出也是理想的數(shù)字電平但在實(shí)物上電機(jī)的EMI干擾、電源紋波、導(dǎo)線(xiàn)電感這些東西全都存在。我在實(shí)物調(diào)試時(shí)就遇到過(guò)一個(gè)非常詭異的現(xiàn)象電機(jī)轉(zhuǎn)動(dòng)后滴速檢測(cè)值從每分鐘60掉到了每分鐘8一開(kāi)始還以為是傳感器壞了后來(lái)用示波器一看原來(lái)是電機(jī)在地線(xiàn)上產(chǎn)生的紋波干擾了紅外接收管的參考電壓導(dǎo)致比較器誤觸發(fā)。這類(lèi)問(wèn)題在仿真里根本復(fù)現(xiàn)不出來(lái)所以我的建議是用仿真驗(yàn)證算法邏輯用實(shí)物驗(yàn)證信號(hào)鏈路。兩者配合才能保證系統(tǒng)的可靠性。4.3 上位機(jī)聯(lián)調(diào)Python開(kāi)個(gè)可視化的數(shù)據(jù)監(jiān)控小工具串口協(xié)議既然定好了上位機(jī)端我也順手寫(xiě)了個(gè)Python小工具用來(lái)實(shí)時(shí)顯示滴速曲線(xiàn)和系統(tǒng)狀態(tài)。代碼很簡(jiǎn)單核心邏輯就是串口接收和解析——讀取到幀頭0xAA 0x5A后按幀格式解析命令把滴速數(shù)據(jù)畫(huà)成折線(xiàn)圖。import serial import matplotlib.pyplot as plt import matplotlib.animation as animation ser serial.Serial(COM3, 115200, timeout1) speed_history [] def parse_frame(data): # 完整幀解析邏輯 # 如果數(shù)據(jù)幀的校驗(yàn)通過(guò)返回滴速值 return speed def update_plot(frame): raw_data ser.read(64) if raw_data: speed parse_frame(raw_data) if speed is not None: speed_history.append(speed) if len(speed_history) 100: speed_history.pop(0) plt.cla() plt.plot(speed_history) plt.xlabel(Time) plt.ylabel(Droplets/min) plt.title(Infusion Speed Monitor) ani animation.FuncAnimation(plt.gcf(), update_plot, interval500) plt.show()這個(gè)工具在調(diào)PID時(shí)作用巨大。你能直觀(guān)看到系統(tǒng)的響應(yīng)曲線(xiàn)比如是否存在過(guò)沖、穩(wěn)態(tài)誤差有多大、調(diào)節(jié)時(shí)間有多長(zhǎng)。如果沒(méi)有可視化工具只靠OLED屏上的數(shù)字這類(lèi)調(diào)試基本沒(méi)法做。4.4 三套使用路徑的配合關(guān)系至此你應(yīng)該能看出整個(gè)項(xiàng)目代碼、原理圖、仿真三者之間的關(guān)系了路徑需要的資源適合場(chǎng)景能驗(yàn)證什么純仿真仿真工程 代碼邏輯入門(mén)、PID調(diào)參、演示講解算法正確性、邏輯分支、控制效果實(shí)物原型原理圖 代碼畢設(shè)實(shí)物、競(jìng)賽作品、產(chǎn)品驗(yàn)證電路設(shè)計(jì)、信號(hào)質(zhì)量、實(shí)際控制精度二次開(kāi)發(fā)全部代碼 原理圖擴(kuò)展功能、改成無(wú)線(xiàn)方案、升級(jí)屏幕等架構(gòu)擴(kuò)展性、代碼可維護(hù)性我之前遇到過(guò)不少問(wèn)能不能只做仿真不做實(shí)物的同學(xué)——能但你要清楚仿真做出來(lái)的東西只能證明邏輯對(duì)了不能證明電路對(duì)了。反過(guò)來(lái)如果你直接開(kāi)打PCB卻不先跑仿真一旦PID邏輯有bug改板子的成本比改代碼高得多。所以最穩(wěn)的路徑永遠(yuǎn)是仿真先行實(shí)物跟上兩者互相印證。5. 從初版到升級(jí)版的演進(jìn)換代過(guò)程中踩過(guò)的最記憶深刻的幾個(gè)坑5.1 初版報(bào)警誤報(bào)率為什么居高不下來(lái)自滴壺掛壁水珠的干擾上一版的系統(tǒng)主要做監(jiān)測(cè)報(bào)警但初版做完后我拿到真實(shí)輸液場(chǎng)景測(cè)試發(fā)現(xiàn)誤報(bào)率高到?jīng)]法用。最典型的一個(gè)場(chǎng)景輸液滴壺上方的管壁掛了一顆水珠它不落下只是掛在管壁上紅外對(duì)管長(zhǎng)時(shí)間處于遮擋狀態(tài)系統(tǒng)就判定為滴速為0并報(bào)警。但實(shí)際上輸液是正常的只是那滴水珠剛好擋住了紅外線(xiàn)。解決思路是區(qū)分長(zhǎng)時(shí)間遮擋和持續(xù)滴落的波形特征。真正的滴落是一個(gè)短暫的脈沖——遮擋時(shí)間通常在50~200ms左右然后迅速恢復(fù)掛壁水珠則是持續(xù)的遮擋。于是代碼里加了一個(gè)邏輯如果遮光持續(xù)時(shí)間超過(guò)500ms就不算一次滴落而是標(biāo)記為疑似掛壁進(jìn)入異常檢測(cè)分支。這個(gè)改進(jìn)沒(méi)有增加任何硬件成本純靠軟件算法就解決了。機(jī)電系統(tǒng)里的很多問(wèn)題都是這樣先別急著換硬件想想能不能通過(guò)軟件邏輯來(lái)看穿物理世界的噪聲。5.2 升級(jí)版新加入的電機(jī)控制給電源帶來(lái)的連鎖反應(yīng)升級(jí)版加了電機(jī)之后新的問(wèn)題又來(lái)了電機(jī)一啟動(dòng)OLED屏幕亮度就閃爍串口偶爾還會(huì)出現(xiàn)亂碼。排查之后發(fā)現(xiàn)是電源的問(wèn)題——電機(jī)啟動(dòng)瞬間電流尖峰導(dǎo)致3.3V電壓跌落MCU和OLED雖然不是同一個(gè)電源網(wǎng)絡(luò)但地線(xiàn)是共用的地線(xiàn)上的壓差直接影響了信號(hào)質(zhì)量。這個(gè)問(wèn)題的處理我在前面原理圖部分已經(jīng)提到模擬/數(shù)字分離、電機(jī)電源獨(dú)立、加去耦電容。但更重要的是要有排查思路先用示波器看電源紋波再用邏輯分析儀看串口信號(hào)逐步縮小范圍最后鎖定到地線(xiàn)公共阻抗噪聲。分享這個(gè)例子的目的是想說(shuō)設(shè)計(jì)時(shí)預(yù)留好測(cè)試點(diǎn)非常重要。我在原理圖的電源、地、關(guān)鍵信號(hào)上都加了測(cè)試焊盤(pán)調(diào)試時(shí)直接夾示波器探頭就行不用拆線(xiàn)省了很多時(shí)間。5.3 兩個(gè)防呆設(shè)計(jì)堵轉(zhuǎn)保護(hù)與報(bào)警延遲消抖升級(jí)版另外加了兩個(gè)防呆設(shè)計(jì)我覺(jué)得對(duì)做同類(lèi)項(xiàng)目的你有參考價(jià)值第一個(gè)是堵轉(zhuǎn)保護(hù)。蠕動(dòng)泵在輸液過(guò)程中如果輸液管被折疊或者患者移動(dòng)扯到了管路泵的負(fù)載會(huì)突然增大步進(jìn)電機(jī)可能丟步堵轉(zhuǎn)。如果不處理電機(jī)會(huì)持續(xù)發(fā)熱嚴(yán)重時(shí)可能損壞電機(jī)或管路。我在電機(jī)控制模塊里加了一個(gè)邏輯如果連續(xù)10次PID運(yùn)算中輸出值都超過(guò)上限的90%但實(shí)際滴速幾乎為0就判定為堵轉(zhuǎn)立即停止電機(jī)并報(bào)警。// motor_control.c void Motor_CheckStall(void) { static uint8_t highOutputCount 0; if (g_pid.output g_pid.outputLimit * 0.9f g_speedDropletsPerMin 5) { highOutputCount; if (highOutputCount 10) { Motor_StopEmergency(); Alarm_Raise(ALARM_STALL); highOutputCount 0; } } else { highOutputCount 0; } }第二個(gè)是報(bào)警延遲消抖。液位傳感器在輸液過(guò)程中可能因?yàn)闅馀萁?jīng)過(guò)產(chǎn)生短暫的誤觸發(fā)信號(hào)如果一觸發(fā)就報(bào)警會(huì)很煩人。我加了一個(gè)軟件消抖邏輯液位低信號(hào)必須持續(xù)超過(guò)3秒才觸發(fā)報(bào)警。這個(gè)延遲時(shí)間既不影響安全性輸液管末段的液位低到報(bào)警點(diǎn)后到完全滴空還有至少幾十秒的緩沖又有效避免了誤報(bào)。5.4 從這一版還能往哪些方向繼續(xù)升級(jí)這套系統(tǒng)現(xiàn)在的開(kāi)源版本其實(shí)還有很大的擴(kuò)展空間。如果你想在這個(gè)基礎(chǔ)上繼續(xù)做我建議按下面的優(yōu)先級(jí)考慮第一加無(wú)線(xiàn)通信模塊。把串口協(xié)議改成通過(guò)ESP8266/ESP32的WiFi模塊或者HC-05藍(lán)牙模塊傳輸就能實(shí)現(xiàn)護(hù)士站大屏監(jiān)控。硬件只需要在USART1上掛一個(gè)透?jìng)髂K協(xié)議幾乎不用改。第二加多通道支持。當(dāng)前版本是單通道輸液監(jiān)護(hù)如果要做多通道主控建議換成STM32F103ZET6144pin的型號(hào)它有更多的外部中斷引腳和定時(shí)器通道靠軟件框架的模塊化復(fù)制一份App層的邏輯就能擴(kuò)展一路。第三加斷電續(xù)調(diào)。用EEPROMI2C接口的AT24C02保存當(dāng)前的PID參數(shù)和運(yùn)行狀態(tài)掉電后重新上電可以自動(dòng)恢復(fù)中斷前的輸液任務(wù)不用護(hù)士重新設(shè)置。第四加GSM/4G遠(yuǎn)程報(bào)警。對(duì)于家庭場(chǎng)景用SIM800L模塊發(fā)送短信報(bào)警這是目前很多商用產(chǎn)品不具備但實(shí)際需求很強(qiáng)的功能。這套項(xiàng)目做到這版已經(jīng)是從傳感器采集到閉環(huán)控制從本地顯示到上位機(jī)聯(lián)動(dòng)的全鏈路閉環(huán)了。結(jié)構(gòu)上足夠覆蓋一個(gè)典型的嵌入式系統(tǒng)包含的幾乎所有技術(shù)要素中斷、定時(shí)器、PWM、PID、串口協(xié)議、模塊化編程。如果你正在做類(lèi)似的項(xiàng)目可以直接拿這套代碼和原理圖當(dāng)基線(xiàn)把精力花在你特有的創(chuàng)新點(diǎn)上比從零開(kāi)始要高效得多。最后分享一個(gè)我做這類(lèi)項(xiàng)目多年下來(lái)的體會(huì)做嵌入式系統(tǒng)功能實(shí)現(xiàn)只是第一步把穩(wěn)定可靠四個(gè)字刻進(jìn)代碼里才是真正拉開(kāi)差距的地方。比如滴速檢測(cè)的抖動(dòng)過(guò)濾、報(bào)警的延時(shí)消抖、電機(jī)的堵轉(zhuǎn)保護(hù)這些初看都是小事但正是這些細(xì)節(jié)決定了別人愿意不愿意把你的作品當(dāng)成產(chǎn)品來(lái)用。希望這套開(kāi)源項(xiàng)目能幫你少走一些我走過(guò)的彎路。 基于STM32的智能輸液監(jiān)護(hù)調(diào)控系統(tǒng)：從滴速檢測(cè)到PID閉環(huán)控制
1. 為什么要自己搭一套智能輸液監(jiān)護(hù)系統(tǒng)從醫(yī)院場(chǎng)景倒推出來(lái)的需求做嵌入式這幾年我陸陸續(xù)續(xù)接觸過(guò)不少醫(yī)療電子相關(guān)的項(xiàng)目但真正讓我下定決心把整套智能輸液監(jiān)護(hù)調(diào)控系統(tǒng)開(kāi)源出來(lái)的其實(shí)是一次去醫(yī)院的陪護(hù)經(jīng)歷。當(dāng)時(shí)隔壁床一位老人輸液藥液快滴完時(shí)家屬?zèng)]注意護(hù)工又忙不過(guò)來(lái)最后是靠鄰床提醒才叫來(lái)護(hù)士換藥。那一刻我就在想輸液監(jiān)護(hù)這件事表面上是個(gè)盯著吊瓶的小事實(shí)際上牽扯到患者安全、護(hù)士工作量、家屬焦慮感一堆問(wèn)題而市面上多數(shù)輸液泵的價(jià)格又讓很多基層醫(yī)療機(jī)構(gòu)和家庭場(chǎng)景望而卻步。正好那段時(shí)間我在做STM32相關(guān)的項(xiàng)目手頭有F103C8T6的板子又剛研究了步進(jìn)電機(jī)驅(qū)動(dòng)和多種傳感器融合的方案于是就有了這套智能輸液監(jiān)護(hù)調(diào)控系統(tǒng)升級(jí)版。所謂的升級(jí)版是相對(duì)于我上一版只做監(jiān)測(cè)報(bào)警來(lái)說(shuō)的——上一版只能檢測(cè)滴速異常和液位過(guò)低然后報(bào)警這一版加上了自動(dòng)調(diào)控的能力也就是說(shuō)系統(tǒng)不僅能發(fā)現(xiàn)問(wèn)題還能在安全范圍內(nèi)做初步處理比如暫停輸液、調(diào)整滴速甚至可以和上位機(jī)聯(lián)動(dòng)由醫(yī)護(hù)人員遠(yuǎn)程確認(rèn)后執(zhí)行操作。整個(gè)項(xiàng)目全部開(kāi)源包含三樣?xùn)|西完整可編譯的STM32工程代碼、Altium Designer繪制的原理圖、Proteus仿真工程。也就是說(shuō)你有三種方式來(lái)使用這套項(xiàng)目手上只有開(kāi)發(fā)板想快速驗(yàn)證邏輯可以直接看代碼和仿真工程想做一塊正經(jīng)的PCB原型機(jī)可以直接參考原理圖甚至改版想把它做成畢業(yè)設(shè)計(jì)、競(jìng)賽作品或者產(chǎn)品原型這套項(xiàng)目提供了完整的基線(xiàn)版本。項(xiàng)目的主要功能和性能指標(biāo)我先放在這兒方便你判斷這套東西是否值得深入看功能模塊具體能力實(shí)現(xiàn)方式滴速檢測(cè)紅外對(duì)管遮擋計(jì)數(shù)實(shí)時(shí)計(jì)算滴速滴/分鐘外部中斷 定時(shí)器窗口統(tǒng)計(jì)液位檢測(cè)輸液管末段液位傳感器低于閾值報(bào)警數(shù)字IO輪詢(xún) 消抖處理自動(dòng)調(diào)控步進(jìn)電機(jī)驅(qū)動(dòng)蠕動(dòng)泵PID閉環(huán)調(diào)節(jié)滴速增量式PID PWM細(xì)分驅(qū)動(dòng)人機(jī)交互OLED顯示實(shí)時(shí)參數(shù)按鍵設(shè)置目標(biāo)滴速I(mǎi)2C驅(qū)動(dòng)SSD1306 GPIO按鍵掃描報(bào)警系統(tǒng)聲光報(bào)警異常狀態(tài)分級(jí)提示蜂鳴器 LED 串口上報(bào)上位機(jī)通信串口協(xié)議上報(bào)數(shù)據(jù)和接收指令USART1中斷收發(fā) 自定義幀協(xié)議這套系統(tǒng)最能打的一點(diǎn)是它把監(jiān)測(cè)和調(diào)控這兩件事同時(shí)給做了。很多開(kāi)源項(xiàng)目只做監(jiān)測(cè)數(shù)據(jù)報(bào)了就不管了也有很多項(xiàng)目只做調(diào)控但不檢測(cè)實(shí)際效果。這套系統(tǒng)是先把滴速的實(shí)際值測(cè)準(zhǔn)然后用PID去逼近目標(biāo)值形成了一個(gè)完整的閉環(huán)控制鏈路。2. 系統(tǒng)硬件設(shè)計(jì)原理圖里的每一路信號(hào)都是有講究的2.1 主控選型STM32F103C8T6為什么是剛剛好的選擇主控我用了STM32F103C8T6這顆芯片在嵌入式圈子里幾乎人手一塊某寶上幾塊錢(qián)就能買(mǎi)到Flash雖然只有64KB但跑這套邏輯綽綽有余。選它有幾個(gè)具體考慮第一外設(shè)夠用且不浪費(fèi)。系統(tǒng)需要的核心外設(shè)是外部中斷、定時(shí)器、I2C、USART、GPIO、ADCF103C8T6全都具備而且數(shù)量正好匹配滴速檢測(cè)用PA0的外部中斷液位傳感器用PB0~PB3的數(shù)字輸入步進(jìn)電機(jī)用TIM2輸出PWM驅(qū)動(dòng)OLED走PB6/PB7的I2C1串口用PA9/PA10。資源表排得滿(mǎn)滿(mǎn)當(dāng)當(dāng)?shù)植痪o張這種剛剛好的感覺(jué)實(shí)際開(kāi)發(fā)中非常舒服。第二3.3V供電體系統(tǒng)一。整塊板子使用3.3V作為主邏輯電壓傳感器模塊、OLED模塊都能直接由板載LDO供電不需要額外電平轉(zhuǎn)換電路。這大大簡(jiǎn)化了原理圖的設(shè)計(jì)也降低了新手焊接時(shí)的出錯(cuò)概率。第三生態(tài)成熟調(diào)試工具鏈完備。無(wú)論是用標(biāo)準(zhǔn)外設(shè)庫(kù)還是HAL庫(kù)網(wǎng)上都有海量參考資料。我自己用標(biāo)準(zhǔn)外設(shè)庫(kù)寫(xiě)的這套代碼底層寄存器操作比較直觀(guān)也方便你移植到寄存器版或者HAL版。2.2 電源設(shè)計(jì)與隔離模擬和數(shù)字部分為什么必須分開(kāi)先說(shuō)一個(gè)很多人會(huì)忽略的問(wèn)題這套系統(tǒng)里既有傳感器的小信號(hào)紅外對(duì)管的微弱電流變化又有步進(jìn)電機(jī)的驅(qū)動(dòng)電流瞬時(shí)電流可能到幾百毫安甚至1A如果電源不處理好會(huì)出現(xiàn)一個(gè)非常典型的現(xiàn)象——電機(jī)一轉(zhuǎn)滴速檢測(cè)值就開(kāi)始亂跳。原因很簡(jiǎn)單電機(jī)啟動(dòng)時(shí)拉低電源電壓導(dǎo)致紅外對(duì)管的發(fā)射管光強(qiáng)閃爍接收端的信號(hào)就出現(xiàn)了毛刺。解決方案是在原理圖里做了模擬電源和數(shù)字電源的分區(qū)處理輸入電源先經(jīng)過(guò)一個(gè)SS34肖特基二極管做反接保護(hù)然后進(jìn)入AMS1117-3.3穩(wěn)壓輸出3.3V主電源模擬部分紅外對(duì)管接收端、液位傳感器的比較器供電通過(guò)一個(gè)磁珠L(zhǎng)1從3.3V分出VCC_ANA數(shù)字部分MCU、OLED、蜂鳴器、電機(jī)驅(qū)動(dòng)邏輯側(cè)直接接VCC_3V3模擬地AGND和數(shù)字地GND單點(diǎn)連接在電路板的電源入口處匯合。這么做的好處是電機(jī)和蜂鳴器工作時(shí)的電流波動(dòng)主要影響數(shù)字電源而模擬電源被磁珠的高頻阻抗擋在外面紅外對(duì)管接收端的信號(hào)穩(wěn)定性顯著提升。實(shí)測(cè)下來(lái)電機(jī)工作時(shí)滴速檢測(cè)值的波動(dòng)從原來(lái)的±5滴/分鐘降到了±1滴/分鐘以?xún)?nèi)這個(gè)改進(jìn)對(duì)PID控制至關(guān)重要——你給PID的反饋數(shù)據(jù)如果本身就不準(zhǔn)后面調(diào)得再辛苦也是白搭。2.3 紅外對(duì)管滴速檢測(cè)電路一個(gè)下拉電阻的坑我踩了整整一下午滴速檢測(cè)的原理不復(fù)雜輸液滴壺兩側(cè)分別放紅外發(fā)射管和接收管液滴落下時(shí)會(huì)短暫遮擋紅外光接收管的狀態(tài)就會(huì)從導(dǎo)通變到截止用一個(gè)上/下拉電阻把這個(gè)變化轉(zhuǎn)成電平跳變MCU就能通過(guò)外部中斷捕捉到每一次滴落。但這套方案里有個(gè)很隱蔽的坑就是接收管的偏置電阻怎么選。我給的是10K下拉電阻信號(hào)接到比較器的同相輸入端。一開(kāi)始為了省事我沒(méi)用比較器直接把接收管的分壓信號(hào)送進(jìn)MCU的GPIO結(jié)果發(fā)現(xiàn)信號(hào)邊緣特別軟滴速快了之后經(jīng)常丟中斷。后來(lái)查了邏輯分析儀才知道紅外管的光電響應(yīng)不是瞬間完成的分壓信號(hào)上升沿有幾十毫秒的斜坡MCU的施密特觸發(fā)雖然能處理一定的邊沿抖動(dòng)但高速滴落時(shí)連續(xù)兩個(gè)脈沖間隔太短信號(hào)還沒(méi)恢復(fù)到閾值就又掉下去了就會(huì)漏檢。最終的電路改成了LM393比較器整形接收管信號(hào)經(jīng)過(guò)10K/10K分壓后進(jìn)比較器的同相端反相端接一個(gè)可調(diào)電位器提供參考電壓。調(diào)整電位器可以設(shè)置觸發(fā)閾值保證滴落瞬間比較器快速翻轉(zhuǎn)輸出方波直接進(jìn)MCU的外部中斷引腳。這個(gè)方案的抗干擾能力比直接接GPIO強(qiáng)很多測(cè)試中在每分鐘20滴到200滴的范圍內(nèi)都能穩(wěn)定計(jì)數(shù)。2.4 步進(jìn)電機(jī)與蠕動(dòng)泵驅(qū)動(dòng)為什么我不建議你用直流電機(jī)自動(dòng)調(diào)控的核心執(zhí)行機(jī)構(gòu)是蠕動(dòng)泵——一根軟管被滾輪反復(fù)擠壓推動(dòng)液體往前流動(dòng)。蠕動(dòng)泵的流量和轉(zhuǎn)速近似線(xiàn)性所以用步進(jìn)電機(jī)驅(qū)動(dòng)比直流電機(jī)有天然優(yōu)勢(shì)精確控制步進(jìn)電機(jī)按固定角度走可以精確控制擠壓頻率從而實(shí)現(xiàn)精確的滴速控制保持力矩步進(jìn)電機(jī)在停止?fàn)顟B(tài)下也有保持力矩可以防止蠕動(dòng)泵在停止時(shí)由于液體壓力產(chǎn)生倒流無(wú)需編碼器開(kāi)環(huán)就能達(dá)到流量控制精度降低系統(tǒng)復(fù)雜度和成本。電機(jī)驅(qū)動(dòng)我選了ULN2003這是最經(jīng)典的達(dá)林頓管陣列芯片5線(xiàn)四相步進(jìn)電機(jī)28BYJ-48的標(biāo)準(zhǔn)搭配。原理圖里每一相都串了限流電阻并且在電機(jī)電源端加了100uF電解電容和104陶瓷電容做去耦。關(guān)于電機(jī)驅(qū)動(dòng)我的建議是如果你要做一個(gè)真正的產(chǎn)品級(jí)原型建議把ULN2003換成A4988或者DRV8825驅(qū)動(dòng)板。前者電流能力弱噪音大力矩也一般但用在Demo和畢設(shè)場(chǎng)景完全夠用且極便宜。后者支持細(xì)分驅(qū)動(dòng)噪音小很多但需要額外的邏輯電源和電機(jī)電源分離設(shè)計(jì)。這也是為什么我在原理圖里保留了電機(jī)供電接口的獨(dú)立性方便你后續(xù)替換驅(qū)動(dòng)方案。2.5 完整BOM和成本估算整套硬件做下來(lái)大約多少錢(qián)我把原理圖里所有器件整理一下給你做個(gè)成本參考按某寶零售價(jià)估算不含PCB打樣費(fèi)器件型號(hào)/規(guī)格數(shù)量參考單價(jià)小計(jì)主控STM32F103C8T616元6元紅外對(duì)管紅外發(fā)射/接收一體或分體2組1元2元比較器LM39310.5元0.5元穩(wěn)壓AMS1117-3.310.3元0.3元OLED屏SSD1306 0.96寸 I2C115元15元步進(jìn)電機(jī)28BYJ-48 ULN200318元8元蜂鳴器有源蜂鳴器11元1元按鍵輕觸開(kāi)關(guān)40.2元0.8元電阻電容各種規(guī)格若干-約3元PCB打樣嘉立創(chuàng)5片包郵1次約20元20元傳感器管子輸液管液位檢測(cè)附件1套約10元10元大約66.6元。這個(gè)成本做出來(lái)的東西功能上對(duì)標(biāo)幾千塊的輸液泵的監(jiān)測(cè)和基礎(chǔ)調(diào)控能力性?xún)r(jià)比是碾壓級(jí)的。當(dāng)然電機(jī)力矩、控制精度、安全認(rèn)證這些和醫(yī)療級(jí)設(shè)備肯定是沒(méi)法比的所以這個(gè)項(xiàng)目的定位很明確教學(xué)演示、原理驗(yàn)證、原型開(kāi)發(fā)、個(gè)人學(xué)習(xí)而不是臨床使用。3. 核心代碼與軟件邏輯從滴速計(jì)算到PID閉環(huán)控制3.1 工程代碼的整體架構(gòu)和文件劃分代碼我基于標(biāo)準(zhǔn)外設(shè)庫(kù)寫(xiě)的工程結(jié)構(gòu)嚴(yán)格按照模塊化思想劃分。你下載下來(lái)用Keil5打開(kāi)就能直接編譯不需要額外配置路徑。主目錄如下SmartInfusion/ ├── User/ │ ├── main.c // 主邏輯循環(huán) │ ├── stm32f10x_it.c // 中斷服務(wù)函數(shù) │ └── system_stm32f10x.c // 系統(tǒng)時(shí)鐘配置 ├── App/ │ ├── droplet_detect.c/h // 滴速檢測(cè)模塊 │ ├── liquid_level.c/h // 液位檢測(cè)模塊 │ ├── motor_control.c/h // 步進(jìn)電機(jī)控制模塊 │ ├── pid.c/h // PID算法模塊 │ ├── oled_display.c/h // OLED屏顯示模塊 │ ├── key_scan.c/h // 按鍵掃描模塊 │ └── alarm.c/h // 報(bào)警模塊 ├── BSP/ │ ├── usart.c/h // 串口初始化與收發(fā) │ ├── i2c.c/h // I2C軟件模擬 │ └── timer.c/h // 定時(shí)器初始化 └── Hardware/ ├── stm32f10x_conf.h └── stm32f10x.h這種分層的好處是App層的每個(gè)模塊只做自己的事通過(guò)接口函數(shù)互相調(diào)用不直接操作寄存器。比如滴速檢測(cè)模塊對(duì)外暴露一個(gè)DropletDect_GetSpeed()函數(shù)主循環(huán)只用調(diào)這個(gè)函數(shù)拿結(jié)果至于內(nèi)部是外部中斷計(jì)數(shù)還是定時(shí)器計(jì)算完全不用關(guān)心。你要改成HAL庫(kù)只需要把BSP層重寫(xiě)一遍App層代碼幾乎不用動(dòng)。3.2 滴速檢測(cè)的算法細(xì)節(jié)怎么把兩次滴落間隔換算成滴/分鐘滴速檢測(cè)的核心是外部中斷定時(shí)器窗口統(tǒng)計(jì)。我在EXTI0_IRQHandler中斷服務(wù)函數(shù)里做兩件事第一讀取當(dāng)前系統(tǒng)滴落計(jì)數(shù)器的值g_dropletCount加1 第二判斷如果當(dāng)前處于統(tǒng)計(jì)窗口內(nèi)定時(shí)器每5秒觸發(fā)一次窗口更新就記錄兩次滴落的時(shí)間戳計(jì)算出當(dāng)前滴速。// App/droplet_detect.c 核心片段 volatile uint32_t g_dropletCount 0; volatile uint32_t g_lastTick 0; volatile uint16_t g_speedDropletsPerMin 0; static uint32_t s_windowStartTick 0; static uint32_t s_windowDropletCount 0; void EXTI0_IRQHandler(void) { if (EXTI_GetITStatus(EXTI_Line0) ! RESET) { uint32_t now TIM2-CNT; // 如果兩次滴落間隔太短判定為抖動(dòng)忽略 if (now - g_lastTick 10) { g_dropletCount; g_lastTick now; } EXTI_ClearITPendingBit(EXTI_Line0); } } void DropletDect_UpdateSpeed(void) { uint32_t now TIM2-CNT; uint32_t elapsed now - s_windowStartTick; if (elapsed 5000) // 5秒統(tǒng)計(jì)窗口 { uint32_t dropletsInWindow g_dropletCount - s_windowDropletCount; // 換算為每分鐘滴速 g_speedDropletsPerMin (uint16_t)((float)dropletsInWindow * 12.0f); s_windowStartTick now; s_windowDropletCount g_dropletCount; } }這里有個(gè)容易被新手忽略的細(xì)節(jié)為什么統(tǒng)計(jì)窗口是5秒而不是1秒或者10秒如果窗口太短比如1秒那么滴速慢時(shí)比如每分鐘20滴一次滴落間隔是3秒一個(gè)1秒窗口內(nèi)可能一次滴落都沒(méi)有測(cè)出來(lái)的速度就是0滴/分鐘這顯然不對(duì)窗口太長(zhǎng)比如10秒系統(tǒng)對(duì)滴速變化的實(shí)時(shí)性就差。5秒是一個(gè)折中——對(duì)于每分鐘12滴以上的輸液速度臨床上常見(jiàn)范圍是20~60滴/分鐘5秒窗口至少能捕捉到1~5個(gè)脈沖換算成滴/分鐘誤差可控。實(shí)際測(cè)試中這個(gè)窗口下穩(wěn)態(tài)誤差在±2滴以?xún)?nèi)對(duì)PID控制來(lái)說(shuō)是夠用的。另外注意代碼里有個(gè)抖動(dòng)過(guò)濾兩次中斷間隔小于10ms就忽略。因?yàn)榧t外對(duì)管在液滴落下的瞬間可能出現(xiàn)回彈液滴表面張力導(dǎo)致光線(xiàn)多次遮擋不處理就會(huì)一次滴落記成多次。3.3 PID調(diào)參實(shí)戰(zhàn)記錄從發(fā)散到穩(wěn)定的完整過(guò)程PID是這套系統(tǒng)里最硬核的部分也是很多人在畢設(shè)或競(jìng)賽里最容易翻車(chē)的地方。我把實(shí)際調(diào)參過(guò)程記錄下來(lái)因?yàn)檫@比單純貼代碼有用得多。首先明確被控對(duì)象和控制量被控對(duì)象蠕動(dòng)泵的滴速單位滴/分鐘執(zhí)行器步進(jìn)電機(jī)的轉(zhuǎn)速單位拍/秒對(duì)應(yīng)相序脈沖頻率反饋量紅外對(duì)管測(cè)得的實(shí)際滴速我最初寫(xiě)的PID參數(shù)是理論值P1.0I0.1D0.0想著反正系統(tǒng)慣量不大先跑起來(lái)看看。結(jié)果一跑電機(jī)瘋狂振蕩滴速在目標(biāo)值上下大幅擺動(dòng)有時(shí)還沖出安全范圍觸發(fā)報(bào)警。用串口把數(shù)據(jù)導(dǎo)出來(lái)畫(huà)圖就是那種經(jīng)典的等幅振蕩曲線(xiàn)。后來(lái)我系統(tǒng)地做了調(diào)整第一步把I和D先設(shè)0只留P。從P0.1開(kāi)始往上漲每次跑30秒看響應(yīng)曲線(xiàn)。發(fā)現(xiàn)P0.3時(shí)系統(tǒng)已經(jīng)能接近目標(biāo)值但有穩(wěn)態(tài)誤差P0.5時(shí)就開(kāi)始出現(xiàn)輕微過(guò)沖P0.8時(shí)明顯振蕩。于是把P定在0.35。第二步加I消除穩(wěn)態(tài)誤差。I0.05觀(guān)察系統(tǒng)能不能緩慢逼近目標(biāo)值。發(fā)現(xiàn)響應(yīng)偏慢調(diào)到0.08后穩(wěn)態(tài)誤差基本消除但出現(xiàn)了一點(diǎn)低頻波動(dòng)。又調(diào)回0.06波動(dòng)消失。第三步加D抑制過(guò)沖。目標(biāo)值從30滴突變?yōu)?0滴時(shí)純PI會(huì)產(chǎn)生約15%的過(guò)沖。D0.2時(shí)過(guò)沖減小到5%以?xún)?nèi)但響應(yīng)速度略有下降。最后D取0.15過(guò)沖約3%調(diào)節(jié)時(shí)間約10秒各項(xiàng)指標(biāo)都滿(mǎn)足需求。最終參數(shù)// App/pid.c 最終調(diào)參結(jié)果 PID_TypeDef g_pid { .targetValue 40.0f, // 目標(biāo)滴速 .kp 0.35f, // 比例系數(shù) .ki 0.06f, // 積分系數(shù) .kd 0.15f, // 微分系數(shù) .outputLimit 1000.0f, // 輸出限幅步進(jìn)電機(jī)最高脈沖頻率 };關(guān)于PID有個(gè)非常重要但經(jīng)常被忽略的點(diǎn)輸出限幅。步進(jìn)電機(jī)的脈沖頻率不是可以無(wú)限大的超出電機(jī)響應(yīng)能力后脈沖再多也是白搭反而會(huì)讓電機(jī)丟步。我把輸出限幅設(shè)為1000PPS對(duì)應(yīng)蠕動(dòng)泵最高流速約每分鐘120滴這個(gè)值在醫(yī)療輸液場(chǎng)景下已經(jīng)非常高了。還有一個(gè)工程技巧積分分離。當(dāng)實(shí)際滴速和目標(biāo)值偏差超過(guò)設(shè)定范圍時(shí)我設(shè)為20滴把積分項(xiàng)清零防止積分飽和導(dǎo)致系統(tǒng)過(guò)沖。這個(gè)邏輯用代碼寫(xiě)很簡(jiǎn)單但對(duì)控制效果的提升非常明顯。float PID_Calculate(PID_TypeDef *pid, float currentValue) { float error pid-targetValue - currentValue; float proportional pid-kp * error; float integral pid-integral; if (error 20.0f) // 積分分離偏差過(guò)大時(shí)關(guān)閉積分 { integral pid-ki * error; pid-integral integral; } else { pid-integral 0.0f; } float derivative pid-kd * (error - pid-lastError); pid-lastError error; float output proportional integral derivative; // 輸出限幅 if (output pid-outputLimit) output pid-outputLimit; if (output -pid-outputLimit) output -pid-outputLimit; return output; }3.4 串口協(xié)議設(shè)計(jì)自定義幀格式 握手應(yīng)答機(jī)制上位機(jī)通信的串口協(xié)議我設(shè)計(jì)成一個(gè)簡(jiǎn)單的自定義幀幀頭 設(shè)備地址 命令字 數(shù)據(jù)長(zhǎng)度 數(shù)據(jù)域 校驗(yàn)字節(jié)。校驗(yàn)采用異或和夠簡(jiǎn)單也夠用。// 協(xié)議幀格式 // | 0xAA | 0x5A | ADDR | CMD | LEN | DATA... | XOR_CHECK |命令分為三類(lèi)0x01 查詢(xún)命令上位機(jī)請(qǐng)求設(shè)備狀態(tài)設(shè)備回復(fù)當(dāng)前滴速、液位狀態(tài)、報(bào)警狀態(tài)0x02 控制命令上位機(jī)設(shè)置目標(biāo)滴速、啟動(dòng)/暫停電機(jī)0x03 主動(dòng)上報(bào)設(shè)備在滴速異常、液位過(guò)低時(shí)主動(dòng)上報(bào)報(bào)警事件。握手流程是設(shè)備上電后每2秒發(fā)送一次心跳幀上位機(jī)收到后如果設(shè)備地址匹配就回復(fù)ACK之后進(jìn)入正常工作模式。這個(gè)握手機(jī)制解決了一個(gè)很實(shí)際的痛點(diǎn)如果上位機(jī)軟件沒(méi)打開(kāi)或者串口被占用設(shè)備會(huì)一直嘗試連接但不會(huì)誤動(dòng)作。有人可能會(huì)問(wèn)為什么不用Modbus這樣現(xiàn)成的協(xié)議因?yàn)轫?xiàng)目定位是輕量級(jí)教學(xué)/原型Modbus雖然規(guī)范但幀結(jié)構(gòu)較復(fù)雜在小資源MCU上跑起來(lái)有點(diǎn)大材小用。自己定義協(xié)議幀的好處是代碼量小、邏輯直觀(guān)而且上位機(jī)這邊我用Python的pyserial寫(xiě)了個(gè)簡(jiǎn)單的調(diào)試工具幾行代碼就能解析幀并實(shí)時(shí)顯示數(shù)據(jù)。4. 仿真工程與實(shí)物聯(lián)調(diào)Proteus仿真能驗(yàn)證什么不能驗(yàn)證什么4.1 仿真工程的搭建細(xì)節(jié)Proteus仿真工程里我把硬件設(shè)計(jì)等比例映射進(jìn)去STM32F103C8T6模型、LM393比較器模型、紅外對(duì)管可以用開(kāi)關(guān)信號(hào)發(fā)生器模擬、步進(jìn)電機(jī)用仿真模型、OLED用I2C顯示模型。你在Proteus里打開(kāi)工程就能直接跑程序燒到虛擬MCU里OLED會(huì)顯示仿真滴速和狀態(tài)。仿真工程的價(jià)值主要在邏輯驗(yàn)證階段。比如我想測(cè)試目標(biāo)滴速?gòu)?0變成80時(shí)PID如何響應(yīng)在實(shí)物上需要手動(dòng)調(diào)整吊瓶高度或者更換泵管在仿真里只需要改一個(gè)參數(shù)就行。這種改參秒級(jí)驗(yàn)證的效率優(yōu)勢(shì)在開(kāi)發(fā)初期非常明顯。4.2 仿真和實(shí)物最大的差異信號(hào)完整性但必須坦白講仿真不能替代實(shí)物驗(yàn)證最大的原因在于信號(hào)完整性。Proteus里的紅外對(duì)管不會(huì)受到電機(jī)電源波動(dòng)的影響LM393的輸出也是理想的數(shù)字電平但在實(shí)物上電機(jī)的EMI干擾、電源紋波、導(dǎo)線(xiàn)電感這些東西全都存在。我在實(shí)物調(diào)試時(shí)就遇到過(guò)一個(gè)非常詭異的現(xiàn)象電機(jī)轉(zhuǎn)動(dòng)后滴速檢測(cè)值從每分鐘60掉到了每分鐘8一開(kāi)始還以為是傳感器壞了后來(lái)用示波器一看原來(lái)是電機(jī)在地線(xiàn)上產(chǎn)生的紋波干擾了紅外接收管的參考電壓導(dǎo)致比較器誤觸發(fā)。這類(lèi)問(wèn)題在仿真里根本復(fù)現(xiàn)不出來(lái)所以我的建議是用仿真驗(yàn)證算法邏輯用實(shí)物驗(yàn)證信號(hào)鏈路。兩者配合才能保證系統(tǒng)的可靠性。4.3 上位機(jī)聯(lián)調(diào)Python開(kāi)個(gè)可視化的數(shù)據(jù)監(jiān)控小工具串口協(xié)議既然定好了上位機(jī)端我也順手寫(xiě)了個(gè)Python小工具用來(lái)實(shí)時(shí)顯示滴速曲線(xiàn)和系統(tǒng)狀態(tài)。代碼很簡(jiǎn)單核心邏輯就是串口接收和解析——讀取到幀頭0xAA 0x5A后按幀格式解析命令把滴速數(shù)據(jù)畫(huà)成折線(xiàn)圖。import serial import matplotlib.pyplot as plt import matplotlib.animation as animation ser serial.Serial(COM3, 115200, timeout1) speed_history [] def parse_frame(data): # 完整幀解析邏輯 # 如果數(shù)據(jù)幀的校驗(yàn)通過(guò)返回滴速值 return speed def update_plot(frame): raw_data ser.read(64) if raw_data: speed parse_frame(raw_data) if speed is not None: speed_history.append(speed) if len(speed_history) 100: speed_history.pop(0) plt.cla() plt.plot(speed_history) plt.xlabel(Time) plt.ylabel(Droplets/min) plt.title(Infusion Speed Monitor) ani animation.FuncAnimation(plt.gcf(), update_plot, interval500) plt.show()這個(gè)工具在調(diào)PID時(shí)作用巨大。你能直觀(guān)看到系統(tǒng)的響應(yīng)曲線(xiàn)比如是否存在過(guò)沖、穩(wěn)態(tài)誤差有多大、調(diào)節(jié)時(shí)間有多長(zhǎng)。如果沒(méi)有可視化工具只靠OLED屏上的數(shù)字這類(lèi)調(diào)試基本沒(méi)法做。4.4 三套使用路徑的配合關(guān)系至此你應(yīng)該能看出整個(gè)項(xiàng)目代碼、原理圖、仿真三者之間的關(guān)系了路徑需要的資源適合場(chǎng)景能驗(yàn)證什么純仿真仿真工程 代碼邏輯入門(mén)、PID調(diào)參、演示講解算法正確性、邏輯分支、控制效果實(shí)物原型原理圖 代碼畢設(shè)實(shí)物、競(jìng)賽作品、產(chǎn)品驗(yàn)證電路設(shè)計(jì)、信號(hào)質(zhì)量、實(shí)際控制精度二次開(kāi)發(fā)全部代碼 原理圖擴(kuò)展功能、改成無(wú)線(xiàn)方案、升級(jí)屏幕等架構(gòu)擴(kuò)展性、代碼可維護(hù)性我之前遇到過(guò)不少問(wèn)能不能只做仿真不做實(shí)物的同學(xué)——能但你要清楚仿真做出來(lái)的東西只能證明邏輯對(duì)了不能證明電路對(duì)了。反過(guò)來(lái)如果你直接開(kāi)打PCB卻不先跑仿真一旦PID邏輯有bug改板子的成本比改代碼高得多。所以最穩(wěn)的路徑永遠(yuǎn)是仿真先行實(shí)物跟上兩者互相印證。5. 從初版到升級(jí)版的演進(jìn)換代過(guò)程中踩過(guò)的最記憶深刻的幾個(gè)坑5.1 初版報(bào)警誤報(bào)率為什么居高不下來(lái)自滴壺掛壁水珠的干擾上一版的系統(tǒng)主要做監(jiān)測(cè)報(bào)警但初版做完后我拿到真實(shí)輸液場(chǎng)景測(cè)試發(fā)現(xiàn)誤報(bào)率高到?jīng)]法用。最典型的一個(gè)場(chǎng)景輸液滴壺上方的管壁掛了一顆水珠它不落下只是掛在管壁上紅外對(duì)管長(zhǎng)時(shí)間處于遮擋狀態(tài)系統(tǒng)就判定為滴速為0并報(bào)警。但實(shí)際上輸液是正常的只是那滴水珠剛好擋住了紅外線(xiàn)。解決思路是區(qū)分長(zhǎng)時(shí)間遮擋和持續(xù)滴落的波形特征。真正的滴落是一個(gè)短暫的脈沖——遮擋時(shí)間通常在50~200ms左右然后迅速恢復(fù)掛壁水珠則是持續(xù)的遮擋。于是代碼里加了一個(gè)邏輯如果遮光持續(xù)時(shí)間超過(guò)500ms就不算一次滴落而是標(biāo)記為疑似掛壁進(jìn)入異常檢測(cè)分支。這個(gè)改進(jìn)沒(méi)有增加任何硬件成本純靠軟件算法就解決了。機(jī)電系統(tǒng)里的很多問(wèn)題都是這樣先別急著換硬件想想能不能通過(guò)軟件邏輯來(lái)看穿物理世界的噪聲。5.2 升級(jí)版新加入的電機(jī)控制給電源帶來(lái)的連鎖反應(yīng)升級(jí)版加了電機(jī)之后新的問(wèn)題又來(lái)了電機(jī)一啟動(dòng)OLED屏幕亮度就閃爍串口偶爾還會(huì)出現(xiàn)亂碼。排查之后發(fā)現(xiàn)是電源的問(wèn)題——電機(jī)啟動(dòng)瞬間電流尖峰導(dǎo)致3.3V電壓跌落MCU和OLED雖然不是同一個(gè)電源網(wǎng)絡(luò)但地線(xiàn)是共用的地線(xiàn)上的壓差直接影響了信號(hào)質(zhì)量。這個(gè)問(wèn)題的處理我在前面原理圖部分已經(jīng)提到模擬/數(shù)字分離、電機(jī)電源獨(dú)立、加去耦電容。但更重要的是要有排查思路先用示波器看電源紋波再用邏輯分析儀看串口信號(hào)逐步縮小范圍最后鎖定到地線(xiàn)公共阻抗噪聲。分享這個(gè)例子的目的是想說(shuō)設(shè)計(jì)時(shí)預(yù)留好測(cè)試點(diǎn)非常重要。我在原理圖的電源、地、關(guān)鍵信號(hào)上都加了測(cè)試焊盤(pán)調(diào)試時(shí)直接夾示波器探頭就行不用拆線(xiàn)省了很多時(shí)間。5.3 兩個(gè)防呆設(shè)計(jì)堵轉(zhuǎn)保護(hù)與報(bào)警延遲消抖升級(jí)版另外加了兩個(gè)防呆設(shè)計(jì)我覺(jué)得對(duì)做同類(lèi)項(xiàng)目的你有參考價(jià)值第一個(gè)是堵轉(zhuǎn)保護(hù)。蠕動(dòng)泵在輸液過(guò)程中如果輸液管被折疊或者患者移動(dòng)扯到了管路泵的負(fù)載會(huì)突然增大步進(jìn)電機(jī)可能丟步堵轉(zhuǎn)。如果不處理電機(jī)會(huì)持續(xù)發(fā)熱嚴(yán)重時(shí)可能損壞電機(jī)或管路。我在電機(jī)控制模塊里加了一個(gè)邏輯如果連續(xù)10次PID運(yùn)算中輸出值都超過(guò)上限的90%但實(shí)際滴速幾乎為0就判定為堵轉(zhuǎn)立即停止電機(jī)并報(bào)警。// motor_control.c void Motor_CheckStall(void) { static uint8_t highOutputCount 0; if (g_pid.output g_pid.outputLimit * 0.9f g_speedDropletsPerMin 5) { highOutputCount; if (highOutputCount 10) { Motor_StopEmergency(); Alarm_Raise(ALARM_STALL); highOutputCount 0; } } else { highOutputCount 0; } }第二個(gè)是報(bào)警延遲消抖。液位傳感器在輸液過(guò)程中可能因?yàn)闅馀萁?jīng)過(guò)產(chǎn)生短暫的誤觸發(fā)信號(hào)如果一觸發(fā)就報(bào)警會(huì)很煩人。我加了一個(gè)軟件消抖邏輯液位低信號(hào)必須持續(xù)超過(guò)3秒才觸發(fā)報(bào)警。這個(gè)延遲時(shí)間既不影響安全性輸液管末段的液位低到報(bào)警點(diǎn)后到完全滴空還有至少幾十秒的緩沖又有效避免了誤報(bào)。5.4 從這一版還能往哪些方向繼續(xù)升級(jí)這套系統(tǒng)現(xiàn)在的開(kāi)源版本其實(shí)還有很大的擴(kuò)展空間。如果你想在這個(gè)基礎(chǔ)上繼續(xù)做我建議按下面的優(yōu)先級(jí)考慮第一加無(wú)線(xiàn)通信模塊。把串口協(xié)議改成通過(guò)ESP8266/ESP32的WiFi模塊或者HC-05藍(lán)牙模塊傳輸就能實(shí)現(xiàn)護(hù)士站大屏監(jiān)控。硬件只需要在USART1上掛一個(gè)透?jìng)髂K協(xié)議幾乎不用改。第二加多通道支持。當(dāng)前版本是單通道輸液監(jiān)護(hù)如果要做多通道主控建議換成STM32F103ZET6144pin的型號(hào)它有更多的外部中斷引腳和定時(shí)器通道靠軟件框架的模塊化復(fù)制一份App層的邏輯就能擴(kuò)展一路。第三加斷電續(xù)調(diào)。用EEPROMI2C接口的AT24C02保存當(dāng)前的PID參數(shù)和運(yùn)行狀態(tài)掉電后重新上電可以自動(dòng)恢復(fù)中斷前的輸液任務(wù)不用護(hù)士重新設(shè)置。第四加GSM/4G遠(yuǎn)程報(bào)警。對(duì)于家庭場(chǎng)景用SIM800L模塊發(fā)送短信報(bào)警這是目前很多商用產(chǎn)品不具備但實(shí)際需求很強(qiáng)的功能。這套項(xiàng)目做到這版已經(jīng)是從傳感器采集到閉環(huán)控制從本地顯示到上位機(jī)聯(lián)動(dòng)的全鏈路閉環(huán)了。結(jié)構(gòu)上足夠覆蓋一個(gè)典型的嵌入式系統(tǒng)包含的幾乎所有技術(shù)要素中斷、定時(shí)器、PWM、PID、串口協(xié)議、模塊化編程。如果你正在做類(lèi)似的項(xiàng)目可以直接拿這套代碼和原理圖當(dāng)基線(xiàn)把精力花在你特有的創(chuàng)新點(diǎn)上比從零開(kāi)始要高效得多。最后分享一個(gè)我做這類(lèi)項(xiàng)目多年下來(lái)的體會(huì)做嵌入式系統(tǒng)功能實(shí)現(xiàn)只是第一步把穩(wěn)定可靠四個(gè)字刻進(jìn)代碼里才是真正拉開(kāi)差距的地方。比如滴速檢測(cè)的抖動(dòng)過(guò)濾、報(bào)警的延時(shí)消抖、電機(jī)的堵轉(zhuǎn)保護(hù)這些初看都是小事但正是這些細(xì)節(jié)決定了別人愿意不愿意把你的作品當(dāng)成產(chǎn)品來(lái)用。希望這套開(kāi)源項(xiàng)目能幫你少走一些我走過(guò)的彎路。