一種果園組合信息導(dǎo)航移動(dòng)平臺(tái)的制作方法
【技術(shù)領(lǐng)域】
[0001]本實(shí)用新型涉及果園機(jī)械自動(dòng)導(dǎo)航領(lǐng)域，具體涉及一種果園組合信息導(dǎo)航移動(dòng)平臺(tái)O
【背景技術(shù)】
[0002]自動(dòng)導(dǎo)航技術(shù)是近年來果園管理自動(dòng)化的關(guān)鍵技術(shù)之一，其包括:周圍環(huán)境信息獲取，導(dǎo)航路徑規(guī)劃，導(dǎo)航平臺(tái)模型建立和導(dǎo)航控制模型建立。通過傳感器對(duì)周圍環(huán)境信息進(jìn)行獲取，根據(jù)所獲取的果園環(huán)境信息擬合導(dǎo)航路徑，使移動(dòng)平臺(tái)能夠?qū)崿F(xiàn)自動(dòng)導(dǎo)航。
[0003]目前使用較為廣泛的導(dǎo)航系統(tǒng)有機(jī)械導(dǎo)航、電磁導(dǎo)航、視覺導(dǎo)航、超聲波導(dǎo)航、GPS導(dǎo)航和激光導(dǎo)航。單一傳感器在果園導(dǎo)航中存在局限性。機(jī)械式導(dǎo)航需在果園中預(yù)先設(shè)置導(dǎo)軌以便對(duì)果園移動(dòng)平臺(tái)進(jìn)行引導(dǎo)，電磁導(dǎo)航需預(yù)埋電纜，這樣做不但增加了果園建園成本，而且日后維護(hù)較為困難。視覺導(dǎo)航和超聲波導(dǎo)航易受環(huán)境因素影響如天氣，光照等，因此導(dǎo)航誤差較大，且可靠性較低。
[0004]液壓系統(tǒng)由于其布置靈活，重量輕，體積小，運(yùn)動(dòng)慣性小，反應(yīng)速度快，易于和電控部分結(jié)合，被廣泛用于工業(yè)生產(chǎn)中。為實(shí)現(xiàn)導(dǎo)航平臺(tái)自動(dòng)化，液壓控制系統(tǒng)的引入具有重要意義。

【發(fā)明內(nèi)容】

