一種智能行間中耕施肥施藥機(jī)的控制電路及算法制造技術(shù)

本發(fā)明專(zhuān)利技術(shù)提供一種智能行間中耕施肥施藥機(jī)的控制電路，包括MCU主控制器，其特征是：所述MCU主控制器分別連接電源隔離模塊、穩(wěn)壓模塊、電池檢測(cè)模塊、霍爾輸入模塊、發(fā)動(dòng)機(jī)調(diào)速模塊、檔位選擇模塊、繼電器控制模塊、串口通信模塊、紅外傳感器采集模塊、網(wǎng)絡(luò)通信模塊，所述MCU主控制器以STM32F103ZET6為控制核心。同時(shí)也提出一種智能行間中耕施肥施藥機(jī)的控制算法，可以有效解決裝置運(yùn)行不穩(wěn)定、工作效率低的問(wèn)題，從軟件和控制原理方面將工作誤差、通信不暢等問(wèn)題的影響做到最小化處理。

【技術(shù)實(shí)現(xiàn)步驟摘要】

本專(zhuān)利技術(shù)涉及機(jī)電控制
，具體地講，涉及一種智能行間中耕施肥施藥機(jī)的控制電路及算法。
技術(shù)介紹
現(xiàn)存的農(nóng)業(yè)機(jī)械主要應(yīng)用于單體種植面積大的區(qū)域，價(jià)格高昂，而且均需要人工駕駛，缺乏適用于小田塊的自動(dòng)化操作機(jī)械，針對(duì)其自身的設(shè)計(jì)缺陷，以及耕地表面的復(fù)雜情況，使這種小型的機(jī)械設(shè)備在耕種過(guò)程中使用效果并不好，究其原因，無(wú)外乎軟硬件方面都存在問(wèn)題，針對(duì)這些問(wèn)題本專(zhuān)利技術(shù)立足根本，從軟件和控制原理出發(fā)，設(shè)計(jì)了一種智能行間中耕施肥施藥機(jī)的控制電路及算法。
技術(shù)實(shí)現(xiàn)思路
本專(zhuān)利技術(shù)要解決的技術(shù)問(wèn)題是提供一種智能行間中耕施肥施藥機(jī)的控制電路及算法，設(shè)計(jì)合理，功能全面，可以滿(mǎn)足市場(chǎng)需要。本專(zhuān)利技術(shù)采用如下技術(shù)手段實(shí)現(xiàn)專(zhuān)利技術(shù)目的：一種智能行間中耕施肥施藥機(jī)的控制電路，包括MCU主控制器，其特征是：所述MCU主控制器分別連接電源隔離模塊、穩(wěn)壓模塊、電池檢測(cè)模塊、霍爾輸入模塊、發(fā)動(dòng)機(jī)調(diào)速模塊、檔位選擇模塊、繼電器控制模塊、串口通信模塊、紅外傳感器采集模塊、網(wǎng)絡(luò)通信模塊，所述MCU主控制器以STM32F103ZET6為控制核心。作為對(duì)本技術(shù)方案的進(jìn)一步限定，所述電源隔離模塊采用DC-DC的隔離電源來(lái)保護(hù)控制板內(nèi)部，所述器件U1通過(guò)48-5V的DC-DC轉(zhuǎn)換模塊，輸出一個(gè)5V的電源作為控制板內(nèi)的信號(hào)電源，所述器件U5通過(guò)48-12V的DC-DC轉(zhuǎn)換模塊，輸出一個(gè)12V的電源作為控制內(nèi)的驅(qū)動(dòng)電源，可以有效消除本裝置電機(jī)產(chǎn)生的電磁干擾，適應(yīng)比較惡劣的環(huán)境。作為對(duì)本技術(shù)方案的進(jìn)一步限定，所述穩(wěn)壓模塊采用現(xiàn)有的電路，使用AMS1086將信號(hào)電源5V轉(zhuǎn)換出一路3.3V電源給單片機(jī)以及一些傳感器供電，使用LM7809將驅(qū)動(dòng)電源轉(zhuǎn)換出一路9V電源給路由器供電，信號(hào)電源使用自恢復(fù)保險(xiǎn)絲，當(dāng)短路過(guò)載時(shí)保護(hù)，使用TVS瞬態(tài)抑制器來(lái)抑制浪涌電壓，通過(guò)電容網(wǎng)絡(luò)進(jìn)行濾波。作為對(duì)本技術(shù)方案的進(jìn)一步限定，所述電池檢測(cè)模塊采用CN1185芯片、74HC04芯片和光電耦合器，所述電池檢測(cè)模塊有4條檢測(cè)類(lèi)似回路，這里就介紹其中一條：所述CN1185芯片U2的引腳1串聯(lián)電阻R58接于地，其并聯(lián)支路串接電阻R57接于電壓直流48V，同理，所述CN1185芯片U2的引腳3、引腳5、引腳7的并聯(lián)支路接的電壓值分別為直流36V、直流24V和直流12V，所述CN1185芯片的輸出引腳CN1185_OUT1連接所述74HC04芯片的引腳1，所述74HC04芯片的引腳2連接所述光電耦合器的引腳2，所述光電耦合器的引腳1串接電阻R62接于+5V電源，所述光電耦合器的引腳4串接電阻R63接于+3.3V電源，所述光電耦合器的引腳3串接電阻R56接于地，其并聯(lián)支路串接電容C59接于地，另外，所述光電耦合器的引腳3連接MCU主控制器的引腳26，同理，可得出其它幾條電池檢測(cè)支路。作為對(duì)本技術(shù)方案的進(jìn)一步限定，所述霍爾輸入模塊包括兩個(gè)類(lèi)似采集電路，這里只解釋一條：所述霍爾元件的引腳1接于+5V電源，其并聯(lián)支路串接發(fā)光二極管D13和電阻R136接于所述霍爾元件的引腳2，所述霍爾元件的引腳2串接電阻R130和電容C56接于地，所述霍爾元件的引腳3接于地，所述霍爾元件的輸出信號(hào)線TIM_CH4接于所述MCU主控制器的引腳140。作為對(duì)本技術(shù)方案的進(jìn)一步限定，所述發(fā)動(dòng)機(jī)調(diào)速模塊采用光電耦合器和三極管，所述光電耦合器的引腳1串接電阻R94接于插座P31的插孔1，所述光電耦合器的引腳2接于插座P31的插孔2，所述光電耦合器的引腳3串接電阻R95和電阻R102接于地，其并聯(lián)支路接于三極管Q1的基極，所述光電耦合器的引腳4接于+3.3V電源，其并聯(lián)支路串接電阻R85和電阻R91接于所述MCU主控制器的引腳141，所述三極管Q1的集電極接于電阻R85與電阻R91之間，所述三極管Q1的發(fā)射極接于地，所述三極管Q1的集電極與輸出信號(hào)線PE0_TIM4_ETR之間串聯(lián)電容C53。作為對(duì)本技術(shù)方案的進(jìn)一步限定，所述檔位選擇模塊采用AQW212芯片，檔位選擇電路上下兩個(gè)AQW212芯片連接方式相同，所述AQW212芯片U8的引腳1和引腳3分別串接電阻R165和電阻R166接于+3.3V，所述AQW212芯片U8的引腳2和引腳4分別連接所述MCU主控制器的引腳75和引腳76，所述AQW212芯片U8的引腳5和引腳7接于+5V電源，所述AQW212芯片U8的引腳5和引腳7分別串接電阻R162和電阻R161接于插座P32的插孔2，所述插座P32的插孔1和插孔3分別連接地和+5V電源，所述AQW212芯片U10的引腳2和引腳4分別連接所述MCU主控制器的引腳73和引腳74。作為對(duì)本技術(shù)方案的進(jìn)一步限定，所述繼電器控制模塊采用PC817光電耦合器、ULN2803芯片和1n4148，本繼電器控制模塊共有16路連接方式相同的控制支路，其中一路為：所述PC817光電耦合器GG6的引腳1接于+3.3V電源，所述PC817光電耦合器GG6的引腳2串接電阻R88接于所述MCU主控制器的引腳44，所述PC817光電耦合器GG6的引腳4串接電阻R84接于+12V電源，所述PC817光電耦合器GG6的引腳3串接電阻R92接地，其并聯(lián)支路接于所述ULN2803芯片的引腳8，所述ULN2803芯片的引腳8連接所述繼電器控制引腳ULN_K8,所述繼電器控制引腳ULN_K8串接發(fā)光二極管D4和電阻R78接于繼電器線圈，其并聯(lián)支路串接二極管D25接于繼電器線圈。作為對(duì)本技術(shù)方案的進(jìn)一步限定，所述串口通信模塊采用現(xiàn)有的電路，擁有兩路串口通信接口，一路接433MHz無(wú)線模塊，一路接超聲波測(cè)距模塊，采用MAX232通信接口，可以連接電腦，通過(guò)電腦進(jìn)行調(diào)試、校準(zhǔn)、設(shè)定參數(shù)等。作為對(duì)本技術(shù)方案的進(jìn)一步限定，所述紅外傳感器采集模塊采用現(xiàn)有的電路，擁有四路紅外傳感器接口，使用PC817作為信號(hào)隔離的主芯片，使用一個(gè)0.1uf電容作為一個(gè)基本的濾波電路，然后將隔離后的信號(hào)輸出給單片機(jī)。作為對(duì)本技術(shù)方案的進(jìn)一步限定，所述網(wǎng)絡(luò)通信模塊采用W5500作為網(wǎng)絡(luò)通信的主控制芯片，改芯片內(nèi)部集成TCP/IP協(xié)議，大大降低軟件開(kāi)發(fā)的難度，另外通信速度以及穩(wěn)定性要遠(yuǎn)好于軟件模擬的TCP/IP協(xié)議，使用內(nèi)部集成隔離電感的網(wǎng)口，大大簡(jiǎn)化電路設(shè)計(jì)，以及減小PCB的尺寸。本專(zhuān)利技術(shù)提出一種智能行間中耕施肥施藥機(jī)的控制算法，所述算法的流程具體為：初始化單片機(jī)資源配置、傳感器信號(hào)和內(nèi)部數(shù)據(jù)默認(rèn)值，讀取默認(rèn)的設(shè)置信息以及參數(shù)控制相關(guān)執(zhí)行器到預(yù)設(shè)位置，實(shí)時(shí)監(jiān)測(cè)控制箱傳回的數(shù)據(jù)以及傳感器信號(hào)，判斷是否有傳感器的信號(hào)，判斷時(shí)候有控制箱傳回的數(shù)據(jù)，若有信號(hào)也有數(shù)據(jù)，則解析來(lái)自控制箱的命令并控制相應(yīng)的執(zhí)行機(jī)構(gòu)；若有信號(hào)無(wú)數(shù)據(jù)，則判斷信號(hào)是否在正常的范圍內(nèi)，若在正常范圍內(nèi)，判斷是否是電子羅盤(pán)的信號(hào)，若滿(mǎn)足，則控制無(wú)線轉(zhuǎn)臺(tái)，保持無(wú)線CPE方向與預(yù)設(shè)的方向一致，以保證接收信號(hào)最強(qiáng)，若不滿(mǎn)足，則判斷是否有危險(xiǎn)狀態(tài)，若無(wú)危險(xiǎn)狀態(tài)，則對(duì)數(shù)據(jù)進(jìn)行處理打包，若有危險(xiǎn)狀態(tài)，則停止機(jī)車(chē)，停止一切操作進(jìn)入保護(hù)狀態(tài)；若無(wú)信號(hào)無(wú)數(shù)據(jù)，則返回，實(shí)時(shí)監(jiān)測(cè)控制箱傳回的數(shù)據(jù)以及傳感器信號(hào)，最后，將執(zhí)行結(jié)果或者是通信數(shù)據(jù)發(fā)送給監(jiān)控箱，繼續(xù)檢測(cè)，控制算法結(jié)束。與現(xiàn)有技術(shù)相比，本專(zhuān)利技術(shù)的優(yōu)點(diǎn)和積極效果是：本專(zhuān)利技術(shù)電源隔離模塊可以有效消除本裝置電機(jī)產(chǎn)生的電磁干擾本文檔來(lái)自技高網(wǎng)...

