時間:2022年01月06日 分類:經濟論文 次數:
摘要:為提高采棉機采收效率,降低駕駛員勞動強度,開發采棉機自動對行系統具有重要意義和實用價值。為此,采用機械機構碰撞棉花植株隊列的方法,研究其碰撞規律、機械運動原理及采棉機轉彎控制方式等內容,開發出能夠對采棉機速度自適應的自動對行技術。工作時,通過實時采集車體航向和棉花隊列之間的相對角度信息以及后輪的當前位置狀態,經速度參數自適應的PID算法得到理想控制電壓,由電壓控制采棉機上的液壓控制器,進而控制后輪轉向;通過判斷后輪位置傳感器狀態限制轉向角度,并及時控制后輪回正,實現采棉機自動對行的功能。田間試驗結果表明:采棉機可以長時間自動對行連續作業,作業結果滿足采棉需求。
關鍵詞:采棉機;輔助駕駛;自動對行;速度參數自適應PID
0引言
采棉機屬于大型農業機械,機械結構復雜,操作復雜度高,在新疆等大面積棉花種植區逐漸廣泛應用,在棉花采摘方面扮演著十分重要的角色。為提高采棉機采收效率,降低駕駛員勞動強度,開發采棉機自動對行系統具有重要意義和實用價值。近年來,自動導航、自主駕駛技術在農業機械上得到越來越多的研究和應用[1-4],通常采用高精度RTK衛星定位技術實現AB線導航,主要應用于不需要對行的田間作業;采棉機采收作業時,不只是需要實現AB線的行駛,還需要使采頭機構始終對準棉壟。
目前,國外部分機型上應用了自動對行技術,如美國約翰迪爾的采棉機;國產機型主要依賴人工對行駕駛,自動對行研究尚為空白。類似的需要對行作業的機械有玉米收獲機、水稻除草機等,有相關的自動對行技術研究,主要采用機器視覺[5-7]或機械碰撞[8-10]兩種方式。筆者根據采棉作業的實際情況,研究了一種基于機械碰撞靴航向偏差角檢測和后輪轉角控制的采棉機自動對行控制系統。
1采棉機自動對行機械設計
1.1航向偏差檢測裝置設計
航向偏差檢測裝置用于檢測采棉機行駛方向相對于棉壟方向的偏差,由3根連桿、兩個碰撞靴、傳感器安裝支撐結構、高精度角度傳感器及其相關配件組成。
角度傳感器選用鈦克邁機電科技有限公司的RFC4801系列角度傳感器。該傳感器是非接觸式傳感器,由傳感器母端和磁珠兩個獨立的元件組成,可通過感知條形磁鐵磁場方向的變化測量角度,輸出4~20mA的電流。航向偏差檢測裝置安裝在采頭內側,采棉機在作業時由于存在實時對行偏差,棉花植株會在不同的位置碰撞到左側或右側的碰撞靴,帶動連桿繞固定軸旋轉;磁珠固定在連桿上與連桿同心旋轉,傳感器母端經支撐架固定于U型槽鋼上,角度傳感器檢測出不同的偏差角度,輸出至自動 對行控制器。
當棉花植株碰到左側碰撞靴時,表示航向偏向左側了,輸出偏差角度為-90°~0°;當碰到右側碰撞靴時,表示航向偏向右側了,輸出偏差角度為0°~90°;當棉花植株從中間通過時,表示航向與棉株方向對齊,輸出偏差角度為0°。通過計算和標定,可以得到碰撞靴橫向運動和傳感器輸出模擬量之間的一一對應關系,進而可以將航向偏差與輸出模擬量之間的關系轉化為碰撞靴橫向偏差與輸出模擬量之間的關系,即d∝I。由此關系可得出航向偏差,進而通過算法控制對行。
1.2轉向控制與輪轉角檢測
采棉機作業期間,通過控制后輪實現轉向,自動對行控制器控制液壓控制器進而控制后輪的轉向角速度和轉向方向,卻無法直接控制轉向角度。因此,在后輪轉向液壓桿上安裝拉線傳感器,實時測量液壓桿長度。通過計算和標定,可以得出后輪轉向角度和拉線傳感器拉線長度的一一對應關系,即轉向角Ø與傳感器輸出I的一一對應關系,即Ø∝I。由此可實時得到采棉機后輪狀態,實現對后輪的閉環控制。
2自動對行控制原理
采棉機在自動對行作業時,自動對行控制器實時采集和計算航向偏差角、行走速度和后輪轉向角,根據航向偏差角判斷對行的偏離程度,采用自動對行控制方法,輸出0~10V電壓信號到液壓控制器,進而由液壓控制器控制轉向液壓桿驅動后輪轉向,實現自動對行。
采棉機在自動對行作業期間方向盤不會隨采棉機轉向而自動轉動,但方向盤仍然具有控制功能,可人為干預控制,手動控制優先級最高。收獲作業時,設備上電后可根據不同采棉機的個體差異選擇一鍵校準傳感器“中位”值;啟動自動對行,自動對行控制器會實時監測航向是否偏離棉花隊列,若偏離則控制采棉機向棉花隊列靠攏。同時,實時監測是否關閉自動對行功能。
3自動對行控制器設計
3.1硬件設計
自動對行控制器采用的主控芯片STMF107VCT6,運行穩定,滿足本文使用功能。CAN通信芯片使用CTM1051AM,內置保護電路,相較VP230抗干擾能力更強;DA芯片使用MCP4728,有4個12位DA轉換通道,通過I2C與主控芯片通信,控制板供電由車上電源供電(24V)。自動對行程序功能模塊主要由一鍵校準程序模塊、自動對行實時控制程序模塊、在線修改PID參數程序模塊3部分組成,其中,一鍵校準解決個體差異問題。當采棉機航向偏差檢測裝置和后輪處于中位時,一鍵校準;在線修改PID參數由車載智能顯示器來完成,通過CAN通信實時更新到控制板中,實時調優控制。
4采棉機自動對行試驗
實地試驗采用4MZ-6A型六行采棉機,安裝航向偏差檢測機械結構(內含角度傳感器)、速度傳感器、后輪轉向拉線傳感器及自動對行控制器。試驗在新疆某處待收獲的棉花田進行,棉花隊列是雙行緊湊形式。因種植過程不是完全標準尺寸,縱向行距與橫向行距均為10cm左右,采棉機采頭機組采用機械仿形,試驗過程中采頭機組離地高度較為穩定。
首先,駕駛員以2~5km/h的動態速度手動控制采棉機收獲。此時,自動對行控制器以5Hz/s的頻率采集采棉機各個傳感器的動態值并打印到文件中。手動駕駛時,采棉機能夠正常收獲棉花,對行效果較為理想。通過計算轉換,采棉機在手動控制時航向偏差在±3°以內。
接著,駕駛員在采棉機正常作業期間啟動自動對行功能,此時采棉機依然能夠正常作業,對采集的數據計算得出其航向偏差變化基本都在±2.5°以內,滿足作業要求。對比手動駕駛,自動對行模式下航向偏差略優于手動模式,行駛穩定,可以連續長時間自動對行作業。
5結論
1)提出了一種新的采棉機自動對行控制方式及機械結構,通過自動對行控制器采集采棉機航向、后輪角度狀態,經速度參數適應的PID算法處理控制采棉機轉向,進而影響航向,形成閉環自動控制。同時,應用于某六行采棉機中,在新疆實地測試驗證了該方案的可行性。
2)實地測試中,采棉機以2~5km/h作業,利用適應速度的PID控制,增加了其對速度的適應能力。對比人工駕駛采棉機對行,自動對行控制系統控制采棉機航向偏差小和效果更好,滿足采棉作業要求
3)采棉機自動對行控制技術是手動駕駛的一種有效輔助,僅適用于手動對準連續的棉株隊列后切換為自動對行,棉株不連續時容易走偏后無法自動回正,且尚不具有自動掉頭和路徑規劃等功能。因此,后續擬結合高精度RTK定位技術和視覺對行技術,逐步實現采棉機無人駕駛。
參考文獻:
[1]劉成良,林洪振,李彥明,等.農業裝備智能控制技術研究現狀與發展趨勢分析[J].農業機械學報,2020,51(1):1-18.
[2]張漫,季宇寒,李世超,等.農業機械導航技術研究進展[J].農業機械學報,2020,51(4):1-18.
[3]李志騰,李彥明,唐小濤,等.水稻穴直播機自主駕駛控制系統設計[J].農機化研究,2019,41(2):150-154.
[4]張健,郭守杰,楊然兵,等.基于STM32F7的農業機械自動導航作業控制器[J].農機化研究,2021,43(5):73- 78.
[5]田光兆,顧寶興,IrshadAliMari,等.基于三目視覺的自主導航拖拉機行駛軌跡預測方法及試驗[J].農業工程學報,2018,34(19):40-45.
[6]QIWANG,CHAGNSONGYANG,SHAOENWU.Applicationofvisionaidedstrapdownintegratednavigationinlanevehicles[J].Internationaljournalofembeddedsystems,2020,13(1):121-127.
[7]梁習卉子,陳兵旗,姜秋慧,等.基于圖像處理的玉米收割機導航路線檢測方法[J].農業工程學報,2016,32(22):43-49.
[8]陳剛,周平,孫宜田,等.機械接觸式導航控制系統的研究與試驗[J].農機化研究,2017,39(8):186-190.
作者:苗中華,田大慶,何創新,李楠