新四季網

一種自主導航拖拉機轉向角無線測量系統及方法與流程

2023-04-26 05:38:31


本發明涉及農業機械自主導航技術,尤其是一種適用於無人駕駛拖拉機的自主導航技術,具體的說是一種自主導航拖拉機轉向角無線測量系統及方法。



背景技術:

在拖拉機自主導航系統的研製中,前輪(轉向輪)轉向角的測量尤為關鍵。目前常用電位計或編碼器測量前輪轉向角。將電位計或編碼器底座固定在拖拉機前橋和前輪連接的轉軸上,電位計或編碼器的軸心通過傳動機構與前橋的固定裝置相連。當拖拉機轉向輪發生偏轉時,電位計或編碼器的轉軸和底座發生相對角位移,進而產生變化的電信號(電位計輸出模擬電壓信號,編碼器輸出脈衝信號)。通過信號採集單元接收電信號,解算出相應角度,並通過物理線路傳輸到工控機,完成了轉向角的測量。

然而在工程實踐中,上述方法存在的突出問題:(1)電位計或編碼器安裝方式複雜,安裝精度要求較高,同時還需要對原有機械結構改造;(2)拖拉機工作環境惡劣,作物、雜草等容易對傳輸線路刮傷、刮斷,影響傳感器的正常使用。



技術實現要素:

本發明的目的是針對目前在無人駕駛拖拉機自主導航技術方面存在的問題,提供一種自主導航拖拉機轉向角無線測量系統及方法,具有結構簡單,安裝方便,適應性強,便於操控等特點,為無人駕駛拖拉機技術的發展創造有利條件。

本發明的技術方案是:

一種自主導航拖拉機轉向角無線測量系統,包括1套數傳電臺,所述數傳電臺包括3個發射端和1個接收端;所述3個發射端分別與1號、2號和3號姿態傳感器相連;所述1號和3號姿態傳感器分別安裝在拖拉機的左、右轉向輪與前橋橫梁連接的轉軸頂部;所述2號姿態傳感器安裝在拖拉機前橋橫梁的中間位置;所述數傳電臺的接收端與工控機相連,能夠接受所述3個發射端的數據。

進一步的,所述數傳電臺為低功耗433mhz。

進一步的,所述1號、2號和3號姿態傳感器的輸出頻率均為20hz,輸出信息為航向角。

進一步的,所述將3個發射端通過ttl串行通信接口與所述1號、2號和3號姿態傳感器分別連接。

進一步的,所述1號和3號姿態傳感器的x軸分別平行於拖拉機左、右轉向輪並指向前方;所述2號姿態傳感器的x軸垂直於前橋橫梁並指向前方。

一種自主導航拖拉機轉向角無線測量系統進行測量的方法,包括以下步驟:

1)從數傳電臺接收端讀取當前時刻3個姿態傳感器的航向角數據h1(t)、h2(t)、h3(t);

2)分別檢測3個姿態傳感器當前時刻數據是否為異常數據。若發現接收到異常數據,則立即剔除,用前一次測量的正常數據代替;

3)通過計算1號和2號姿態傳感器發送的航向角之差,確定左輪轉向角al;通過計算2號和3號姿態傳感器發送的航向角之差,確定右輪轉向角ar;即:al=h1(t)-h2(t),ar=h3(t)-h2(t);

4)重複上述步驟1)至3),實現循環檢測左、右轉向輪的轉向角。

本發明的有益效果:

本發明結構簡單,安裝方便,可以避免傳統技術中複雜的物理傳輸線路,極大地提高了拖拉機導航系統工作的可靠性,為無人駕駛拖拉機技術的發展創造有利條件。

附圖說明

圖1是本發明的系統結構示意圖。

圖2是本發明中的姿態傳感器的安裝示意圖。

圖3是本發明中的數據流程示意圖。

其中:1-左轉向輪;2-1號姿態傳感器;3-前橋橫梁;4-2號姿態傳感器;5-3號姿態傳感器;6-右轉向輪。

具體實施方式

下面結合附圖和實施例對本發明作進一步的說明。

如圖1所示,一種自主導航拖拉機轉向角無線測量系統,包括1套數傳電臺。該數傳電臺為低功耗433mhz,包括3個發射端和1個接收端。所述3個發射端分別通過ttl串行通信接口與1號、2號和3號姿態傳感器相連,以便將各姿態傳感器感測到的信息發送給所述接收端。所述接收端與工控機相連,能夠接受所述3個發射端的數據,並傳輸給工控機。優選的,所述1號、2號和3號姿態傳感器均為微型姿態傳感器。