【技術(shù)保護(hù)點(diǎn)】
一種智能行間中耕施肥施藥機(jī)的控制電路，包括MCU主控制器，其特征是：所述MCU主控制器分別連接電源隔離模塊、穩(wěn)壓模塊、電池檢測(cè)模塊、霍爾輸入模塊、發(fā)動(dòng)機(jī)調(diào)速模塊、檔位選擇模塊、繼電器控制模塊、串口通信模塊、紅外傳感器采集模塊、網(wǎng)絡(luò)通信模塊，所述MCU主控制器以STM32F103ZET6為控制核心。

【技術(shù)特征摘要】
1.一種智能行間中耕施肥施藥機(jī)的控制電路，包括MCU主控制器，其特征是：所述MCU主控制器分別連接電源隔離模塊、穩(wěn)壓模塊、電池檢測(cè)模塊、霍爾輸入模塊、發(fā)動(dòng)機(jī)調(diào)速模塊、檔位選擇模塊、繼電器控制模塊、串口通信模塊、紅外傳感器采集模塊、網(wǎng)絡(luò)通信模塊，所述MCU主控制器以STM32F103ZET6為控制核心。2.根據(jù)權(quán)利要求1提出一種智能行間中耕施肥施藥機(jī)的控制電路，其特征是：所述電池檢測(cè)模塊采用CN1185芯片、74HC04芯片和光電耦合器，所述電池檢測(cè)模塊有4條檢測(cè)類(lèi)似回路，這里就介紹其中一條：所述CN1185芯片U2的引腳1串聯(lián)電阻R58接于地，其并聯(lián)支路串接電阻R57接于電壓直流48V，同理，所述CN1185芯片U2的引腳3、引腳5、引腳7的并聯(lián)支路接的電壓值分別為直流36V、直流24V和直流12V，所述CN1185芯片的輸出引腳CN1185_OUT1連接所述74HC04芯片的引腳1，所述74HC04芯片的引腳2連接所述光電耦合器的引腳2，所述光電耦合器的引腳1串接電阻R62接于+5V電源，所述光電耦合器的引腳4串接電阻R63接于+3.3V電源，所述光電耦合器的引腳3串接電阻R56接于地，其并聯(lián)支路串接電容C59接于地，另外，所述光電耦合器的引腳3連接MCU主控制器的引腳26，同理，可得出其它幾條電池檢測(cè)支路。3.根據(jù)權(quán)利要求1提出一種智能行間中耕施肥施藥機(jī)的控制電路，其特征是：所述霍爾輸入模塊包括兩個(gè)類(lèi)似采集電路，這里只解釋一條：所述霍爾元件的引腳1接于+5V電源，其并聯(lián)支路串接發(fā)光二極管D13和電阻R136接于所述霍爾元件的引腳2，所述霍爾元件的引腳2串接電阻R130和電容C56接于地，所述霍爾元件的引腳3接于地，所述霍爾元件的輸出信號(hào)線TIM_CH4接于所述MCU主控制器的引腳140。4.根據(jù)權(quán)利要求1提出一種智能行間中耕施肥施藥機(jī)的控制電路，其特征是：所述發(fā)動(dòng)機(jī)調(diào)速模塊采用光電耦合器和三極管，所述光電耦合器的引腳1串接電阻R94接于插座P31的插孔1，所述光電耦合器的引腳2接于插座P31的插孔2，所述光電耦合器的引腳3串接電阻R95和電阻R102接于地，其并聯(lián)支路接于三極管Q1的基極，所述光電耦合器的引腳4接于+3.3V電源，其并聯(lián)支路串接電阻R85和電阻R91接于所述MCU主控制器的引腳141，所述三極管Q1的集電極接于電阻R85與電阻R91之間，所述三極管Q1的發(fā)射極接于地，所述三極管Q1的集電極與輸出信號(hào)線PE0_TIM4_ETR之間串聯(lián)電容C53。5.根據(jù)權(quán)利要求1提出一種智能行間中耕施肥施藥機(jī)的控制電路，其特征是：所述檔位選擇模塊采用AQW212芯片，檔位選擇電路上下兩個(gè)AQW212芯片連接方式相...

【專(zhuān)利技術(shù)屬性】
技術(shù)研發(fā)人員：羅映，
申請(qǐng)(專(zhuān)利權(quán))人：山東建筑大學(xué)，
類(lèi)型：發(fā)明
國(guó)別省市：山東;37