專利名稱：基于地面仿形機械行走控制系統(tǒng)及方法
技術(shù)領域：
本發(fā)明涉及一種機械控制系統(tǒng)和方法，尤其涉及一種基于地面仿形機械行走控制系統(tǒng)及方法。
背景技術(shù)：
目前國內(nèi)甘蔗收割機收割底盤的仿形主要是機械仿形，而機械傳動割臺的突出代表是撓性割臺，它的特點就是割臺底部是由柔性鋼板制成，可以小范圍內(nèi)變形，依靠壓力(或拉力)及自身重力自動校正仿形機構(gòu)，以此達到對地面進行仿形的目的。電液仿形技術(shù)應用在機械加工領域比較成熟，一般系統(tǒng)采用電傳感器將模板的形狀轉(zhuǎn)換成電信號，經(jīng)過放大電路放大推動電液伺服閥(電一液轉(zhuǎn)化機構(gòu))，由液壓缸或液壓電動機(液壓馬達)等液壓執(zhí)行機構(gòu)驅(qū)動工作臺，帶動刀架作伺服運動，這就實現(xiàn)了刀具與模板形狀的隨動，實現(xiàn)仿形加工。電液仿形系統(tǒng)穩(wěn)定性好，靈敏度高，加工精度能夠可靠地保證使用要求。然而以上這兩種控制模式共同的問題是控制精度和實時性差，且不能進行割臺高度數(shù)據(jù)的獲取和分析。

發(fā)明內(nèi)容
(一)技術(shù)問題本發(fā)明解決了現(xiàn)有技術(shù)中控制精度和實時性差、不能進行割臺高度數(shù)據(jù)的獲取和分析的技術(shù)問題。(二)技術(shù)方案本發(fā)明提供一種收割機行走控制系統(tǒng)，該系統(tǒng)包括超聲波傳感器、單片機、顯示器、三位四通電磁閥，其中，所述超聲波傳感器用于監(jiān)測甘蔗收割機機械底盤的高度，并將所述信號傳送給單片機和顯示器，所述單片機對該信號進行分析處理，然后將處理后的信號傳送給三位四通電磁閥，通過控制該電磁閥的電流實現(xiàn)對其不同方向上對負載流量。進一步地，所述系統(tǒng)還包括D/A轉(zhuǎn)換器，連接在所述單片機和三位四通電磁閥之間。進一步地，所述系統(tǒng)還包括比例放大器，連接在所述D/A轉(zhuǎn)換器和三位四通電磁閥之間。 進一步地，所述比例放大器安裝在駕駛室內(nèi)。進一步地，所述超聲波傳感器為一種探測頭，至于所述底盤上方。進一步地，所述單片機根據(jù)內(nèi)置的PID算法對所述三位四通電磁閥發(fā)出反應信號。進一步地，該系統(tǒng)還包括液壓缸及其附件，通過單片機進行自動控制。進一步地，所述收割機行走控制系統(tǒng)為甘蔗收割機行走控制系統(tǒng)。本發(fā)明還提供了一種收割機行走控制方法，其包括如下步驟
I)利用超聲波傳感器檢測得到所述超聲波傳感器與地面的距離和所述超聲波傳感器距離底盤的距離；2)單片機接收所述傳感器檢測到距離，計算得到底盤距離地面的距離；并根據(jù)內(nèi)置的PID算法對三位四通電磁 閥發(fā)出指令，從而實現(xiàn)液壓缸的動作控制。進一步地，該收割機行走控制方法用于甘蔗收獲機械。所述步驟2 )進一步包括單片機根據(jù)所述傳感器檢測到的兩個距離計算得到底盤距離地面的距離；單片機利用內(nèi)置的PID算法不斷的將超聲波傳感器中的反饋電路得到的高度測量值與設定值性比較，用比較得到的偏差進行比例、積分、微分的計算，所得結(jié)果作為對三位四通電磁閥的輸入，從而實現(xiàn)液壓缸的動作控制。(三)技術(shù)效果通過自動控制割臺的升降使割臺達到最優(yōu)的離地距離，提高其仿形能力，并以此來提高收割質(zhì)量，尤其能解決甘蔗在收獲期間破頭率高和切割損失嚴重的問題。