如圖2所示,所述1號姿態傳感器2安裝在左轉向輪1與前橋橫梁3連接的轉軸頂部,其x軸正方向x1與左轉向輪1平行的指向前方。所述3號姿態傳感器5安裝在右轉向輪6與前橋橫梁3連接的轉軸頂部,其x軸正方向x3與右轉向輪6平行的指向前方。由此,可保證左、右轉向輪發生偏轉時,1號和3號姿態傳感器能夠同步運動。所述2號姿態傳感器4安裝在前橋橫梁3的中心,其x軸正方向x2垂直於前橋橫梁3指向前方。

所述1號、2號和3號姿態傳感器的輸出頻率均為20hz,輸出信息為航向角,同時,設置通信參數為波特率9600bps,校驗位:n,數據位:8,停止位:1,即可感測拖拉機左、右轉向輪相對於前橋橫梁垂直方向之間的角度變化,並通過數傳電臺傳輸到工控機上。

如圖3所示,使用上述自主導航拖拉機轉向角無線測量系統進行測量的方法包括以下步驟:

1)從數傳電臺接收端讀取當前時刻3個姿態傳感器的航向角數據h1(t)、h2(t)、h3(t);

2)分別檢測3個姿態傳感器當前時刻數據是否為異常數據。若發現接收到異常數據,則立即剔除,用前一次測量的正常數據代替;

3)通過計算1號和2號姿態傳感器發送的航向角之差,確定左輪轉向角al;通過計算2號和3號姿態傳感器發送的航向角之差,確定右輪轉向角ar;即:al=h1(t)-h2(t),ar=h3(t)-h2(t);

4)重複上述步驟1)至3),實現循環檢測左、右轉向輪的轉向角。

所述步驟2)中,奇異值的檢測算法為,以1號姿態傳感器為例:

a.獲取當前時刻航向角h1(t)和鄰近連續8個時刻的航向角h1(t-1)h1(t-2)……h1(t-8);

b.計算連續8個距離增量△h1(t)、△h1(t-1)……△h1(t-7),表達式中△h1(t-n)=|h1(t-n)-h1(t-n-1)|;

c.計算上述8個距離增量的算術平均值d(t);

d.若h1(t)>3d(t),則認為h1(t)為異常數據,然後將h1(t)的數值用h1(t-1)代替。反之,則認為h1(t)為正常數據。

本發明未涉及部分均與現有技術相同或可採用現有技術加以實現。



技術特徵:

技術總結
本發明涉及一種自主導航拖拉機轉向角無線測量系統及方法,包括1套數傳電臺,所述數傳電臺包括3個發射端和1個接收端;所述3個發射端分別與1號、2號和3號姿態傳感器相連;所述1號和3號姿態傳感器分別安裝在拖拉機的左、右轉向輪與前橋橫梁連接的轉軸頂部;所述2號姿態傳感器安裝在拖拉機前橋橫梁的中間位置;所述數傳電臺的接收端與工控機相連,能夠接受所述3個發射端的數據。通過計算1號和2號姿態傳感器,以及2號和3號姿態傳感器的航向角之差,即可確定左右轉向輪的轉向角。本發明結構簡單,安裝方便,可以避免傳統技術中複雜的物理傳輸線路,極大地提高了拖拉機導航系統工作的可靠性,為無人駕駛拖拉機技術的發展創造有利條件。

技術研發人員:田光兆;顧寶興;王海青;周俊;安秋
受保護的技術使用者:南京農業大學
技術研發日:2017.04.10
技術公布日:2017.08.01
同类文章

一種新型多功能組合攝影箱的製作方法

一種新型多功能組合攝影箱的製作方法【專利摘要】本實用新型公開了一種新型多功能組合攝影箱,包括敞開式箱體和前攝影蓋,在箱體頂部設有移動式光源盒,在箱體底部設有LED脫影板,LED脫影板放置在底板上;移動式光源盒包括上蓋,上蓋內設有光源,上蓋部設有磨沙透光片,磨沙透光片將光源封閉在上蓋內;所述LED脫影