[0005]為克服現(xiàn)有技術(shù)中的不足和缺陷，本實(shí)用新型提出了一種果園組合信息導(dǎo)航移動(dòng)平臺(tái)，該系統(tǒng)是基于機(jī)器視覺、激光測(cè)距儀和液壓轉(zhuǎn)向技術(shù)進(jìn)行設(shè)計(jì)的。該移動(dòng)平臺(tái)有效克服了機(jī)器視覺易受環(huán)境變化影響的缺點(diǎn)。
[0006]本實(shí)用新型解決其技術(shù)問題所采用的技術(shù)方案是一種果園組合信息導(dǎo)航移動(dòng)平臺(tái)，主要包括激光測(cè)距儀1、工業(yè)相機(jī)2、傳感器安裝架3、蓄電池4、控制箱5、車身6、前輪轉(zhuǎn)角傳感器7、前輪軸8、前輪轉(zhuǎn)向軸9、前輪連桿1、液壓缸11、電磁閥12、液壓栗13、角速度傳感器14、后輪電機(jī)15、油箱16、溢流閥17、底盤18。其特征在于:所述傳感器安裝架3通過螺紋連接安裝在移動(dòng)平臺(tái)車身6正前方，所述激光測(cè)距儀I通過螺紋連接安裝在傳感器安裝架3正前方，所述工業(yè)相機(jī)2通過螺紋連接安裝在傳感器安裝架3頂端并和水平方向成向下呈30°夾角。蓄電池4和控制箱5通過螺紋連接安裝在移動(dòng)平臺(tái)車身6上表面。前輪轉(zhuǎn)角傳感器7安裝在前輪轉(zhuǎn)向軸9上以便測(cè)量前輪轉(zhuǎn)向角度，前輪軸8焊接在地盤18上，前輪連桿10通過前輪轉(zhuǎn)向軸9和前輪軸8連接，確保前輪可繞前輪轉(zhuǎn)向軸9轉(zhuǎn)動(dòng)。前輪和前輪連桿通過軸承和螺紋連接，使得前輪可自由轉(zhuǎn)動(dòng)。液壓缸11通過螺紋連接安裝在地盤18上，液壓缸11左右兩端推桿通過前輪轉(zhuǎn)向軸9和前輪連桿1連接。電磁閥12、油箱16、和溢流閥17通過螺紋連接固定在地盤上。液壓缸11、電磁閥12、液壓栗13、溢流閥17和油箱16通過油管連接組成轉(zhuǎn)向油路。后輪電機(jī)15通過螺紋與底盤連接，后輪安裝在電機(jī)轉(zhuǎn)軸上。角速度傳感器14安裝在后輪電機(jī)轉(zhuǎn)軸上測(cè)量電機(jī)輸出轉(zhuǎn)速。
[0007]上述的一種果園組合信息導(dǎo)航移動(dòng)平臺(tái)，以蓄電池4為動(dòng)力源，通過后輪電機(jī)15驅(qū)動(dòng)移動(dòng)平臺(tái)后輪轉(zhuǎn)動(dòng)，同時(shí)可通過角速度傳感器14測(cè)量后輪轉(zhuǎn)速。角速度傳感器14、前輪轉(zhuǎn)角傳感器7、激光測(cè)距儀I和工業(yè)相機(jī)2通過RS232和控制箱5相連接?？刂葡?通過RS232和后輪電機(jī)15相連接。
[0008]本實(shí)用新型基于上述原理，其工作原理是:該移動(dòng)平臺(tái)通過激光測(cè)距儀I和工業(yè)相機(jī)2獲取的周圍環(huán)境信息通過RS232接口傳輸給控制箱5然后由控制箱5計(jì)算出移動(dòng)平臺(tái)導(dǎo)航路徑，并根據(jù)導(dǎo)航路徑計(jì)算出前輪轉(zhuǎn)角大小和行駛速度。然后由控制箱發(fā)出信號(hào)通過前輪轉(zhuǎn)角傳感器7和角速度傳感器14獲取車輛當(dāng)前前輪轉(zhuǎn)向角度和后輪轉(zhuǎn)速，然后將由導(dǎo)航路徑計(jì)算出的前輪轉(zhuǎn)向角度和后輪行駛速度與當(dāng)前值進(jìn)行比較，最終輸出移動(dòng)平臺(tái)前輪轉(zhuǎn)向控制命令傳送電磁閥12給前輪達(dá)到預(yù)定轉(zhuǎn)向角，同時(shí)將后轉(zhuǎn)速控制命令傳輸給后輪電機(jī)15調(diào)整電機(jī)轉(zhuǎn)速，使移動(dòng)平臺(tái)后輪轉(zhuǎn)速達(dá)到預(yù)定速度。
[0009]本實(shí)用新型一種果園組合信息導(dǎo)航移動(dòng)平臺(tái)的有益效果是:根據(jù)果園環(huán)境實(shí)現(xiàn)了自動(dòng)導(dǎo)航，并克服了單一傳感器所存在的缺陷，在工作時(shí)可實(shí)現(xiàn)完全自主行走，節(jié)約了勞動(dòng)力，提高了工作效率和作業(yè)質(zhì)量。
【附圖說明】
[0010]圖1為本實(shí)用新型一種果園組合信息導(dǎo)航移動(dòng)平臺(tái)的外部結(jié)構(gòu)示意圖。
[0011]圖2為本實(shí)用新型一種果園組合信息導(dǎo)航移動(dòng)平臺(tái)的內(nèi)部結(jié)構(gòu)示意圖。
【具體實(shí)施方式】
[0012]下面結(jié)合附圖1對(duì)本實(shí)用新型作更進(jìn)一步的說明:
[0013]一種果園組合信息導(dǎo)航移動(dòng)平臺(tái)，主要包括激光測(cè)距儀1、工業(yè)相機(jī)2、傳感器安裝架3、蓄電池4、控制箱5、車身6、前輪轉(zhuǎn)角傳感器7、前輪軸8、前輪轉(zhuǎn)向軸9、前輪連桿10、液壓缸11、電磁閥12、液壓栗13、角速度傳感器14、后輪電機(jī)15、油箱16、溢流閥17、底盤18。其特征在于:所述傳感器安裝架3通過螺紋連接安裝在移動(dòng)平臺(tái)車身6正前方，所述激光測(cè)距儀I通過螺紋連接安裝在傳感器安裝架3正前方，所述工業(yè)相機(jī)2通過螺紋連接安裝在傳感器安裝架3頂端并和水平方向成向下呈30°夾角。蓄電池4和控制箱5通過螺紋連接安裝在移動(dòng)平臺(tái)車身6上表面。前輪轉(zhuǎn)角傳感器7安裝在前輪轉(zhuǎn)向軸9上以便測(cè)量前輪轉(zhuǎn)向角度，前輪軸8焊接在地盤18上，前輪連桿1通過前輪轉(zhuǎn)向軸9和前輪軸8連接，確保前輪可繞前輪轉(zhuǎn)向軸9轉(zhuǎn)動(dòng)。前輪和前輪連桿通過軸承和螺紋連接，使得前輪可自由轉(zhuǎn)動(dòng)。液壓缸11通過螺紋連接安裝在地盤18上，液壓缸11左右兩端推桿通過前輪轉(zhuǎn)向軸9和前輪連桿1連接。電磁閥12、油箱16、和溢流閥17通過螺紋連接固定在地盤上。液壓缸11、電磁閥12、液壓栗13、溢流閥17和油箱16通過油管連接組成轉(zhuǎn)向油路。后輪電機(jī)15通過螺紋與底盤連接，后輪安裝在電機(jī)轉(zhuǎn)軸上。角速度傳感器14安裝在后輪電機(jī)轉(zhuǎn)軸上測(cè)量電機(jī)輸出轉(zhuǎn)速。
[0014]上述的一種果園組合信息導(dǎo)航移動(dòng)平臺(tái)，以蓄電池4為動(dòng)力源，通過后輪電機(jī)15驅(qū)動(dòng)移動(dòng)平臺(tái)后輪轉(zhuǎn)動(dòng)，同時(shí)可通過角速度傳感器14測(cè)量后輪轉(zhuǎn)速。角速度傳感器14、前輪轉(zhuǎn)角傳感器7、激光測(cè)距儀I和工業(yè)相機(jī)2通過RS232和控制箱5相連接?？刂葡?通過RS232和后輪電機(jī)15相連接。
【主權(quán)項(xiàng)】
1.一種果園組合信息導(dǎo)航移動(dòng)平臺(tái)，主要包括激光測(cè)距儀(I)、工業(yè)相機(jī)(2)、傳感器安裝架(3)、蓄電池(4)、控制箱(5)、車身(6)、前輪轉(zhuǎn)角傳感器(7)、前輪軸(8)、前輪轉(zhuǎn)向軸(9)、前輪連桿(10)、液壓缸(11)、電磁閥(12)、液壓栗(13)、角速度傳感器(14)、后輪電機(jī)(15)、油箱(16)、溢流閥(17)、底盤(18)，其特征在于:所述傳感器安裝架(3)通過螺紋連接安裝在移動(dòng)平臺(tái)車身(6)正前方，所述激光測(cè)距儀(I)通過螺紋連接安裝在傳感器安裝架(3)正前方，所述工業(yè)相機(jī)(2)通過螺紋連接安裝在傳感器安裝架(3)頂端并和水平方向成向下呈30°夾角，蓄電池(4)和控制箱(5)通過螺紋連接安裝在移動(dòng)平臺(tái)車身(6)上表面，前輪轉(zhuǎn)角傳感器(7)安裝在前輪轉(zhuǎn)向軸(9)上以便測(cè)量前輪轉(zhuǎn)向角度，前輪軸(8)焊接在地盤(18)上，前輪連桿(10)通過前輪轉(zhuǎn)向軸(9)和前輪軸(8)連接，確保前輪可繞前輪轉(zhuǎn)向軸(9)轉(zhuǎn)動(dòng)，前輪和前輪連桿(10)通過軸承和螺紋連接，使得前輪可自由轉(zhuǎn)動(dòng)，液壓缸(11)通過螺紋連接安裝在底盤(18)上，液壓缸(11)左右兩端推桿通過前輪轉(zhuǎn)向軸(9)和前輪連桿(10)連接，電磁閥(12)、油箱(16)、和溢流閥(17)通過螺紋連接固定在地盤上，液壓缸(11)、電磁閥(12)、液壓栗(13)、溢流閥(17)和油箱(16)通過油管連接組成轉(zhuǎn)向油路，后輪電機(jī)(15)通過螺紋與底盤連接，后輪安裝在電機(jī)轉(zhuǎn)軸上，角速度傳感器(14)安裝在后輪電機(jī)轉(zhuǎn)軸上測(cè)量電機(jī)輸出轉(zhuǎn)速。2.根據(jù)權(quán)利要求1所述的一種果園組合信息導(dǎo)航移動(dòng)平臺(tái)，其特征在于:以蓄電池(4)為動(dòng)力源，通過后輪電機(jī)(15)驅(qū)動(dòng)移動(dòng)平臺(tái)后輪轉(zhuǎn)動(dòng)，同時(shí)可通過角速度傳感器(14)測(cè)量后輪轉(zhuǎn)速，角速度傳感器(14)、前輪轉(zhuǎn)角傳感器(7)、激光測(cè)距儀(I)和工業(yè)相機(jī)(2)通過RS232和控制箱(5)相連接，控制箱(5)通過RS232和后輪電機(jī)(15)相連接，利用激光測(cè)距儀(I)和工業(yè)相機(jī)(2)獲取周圍環(huán)境信息，通過控制箱(5)根據(jù)周圍環(huán)境信息擬合出導(dǎo)航路徑，并對(duì)電磁閥(12)和后輪電機(jī)(15)發(fā)出控制指令，實(shí)現(xiàn)導(dǎo)航平臺(tái)自主行走。
【專利摘要】本實(shí)用新型解決其技術(shù)問題所采用的技術(shù)方案是一種果園組合信息導(dǎo)航移動(dòng)平臺(tái)，主要包括激光測(cè)距儀、工業(yè)相機(jī)、傳感器安裝架、蓄電池、控制箱、車身、前輪轉(zhuǎn)角傳感器、前輪軸、前輪轉(zhuǎn)向軸、前輪連桿、液壓缸、電磁閥、液壓泵、角速度傳感器、后輪電機(jī)、油箱、溢流閥、底盤。所述激光測(cè)距儀和工業(yè)相機(jī)主要用于獲取周圍環(huán)境信息。所述液壓缸、電磁閥、液壓泵和前輪轉(zhuǎn)角傳感器主要用于控制前輪轉(zhuǎn)向。所述電機(jī)、角速度傳感器主要用于平臺(tái)驅(qū)動(dòng)和速度控制，所述控制箱用于計(jì)算和規(guī)劃導(dǎo)航路徑并發(fā)出導(dǎo)航指令。本實(shí)用新型根據(jù)果園環(huán)境實(shí)現(xiàn)了自動(dòng)導(dǎo)航，并克服了單一傳感器所存在的缺陷，在工作時(shí)可實(shí)現(xiàn)完全自主行走，節(jié)約了勞動(dòng)力，提高了工作效率和作業(yè)質(zhì)量。
【IPC分類】G01C21/00, G05D1/02
【公開號(hào)】CN205229801
【申請(qǐng)?zhí)枴緾N201520977124
【發(fā)明人】陳軍, 聶森
【申請(qǐng)人】西北農(nóng)林科技大學(xué)
【公開日】2016年5月11日
【申請(qǐng)日】2015年11月25日