圖I電液控制系統(tǒng)2控制系統(tǒng)流程3超聲波發(fā)射電路4超聲波接收電路5超聲波測距程序流程6IXD顯示電路7IXD顯不程序流程圖
具體實施例方式本發(fā)明將機械加工領域的電液仿形技術(shù)借鑒過來，用于收割機械的底盤仿形控制。本方法的關(guān)鍵技術(shù)在于，單片機系統(tǒng)的設計和控制方法的實現(xiàn)，使其能夠準確的獲取超聲波傳感器的數(shù)據(jù)，并進行處理反映，再將其反映信號通過D/A轉(zhuǎn)化器和比例放大器傳送給三位四通電磁閥和液壓缸，然后將根據(jù)單片機內(nèi)PID子程序?qū)崿F(xiàn)對收割底盤高度的自動控制。實施例I :本發(fā)明提供的基于地面仿形機械行走控制系統(tǒng)及方法在收割機械地面仿形及收割底盤高度控制方面進行了改進，利用超聲波傳感器來測割臺離地的距離，再通過單片機來控制液壓系統(tǒng)，控制割臺的升降使割臺達到最優(yōu)的離地距離。利用(I)超聲波傳感器監(jiān)測收割機械收割底盤的高度，并將信號傳給(2) AT89S52單片機，同時將此高度值顯示在LDC1602顯示器上，單片機根據(jù)內(nèi)置的PID算法對該信號進行分析處理，然后將反映信號經(jīng)過D/A轉(zhuǎn)換器和(4)比例放大器傳給三位四通的電磁閥，通過控制電磁閥的電流實現(xiàn)對其不同方向上對負載流量或壓力的連續(xù)控制，進而實現(xiàn)對收割底盤的自動仿形控制。
此外，亦可通過人為的通過手動方式設定一個收割底盤高度值，則單片機系統(tǒng)則會根據(jù)此值自動進行反饋調(diào)節(jié)，從而使收割底盤達到一個合理的自動仿形高度。實施例2 本發(fā)明提供了一種基于地面仿形甘蔗收割機械行走控制系統(tǒng)，該系統(tǒng)包括超聲波傳感器，單片機，顯示器，比例放大器，三位四通電磁閥，液壓缸及其它液壓附件(7、8、9)。
所述的超聲波傳感器采用上海彭城電子公司生產(chǎn)UNAM 50型超聲波傳感器，感應范圍為400-2500mm，外殼為黃銅鎳電鍍的圓柱形。并將其做成一種探測頭置于收割底盤上方某一位置，并使其能夠監(jiān)測到對地高度。所述的單片機為Atmel公司生產(chǎn)的AT89S52型,該單片機是一種低功耗、高性能、采用CMOS工藝制作的8位單片機，并且與工業(yè)標準型80C51單片機的指令集和引腳完全兼容。所述的IXD1602顯示器采用深圳市柏晶科技有限公司的1602IXD，此顯示器每行顯示16個字符，一共可以顯示兩行，并且具有顯示質(zhì)量高、數(shù)字式接口、體積小、重量輕、功率消耗小等優(yōu)點。此顯示器安裝在操作室儀表盤附近，以便于操作人員的查看。所述的比例放大器采用泉州東馳電子公司生產(chǎn)的塑盒模塊導軌式單路比例閥放大器VT-P-D24-AX-X，以此來控制電磁閥的動作。該比例放大器采用電源錯極保護技術(shù)，內(nèi)置自恢復保險絲，無須更換，故障排除可自動恢復正常工作。如圖I所示，基于地面仿形甘蔗收割機械行走控制系統(tǒng)，該系統(tǒng)包括(I)超聲波傳感器，(2)AT89S52單片機，(3)LCD1602顯示器，(4)比例放大器(5)三位四通電磁閥，(6)液壓缸及其它液壓附件。利用(I)超聲波傳感器監(jiān)測甘蔗收割機械收割底盤的高度，并將信號傳給(2) AT89S52單片機，同時將此高度值顯示在LDC1602顯示器上，單片機根據(jù)內(nèi)置的PID算法對該信號進行分析處理，然后將反映信號經(jīng)過D/A轉(zhuǎn)換器和(4)比例放大器傳給三位四通的電磁閥，通過控制電磁閥的電流實現(xiàn)對其不同方向上對負載流量或壓力的連續(xù)控制，進而實現(xiàn)對收割底盤的自動仿形控制。與此同時，亦可人為的通過手動方式設定一個收割底盤高度值，則單片機系統(tǒng)則會根據(jù)此值自動進行反饋調(diào)節(jié)，從而使收割底盤達到一個合理的自動仿形高度。其控制系統(tǒng)流程圖如圖2所示。本發(fā)明所用的PID控制技術(shù)，是基于反饋的控制方法。反饋理論的要素包括三個部分測量、比較和執(zhí)行。在本發(fā)明中則是不斷的將反饋電路得到的高度測量值與設定值相比較，用它們之間的偏差E進行比例(P)、積分(I)、微分(D)的計算，所得結(jié)果作為執(zhí)行器的輸入，執(zhí)行器的輸出調(diào)節(jié)控制對象，進而實現(xiàn)對仿形系統(tǒng)的高度控制。比例部分的作用可以減少穩(wěn)態(tài)誤差，提聞系統(tǒng)的動態(tài)響應速度。實施例3 除了和實施例2相同的內(nèi)容，該系統(tǒng)還包含有軟件特征。該系統(tǒng)的軟件編程主要是通過Keil uVision2軟件以C語言和匯編語言為基礎來進行編程的，并通過燒錄軟件將程序燒入單片機。該程序算法主要包括超聲波測距算法，LCD顯示算法和PID算法。當超聲波傳感器將信號傳送過來時，單片機即可對此信號做出反應，其一方面根據(jù)內(nèi)置的PID算法對電磁閥發(fā)出反應信號，另一方面將傳感器的信號顯示在LCD上。實施例4 本發(fā)明中的超聲波發(fā)射和接收電路設計圖如圖3圖4所示，其超聲波測距算法特征主要為程序首先要對系統(tǒng)環(huán)境初始化，設置定時器TO工作模式為16位定時/計數(shù)器模式，置位總中斷允許位EA并對顯示端口 PO和P2清0 ;然后調(diào)用超聲波發(fā)生子程序送出一個超聲波脈沖。為了避免超聲波從發(fā)射器直接傳到接收器引起的直射波，需要延時約0. Ims(這也就是超聲波測距器會有一個最小可測距離的原因)后才可打開外中斷0接收返回的超聲波信號。由于采用的是12MHz的晶振，計數(shù)器每計一個數(shù)就是lus，所以當主程序檢測到接收成功的標志位后，將計數(shù)器TO中的數(shù)(即超聲波來回所用的時間)按下面公式計算，即可得被測物體與測距器之間的距離。設計時取20°C時的聲速為344m/s，則有d= (vXt)/2= (172T/10000) cm其中T為計數(shù)器TO的計數(shù)值，V表示聲速，t表示時間，測出距離后，單片機自動調(diào)用IXD顯示程序，并將結(jié)果送往IXD顯示約為0. 5s，然后再發(fā)超聲波脈沖重復測量過程。具體超聲波測距主程序如圖5所示。以上實施方式僅用于說明本發(fā)明，而并非對本發(fā)明的限制，如本發(fā)明還可用于收割其他農(nóng)作物，有關(guān)技術(shù)領域的普通技術(shù)人員，在不脫離本發(fā)明的精神和范圍的情況下，還 可以做出各種變化和變型，因此所有等同的技術(shù)方案也屬于本發(fā)明的范疇，本發(fā)明的專利保護范圍應由權(quán)利要求限定。
權(quán)利要求
1.一種收割機行走控制系統(tǒng)，其特征在于，該系統(tǒng)包括超聲波傳感器、單片機、顯示器、三位四通電磁閥，其中，所述超聲波傳感器用于監(jiān)測甘蔗收割機機械底盤的高度，并將所述信號傳送給單片機和顯示器，所述單片機對該信號進行分析處理，然后將處理后的信號傳送給三位四通電磁閥，通過控制該電磁閥的電流實現(xiàn)在其不同方向上對負載流量或壓力的控制。
2.如權(quán)利要求I所述的收割機行走控制系統(tǒng)，其特征還在于所述系統(tǒng)還包括D/A轉(zhuǎn)換器，連接在所述單片機和三位四通電磁閥之間。
3.如權(quán)利要求2所述的收割機行走控制系統(tǒng)，其特征還在于所述系統(tǒng)還包括比例放大器，連接在所述D/A轉(zhuǎn)換器和三位四通電磁閥之間。
4.如權(quán)利要求3所述的收割機行走控制系統(tǒng)，所述比例放大器安裝在駕駛室內(nèi)。
5.如權(quán)利要求I所述的收割機行走控制系統(tǒng)，所述超聲波傳感器為一種探測頭，至于所述底盤上方。
6.如權(quán)利要求I所述的收割機行走控制系統(tǒng)，所述單片機根據(jù)內(nèi)置的PID算法對所述三位四通電磁閥發(fā)出反應信號。
7.如權(quán)利要求I所述的收割機行走控制系統(tǒng)，還包括液壓缸及其附件，通過單片機進行自動控制。
8.如權(quán)利要求I所述的收割機行走控制系統(tǒng)，所述收割機行走控制系統(tǒng)為甘蔗收割機行走控制系統(tǒng)。
9.一種收割機行走控制方法，其包括如下步驟 1)利用超聲波傳感器檢測得到所述超聲波傳感器與地面的距離和所述超聲波傳感器距離底盤的距離； 2)單片機接收所述傳感器檢測到的兩個距離，并且根據(jù)內(nèi)置的PID控制算法對三位四通電磁閥發(fā)出指令，實現(xiàn)對液壓缸的動作控制。
10.如權(quán)利要求9所述的收割機行走控制方法， 所述步驟2)進一步包括 單片機根據(jù)所述傳感器檢測到的兩個距離計算得到底盤距離地面的距離； 單片機利用內(nèi)置的PID算法不斷的將超聲波傳感器中的反饋電路得到的高度測量值與設定值性比較，用比較得到的偏差進行比例、積分、微分的計算，所得結(jié)果作為對三位四通電磁閥的輸入，從而實現(xiàn)液壓缸的動作控制。
全文摘要
本發(fā)明提供一種收割機機械行走控制系統(tǒng)，其特征在于，該系統(tǒng)包括超聲波傳感器、單片機、顯示器、三位四通電磁閥，其中，所述超聲波傳感器用于監(jiān)測收割機機械底盤的高度，并將所述信號傳送給單片機和顯示器，所述單片機對該信號進行分析處理，然后將處理后的信號傳送給三位四通電磁閥，通過控制該電磁閥的電流實現(xiàn)在其不同方向上對負載流量或壓力的控制。
文檔編號A01D45/10GK102714972SQ20121020267
公開日2012年10月10日 申請日期2012年6月15日 優(yōu)先權(quán)日2012年6月15日
發(fā)明者彭彥昆, 楊偉龍, 湯修映 申請人:中國農(nóng)業(yè)大學