壓縮模式圖樣重疊檢測方法與裝置與流程

本發明涉及通信領域,特別涉及一種壓縮模式圖樣重疊檢測方法與裝置。背景技術:在寬帶碼分多址(WCDMA,WidebandCodeDivisionMultipleAccess)系統頻分復用(FDD,FrequencyDivisionDuplex)模式下,為了進行異頻硬切換、FDD到時分復用(TDD,Ti

個性化檯曆的製作方法

專利名稱::個性化檯曆的製作方法技術領域::本實用新型涉及一種檯曆,尤其涉及一種既顯示月曆、又能插入照片的個性化檯曆,屬於生活文化藝術用品領域。背景技術::公知的立式檯曆每頁皆由月曆和畫面兩部分構成,這兩部分都是事先印刷好,固定而不能更換的。畫面或為風景,或為模特、明星。功能單一局限性較大。特別是畫

一種實現縮放的視頻解碼方法

專利名稱:一種實現縮放的視頻解碼方法技術領域:本發明涉及視頻信號處理領域,特別是一種實現縮放的視頻解碼方法。背景技術: Mpeg標準是由運動圖像專家組(Moving Picture Expert Group,MPEG)開發的用於視頻和音頻壓縮的一系列演進的標準。按照Mpeg標準,視頻圖像壓縮編碼後包

基於加熱模壓的纖維增強PBT複合材料成型工藝的製作方法

本發明涉及一種基於加熱模壓的纖維增強pbt複合材料成型工藝。背景技術:熱塑性複合材料與傳統熱固性複合材料相比其具有較好的韌性和抗衝擊性能,此外其還具有可回收利用等優點。熱塑性塑料在液態時流動能力差,使得其與纖維結合浸潤困難。環狀對苯二甲酸丁二醇酯(cbt)是一種環狀預聚物,該材料力學性能差不適合做纖

一種pe滾塑儲槽的製作方法

專利名稱:一種pe滾塑儲槽的製作方法技術領域:一種PE滾塑儲槽一、 技術領域 本實用新型涉及一種PE滾塑儲槽,主要用於化工、染料、醫藥、農藥、冶金、稀土、機械、電子、電力、環保、紡織、釀造、釀造、食品、給水、排水等行業儲存液體使用。二、 背景技術 目前,化工液體耐腐蝕貯運設備,普遍使用傳統的玻璃鋼容

釘的製作方法

專利名稱:釘的製作方法技術領域:本實用新型涉及一種釘,尤其涉及一種可提供方便拔除的鐵(鋼)釘。背景技術:考慮到廢木材回收後再加工利用作業的方便性與安全性,根據環保規定,廢木材的回收是必須將釘於廢木材上的鐵(鋼)釘拔除。如圖1、圖2所示,目前用以釘入木材的鐵(鋼)釘10主要是在一釘體11的一端形成一尖

直流氧噴裝置的製作方法

專利名稱:直流氧噴裝置的製作方法技術領域:本實用新型涉及ー種醫療器械,具體地說是ー種直流氧噴裝置。背景技術:臨床上的放療過程極易造成患者的局部皮膚損傷和炎症,被稱為「放射性皮炎」。目前對於放射性皮炎的主要治療措施是塗抹藥膏,而放射性皮炎患者多伴有局部疼痛,對於止痛,多是通過ロ服或靜脈注射進行止痛治療

新型熱網閥門操作手輪的製作方法

專利名稱:新型熱網閥門操作手輪的製作方法技術領域:新型熱網閥門操作手輪技術領域:本實用新型涉及一種新型熱網閥門操作手輪,屬於機械領域。背景技術::閥門作為流體控制裝置應用廣泛,手輪傳動的閥門使用比例佔90%以上。國家標準中提及手輪所起作用為傳動功能,不作為閥門的運輸、起吊裝置,不承受軸向力。現有閥門

用來自動讀取管狀容器所載識別碼的裝置的製作方法

專利名稱:用來自動讀取管狀容器所載識別碼的裝置的製作方法背景技術:1-本發明所屬領域本發明涉及一種用來自動讀取管狀容器所載識別碼的裝置,其中的管狀容器被放在循環於配送鏈上的文檔匣或託架裝置中。本發明特別適用於,然而並非僅僅專用於,對引入自動分析系統的血液樣本試管之類的自動識別。本發明還涉及專為實現讀