專利名稱：山地單軌運輸遙控車遙控裝置的制作方法
技術(shù)領(lǐng)域：
本發(fā)明涉及一種山地單軌運輸遙控車遙控裝置，以降低勞動強度、提高運輸效率，
確保山地單軌運輸遙控車在無人駕駛的情況下安全、靈活的控制及掌握山地單軌運輸遙控 車的運行情況。
背景技術(shù)：
經(jīng)濟林果的種植在山區(qū)經(jīng)濟發(fā)展中占有舉足輕重的地位，而林果采摘及運輸問題 是林果種植中必須要考慮的問題。目前一些地區(qū)還存在的林果運輸技術(shù)裝備落后的現(xiàn)狀， 特別在車輛無法進入的山地果林區(qū)采摘下的果實仍采用的是人工運輸、畜力車運輸、摩托 車運輸或小型農(nóng)用車運輸，這些運輸手段不僅效率低、勞動強度大，而且或多或少都對森林 生態(tài)造成破壞，因此在不破壞自然地理環(huán)境條件下，研制容易架設軌道、不妨礙作物的種植 及生長、不受地形限制的山地單軌運輸遙控車是山區(qū)經(jīng)濟林果運輸方式的發(fā)展趨勢。
發(fā)明內(nèi)容
本發(fā)明設計的山地單軌運輸遙控車遙控裝置包括車載控制儀和手持控制器兩大 部分，所述車載控制儀向所述手持控制器無線發(fā)送山地單軌運輸遙控車的位置、請求運行 及故障信息，接收所述手持控制器發(fā)出的控制數(shù)據(jù)、執(zhí)行所述手持控制器發(fā)送的控制命 令； 所述車載控制儀包括ARM9處理器S3C2410X芯片、車載控制儀LCD顯示器、旋轉(zhuǎn)編 碼器檢測裝置、轉(zhuǎn)換檢測電路及鑒相電路、5*4鍵盤、障礙物檢測裝置、報警電路、運動控制 裝置、GPRS模塊以及電源電路；所述車載控制儀LCD顯示器顯示山地單軌運輸遙控車當前 的具體位置及驅(qū)動輪的轉(zhuǎn)速；所述旋轉(zhuǎn)編碼器檢測裝置安裝于所述山地單軌運輸遙控車驅(qū) 動輪上，所述旋轉(zhuǎn)編碼器檢測裝置測定所述山地單軌運輸遙控車的驅(qū)動輪的轉(zhuǎn)速及所述山 地單軌運輸遙控車位置及轉(zhuǎn)向；所述障礙物檢測裝置檢測所述山地單軌運輸遙控車運行中 前方障礙物的信息，所述車載控制儀的ARM9處理器S3C2410X芯片處理檢測到的所述信息 數(shù)據(jù)，當檢測到的障礙物阻礙山地單軌運輸遙控車正常運行時，經(jīng)所述報警電路報警；所述 運動控制裝置控制所述山地單軌運輸遙控車的運行速度和運行方向，所述山地單軌運輸遙 控車由汽油發(fā)動機作為動力源，所述的山地單軌運輸遙控車的運行速度控制是在運行過程 中通過控制所述汽油發(fā)動機的油門開啟大小程度來輸出不同的功率改變所述山地單軌運 輸遙控車的運行速度的大?。凰錾降貑诬夁\輸遙控車的運行方向是由動力傳動系統(tǒng)中離 合器所處的嚙合位置來控制動力的傳動方向從而改變所述山地單軌運輸遙控車的運行方 向；所述車載控制儀運動控制裝置中的第一舵機控制所述動力傳動系統(tǒng)中離合器，所述車 載控制儀運動控制裝置中的第二舵機控制所述汽油發(fā)動機油門； 所述GPRS模塊控制所述車載控制儀、所述手持控制器之間的無線數(shù)據(jù)傳輸；所述 手持控制器包括ARM9處理器S3C2410X芯片、手持控制器LCD顯示器、GPRS模塊、功能鍵盤、 電源電路；
所述手持控制器由控制人員在遠距離操作控制，對所述山地單軌運輸遙控車驅(qū)動 輪的轉(zhuǎn)速及位置信息無線實時采集，所述手持控制器LCD顯示器遠距離觀察所述山地單軌 運輸遙控車運行情況并及時發(fā)出控制命令。 其中所述車載控制儀具有遙控運行工作模式和車載運行工作模式；在所述遙控運 行工作模式時所述車載控制儀在所述手持控制器控制下完成對所述山地單軌運輸遙控車 驅(qū)動輪轉(zhuǎn)速及位置實時檢測、控制及狀態(tài)顯示；在所述遙控運行工作模式時所述車載控制 儀中的ARM9處理器S3C2410X芯片接收所述GPRS模塊的運動控制指令，通過所述運動控制 裝置輸出所述山地單軌運輸遙控車運動命令；在所述山地單軌運輸遙控車運行過程中通過 所述障礙物檢測裝置中的紅外傳感器自動檢測前方障礙物信息并進行處理、報警并通過所 述GPRS模塊將報警信息發(fā)送至所述手持控制器，在所述手持控制器LCD顯示器上顯示報警 信息；在運行過程中通過所述旋轉(zhuǎn)編碼器檢測裝置及轉(zhuǎn)換檢測電路自動檢測所述山地單軌 運輸遙控車當前的具體位置及驅(qū)動輪的轉(zhuǎn)速，并通過所述GPRS模塊將所述山地單軌運輸 遙控車位置及驅(qū)動輪的轉(zhuǎn)速信息發(fā)送至所述手持控制器，在所述手持控制器LCD顯示器上 顯示所述山地單軌運輸遙控車當前的位置及驅(qū)動輪的轉(zhuǎn)速信息。 其中所述車載運行工作模式，在所述車載運行工作模式時所述車載控制儀獨立完
成對所述山地單軌運輸遙控車驅(qū)動輪轉(zhuǎn)速及位置實時檢測、控制及狀態(tài)顯示；在所述車載
運行工作模式時所述車載控制儀中的ARM9處理器S3C2410X芯片接收所述5*4鍵盤輸入的
運動控制指令，通過所述運動控制裝置輸出所述山地單軌運輸遙控車運動命令；在所述山
地單軌運輸遙控車運行過程中通過所述障礙物檢測裝置中的紅外傳感器自動檢測前方障
礙物信息；通過所述旋轉(zhuǎn)編碼檢測裝置及轉(zhuǎn)換檢測電路自動檢測所述山地單軌運輸遙控車
當前的具體位置及驅(qū)動輪的轉(zhuǎn)速并在所述車載控制儀LCD顯示器上顯示。 其中所述障礙物檢測裝置采用紅外傳感器獲取所述山地單軌運輸遙控車運行前
方軌道上的障礙物信息；當檢測到有障礙物時，所述障礙物檢測裝置輸出的為高電平，沒有
障礙物的時候，所述障礙物檢測裝置輸出為低電平；所述山地單軌運輸遙控車車載控制儀
ARM9處理器S3C2410芯片通過所述障礙物檢測裝置輸入的高低電平的判斷來識別是否有
障礙物。 其中所述障礙物檢測裝置中的紅外傳感器檢測到有障礙物信號時向所述車載控
制儀的ARM9處理器S3C2410X芯片輸入高電平發(fā)出中斷請求，所述車載控制儀的ARM9處理
器S3C2410X芯片進行中斷處理后將所述山地單軌運輸遙控車車載控制儀運動控制裝置中
的第一舵機、所述山地單軌運輸遙控車車載控制儀運動控制裝置中的第二舵機均復位、經(jīng)
所述報警電路輸出報警信號并驅(qū)動所述山地單軌運輸遙控車緊急停車；障礙物排除后所述
障礙物檢測裝置中的紅外傳感器向所述車載控制儀的ARM9處理器S3C2410X芯片輸入低電
平，所述車載控制儀的ARM9處理器S3C2410X芯片進行處理后經(jīng)所述報警電路停止報警并
繼續(xù)驅(qū)動所述山地單軌運輸遙控車按照控制指令運行。其中所述山地單軌運輸遙控車運行在固定的軌道上。 該發(fā)明具有如下控制功能 遠距離遙控山地單軌運輸遙控車沿單軌無人自動運行，包括山地單軌運輸遙控 車的啟動、停止、換檔、制動； 將山地單軌運輸遙控車運行的狀態(tài)，如山地單軌運輸遙控車驅(qū)動輪的轉(zhuǎn)速、山地
5單軌運輸遙控車具體運行的位置、山地單軌運輸遙控車運行中的障礙物信息實時發(fā)送到手
持控制器上，并通過手持控制器LCD顯示器遠距離觀察山地單軌運輸遙控車運行情況； 手持控制器攜帶方便，控制者可在地面不同位置對山地單軌運輸遙控車進行控
制，無須固定在地面山地單軌運輸遙控車控制室中，也無須連接Internet網(wǎng)絡。 本發(fā)明的目的是基于山地林果生產(chǎn)的特點，實現(xiàn)在運行過程中對前方軌道上存
在障礙物時的避障控制，利用該發(fā)明可控制山地單軌運輸遙控車裝載果農(nóng)及果品等物資往
返，能滿足經(jīng)濟林果大規(guī)模生產(chǎn)的需要。
附圖l:附圖2:附圖3:附圖4:附圖5:附圖6:附圖7:附圖8:附圖9:附圖10附圖11附圖12
山地單軌運輸遙控車遙控裝置系統(tǒng)總體架構(gòu)圖山地單軌運輸遙控車遙控裝置車載控制儀結(jié)構(gòu)框圖山地單軌運輸遙控車遙控裝置手持控制器結(jié)構(gòu)框圖山地單軌運輸遙控車遙控裝置測速裝置連接圖山地單軌運輸遙控車遙控裝置脈沖數(shù)據(jù)計算框圖山地單軌運輸遙控車遙控裝置轉(zhuǎn)速、位置計算框圖山地單軌運輸遙控車遙控裝置無線數(shù)據(jù)傳輸框圖山地單軌運輸遙控車遙控裝置運動控制裝置連接圖山地單軌運輸遙控車遙控裝置舵機輸出軸機電接口裝置圖
:山地單軌運輸遙控車遙控裝置故障處理框圖:山地單軌運輸遙控車遙控裝置緊急停車控制電路圖
具體實施例方式
—種山地單軌運輸遙控車，該山地單軌運輸遙控車能在無人駕駛的情況下安全、靈活地控制并讓使用者掌握山地單軌運輸遙控車具體的運行情況。山地單軌運輸遙控車包括發(fā)動機、動力傳動系統(tǒng)和山地單軌運輸遙控車遙控裝置，其中山地單軌運輸遙控車遙控裝置包括車載控制儀和手持控制器。下面針對山地單軌運輸遙控車遙控裝置的控制具體說明，如附圖1所示，山地運輸遙控車遙控裝置包括車載控制儀和手持控制器兩大部分。
車載控制儀是一個小型ARM (Advanced RISC Machines,即高性能RISC處理器)嵌入式系統(tǒng)，安裝于山地單軌運輸遙控車上，完成對山地單軌運輸遙控車驅(qū)動輪的轉(zhuǎn)速及山地單軌運輸遙控車位置信息實時檢測、山地單軌運輸遙控車運行中障礙物檢測、通過GPRS模塊向手持控制器無線發(fā)送山地單軌運輸遙控車的位置、請求運行及故障信息、接收手持控制器發(fā)出的控制數(shù)據(jù)、執(zhí)行手持控制器發(fā)送的控制命令、分別在車載控制儀及手持控制器的LCD顯示器上顯示山地單軌運輸遙控車當前的具體位置及驅(qū)動輪的轉(zhuǎn)速，既可在車載控制儀的LCD顯示器上近距離的觀察山地單軌運輸遙控車運行情況也可通過手持控制器的LCD顯示器遠距離觀察山地單軌運輸遙控車的運行情況。 如附圖2所示，山地單軌運輸遙控車遙控裝置車載控制儀包括ARM9處理器S3C2410X芯片、LCD顯示器、旋轉(zhuǎn)編碼器檢測裝置、轉(zhuǎn)換檢測電路及鑒相電路、5*4鍵盤、障礙物檢測裝置、報警電路、運動控制裝置、GPRS模塊以及電源電路。
車載控制儀具有遙控運行和車載運行兩種工作模式，在遙控運行工作模式時車載控制儀在手持控制器控制下完成對山地單軌運輸遙控車驅(qū)動輪轉(zhuǎn)速及位置實時檢測、控制及狀態(tài)顯示；在遙控運行工作模式時車載控制儀中的ARM9處理芯片接收GPRS模塊的運動控制指令，通過運動控制裝置輸出山地單軌運輸遙控車運動命令；在山地單軌運輸遙控車運行過程中通過障礙物檢測裝置自動檢測前方障礙物信息并進行處理、報警并通過GPRS模塊將報警信息發(fā)送至手持控制器，在手持控制器LCD顯示器上顯示報警信息；在運行過程中通過旋轉(zhuǎn)編碼器檢測裝置及轉(zhuǎn)換檢測電路自動檢測山地單軌運輸遙控車當前的具體位置及驅(qū)動輪的轉(zhuǎn)速，并通過GPRS模塊將山地單軌運輸遙控車位置及驅(qū)動輪的轉(zhuǎn)速信息發(fā)送至手持控制器，在手持控制器LCD顯示器上顯示山地單軌運輸遙控車當前的位置及驅(qū)動輪的轉(zhuǎn)速信息。在車載運行工作模式時車載控制儀可獨立完成對山地單軌運輸遙控車驅(qū)動輪轉(zhuǎn)速及位置實時檢測、控制及狀態(tài)顯示；在車載運行工作模式時車載控制儀中的ARM9處理器S3C2410X芯片接收5*4鍵盤輸入的運動控制指令，通過運動控制裝置輸出山地單軌運輸遙控車運動命令；在山地單軌運輸遙控車運行過程中通過障礙物檢測裝置自動檢測前方障礙物信息并進行處理及報警；在運行過程中通過旋轉(zhuǎn)編碼器檢測裝置及轉(zhuǎn)換檢測電路
自動檢測山地單軌運輸遙控車當前的具體位置及驅(qū)動輪的轉(zhuǎn)速并在車載控制儀LCD顯示器上顯示。 手持控制器是一個小型ARM嵌入式系統(tǒng)，由控制人員在遠距離如林果卸貨點、地面控制室等地操作控制，完成對山地單軌運輸遙控車驅(qū)動輪轉(zhuǎn)速及位置信息無線實時采集、通過LCD顯示器遠距離觀察山地單軌運輸遙控車運行情況并及時發(fā)出控制命令。如圖3所示，手持控制器包括ARM9處理器S3C2410X芯片、LCD顯示器、GPRS模塊、功能鍵盤、電源電路。在山地單軌運輸遙控車遙控運行工作模式時手持控制器通過GPRS模塊接收車載控制儀的運行請求信息、發(fā)送運動控制命令；在山地單軌運輸遙控車運行過程中接收車載控制儀檢測到的驅(qū)動輪速度、位置及故障信息，并在LCD顯示器上顯示故障報警信息及山地單軌運輸遙控車當前的位置及驅(qū)動輪的轉(zhuǎn)速信息。
山地單軌運輸遙控車遙控裝置定位、測速裝置 山地單軌運輸遙控車遙控裝置定位、測速裝置包括旋轉(zhuǎn)編碼器檢測裝置、轉(zhuǎn)換檢測電路、鑒相電路、ARM9處理芯片。 旋轉(zhuǎn)編碼器檢測裝置，這里我們選用HMR-10G系列的旋轉(zhuǎn)編碼器，響應頻率能達到100KHz， 1024脈沖/每轉(zhuǎn)，電源電壓為10V-30V。將旋轉(zhuǎn)編碼器檢測裝置安裝于山地單軌運輸遙控車的驅(qū)動輪上，由于旋轉(zhuǎn)編碼器光柵碼盤與驅(qū)動輪同軸，光柵碼盤與山地單軌運輸遙控車驅(qū)動輪同速旋轉(zhuǎn)，經(jīng)旋轉(zhuǎn)編碼器內(nèi)部檢測裝置檢測輸出若干脈沖信號，通過檢測到的脈沖個數(shù)結(jié)合車上的一些原始參數(shù)如驅(qū)動輪半徑、車前進或倒退的方向等可計算出車的位置、轉(zhuǎn)速及轉(zhuǎn)向。 車載控制儀使用的ARM9處理器芯片主板輸入電壓5V，經(jīng)電壓穩(wěn)壓進入I/O端口要求電壓為3. 3V。根據(jù)旋轉(zhuǎn)編碼器檢測裝置電源電壓要求在10V-30V之間，該旋轉(zhuǎn)編碼器檢測裝置使用電源為12V，其輸出脈沖幅值為12V，而車載控制儀中ARM9處理器芯片允許輸入的脈沖幅值為3. 3V，故外圍硬件電路還需要一個轉(zhuǎn)換檢測電路。如附圖4所示，A、B為旋轉(zhuǎn)編碼器檢測裝置輸出的脈沖序列，脈沖幅值為12V;A' 、B'為經(jīng)轉(zhuǎn)換檢測電路電平轉(zhuǎn)換后的脈沖序列，脈沖幅值為3. 3V ;該旋轉(zhuǎn)編碼器檢測裝置有A、B兩路脈沖輸出信號，經(jīng)轉(zhuǎn)換檢
7測電路得到A' 、B'脈沖信號，A' 、B'脈沖信號相位相差90。，當山地單軌運輸遙控車前進時，旋轉(zhuǎn)編碼器檢測裝置順時針旋轉(zhuǎn)時，A'輸出波形超前B'輸出波形9(T ;當山地單軌運輸遙控車后退時，旋轉(zhuǎn)編碼器檢測裝置逆時針旋轉(zhuǎn)時，A'輸出波形比B'輸出波形滯后90° 。如附圖4所示的鑒相電路，A' 、B'脈沖信號輸入到鑒相電路，C為鑒相電路的輸出信號，與ARM9處理器芯片相連；附圖4中C輸出是一個電平信號，當C輸出為"l"時表示山地單軌運輸遙控車前進，C輸出為"O"時表示山地單軌運輸遙控車后退。根據(jù)A' 、B'兩路脈沖的超前滯后情況即可判斷出山地單軌運輸遙控車前進與后退的方向。
旋轉(zhuǎn)編碼器檢測裝置輸出脈沖的個數(shù)送入ARM9處理器，程序計算出當前車的轉(zhuǎn)速。 如果在T時間內(nèi)，測量出旋轉(zhuǎn)編碼器檢測裝置的輸出脈沖數(shù)為M，山地單軌運輸遙控車驅(qū)動輪半徑為R，旋轉(zhuǎn)編碼器檢測裝置每轉(zhuǎn)輸出脈沖數(shù)為N，驅(qū)動輪的速度用V表示 <formula>formula see original document page 8</formula>
碼器檢鄰S為
如果把旋轉(zhuǎn)編碼器檢測裝置從山地單軌運輸遙控車運動開始到時間T內(nèi)旋轉(zhuǎn)編U裝置輸出的脈沖個數(shù)用G表示，則在時間T內(nèi)山地單軌運輸遙控車所走過的距離
<formula>formula see original document page 8</formula> 在用上述二公式對山地單軌運輸遙控車的位置、驅(qū)動輪速度計算時還要考慮山地
單軌運輸遙控車中途停止、往復運動、驅(qū)動輪轉(zhuǎn)動不到一周的情況，若山地單軌運輸遙控車
中途停止，在T時間內(nèi)計得脈沖數(shù)為O，可判斷出車速為0 ;若山地單軌運輸遙控車往復運
動，可根據(jù)山地單軌運輸遙控車前進和后退分別計得的脈沖數(shù)，計算出單向運動的脈沖差
值，再計算出山地單軌運輸遙控車的位置；若驅(qū)動輪轉(zhuǎn)動不到一周，計算出山地單軌運輸遙
控車驅(qū)動輪轉(zhuǎn)動不到一周計得的脈沖數(shù)與驅(qū)動輪轉(zhuǎn)動一周的脈沖數(shù)的比值，根據(jù)此比值及
驅(qū)動輪的周長，算出驅(qū)動輪轉(zhuǎn)動不到一周所走的距離，實現(xiàn)精確定位。
山地單軌運輸遙控車遙控裝置定位、測速方法 第一步驟是山地單軌運輸遙控車脈沖數(shù)據(jù)計算 對旋轉(zhuǎn)編碼器檢測裝置脈沖數(shù)據(jù)采集在車載控制儀中是采用中斷方式完成的，選擇外部中斷EXTINTO和EXTINTll。如附圖5所示，中斷的產(chǎn)生分別來自旋轉(zhuǎn)編碼器檢測裝置經(jīng)轉(zhuǎn)換檢測電路后的A'脈沖和判向脈沖C。當C脈沖的電平由低變高時，表示山地單軌運輸遙控車運行方向為前進，CPU命令中斷EXINTO正向計數(shù)，正向脈沖值p開始計數(shù)，當脈沖數(shù)大于等于一個周期(1024個脈沖)時，正向圈數(shù)h加l，正向脈沖值清零重新計數(shù)；當C脈沖的電平由高變低時，表示山地單軌運輸遙控車運行方向為后退，反向脈沖值antip開始計數(shù)，當脈沖數(shù)大于等于一個周期( 個脈沖)時，反向圈數(shù)antih加l，反向脈沖值清零重新計數(shù)。 第二步驟是山地單軌運輸遙控車轉(zhuǎn)速、位置計算 如附圖6所示，對旋轉(zhuǎn)編碼器檢測裝置脈沖數(shù)據(jù)采集有兩種方式一種是車從始端開始行進時就計數(shù)，脈沖數(shù)用G表示；另一種方式是當需要測速時，在T時間內(nèi)，測量出旋轉(zhuǎn)編碼器檢測裝置的輸出脈沖數(shù)用M表示。完成旋轉(zhuǎn)編碼器檢測裝置脈沖數(shù)據(jù)采集后，再提取出驅(qū)動輪半徑R及旋轉(zhuǎn)編碼器每轉(zhuǎn)輸出脈沖數(shù)N，根據(jù)式(1)、 (2)對山地單軌運輸遙控車的驅(qū)動輪轉(zhuǎn)速V、位置S進行計算。還要對小車中途停止、往復運動、驅(qū)動輪轉(zhuǎn)動不到一
周等特殊情況進行修正，以得到較精確的山地單軌運輸遙控車的驅(qū)動輪轉(zhuǎn)速與位置值。
山地單軌運輸遙控車遙控裝置無線遙控方法 山地單軌運輸遙控車遙控裝置無線遙控采用GPRS模塊控制車載控制儀、手持控制器之間的無線數(shù)據(jù)傳輸，采用CENTEL公司推出的PIML-900/1800型GPRS模塊。如附圖7所示，GPRS模塊與ARM9處理器S3C2410芯片的UART0進行通訊，通過該串口發(fā)送AT命令到GPRS模塊并獲取GPRS模塊的輸入。由于模塊波特率為9600bit/s，程序中先設置波特率為9600bit/s。首先，系統(tǒng)和GPRS模塊初始化，然后GPRS模塊可以發(fā)送和接受短信息。發(fā)送短信息之前，先發(fā)送AT指令與模塊連接，當返回OK，表示通信正常，此時可發(fā)送AT+CMGS指令以及消息內(nèi)容到指定手機號，以Ctrl+Z結(jié)束。若返回Error,則表示模塊基本通信出現(xiàn)問題，繼續(xù)發(fā)送AT指令與GPRS模塊連接。當有新信息提示時，可發(fā)送AT+CMGR二 〈index〉，對短消息內(nèi)容進行判斷分析。 山地單軌運輸遙控車遙控裝置運動控制裝置 所述山地單軌運輸遙控車遙控裝置運動控制是控制山地單軌運輸遙控車的運行速度和運行方向。 如附圖8所示，山地單軌運輸遙控車由汽油發(fā)動機作為動力源，所述的山地單軌運輸遙控車的運行速度控制是在運行過程中通過控制汽油發(fā)動機的油門開啟大小來輸出不同的功率，從而改變山地單軌運輸遙控車的運行速度的大小。當加大油門即增加功率時山地單軌運輸遙控車高速運行；當減小油門即減少功率時山地單軌運輸遙控車低速運行；當油門處于最小的位置時山地單軌運輸遙控車怠速。因此對于山地單軌運輸遙控車的運行速度控制而言，要滿足三個動作要求，即高速、低速、怠速的控制來控制汽油機油門開啟大小程度。 山地單軌運輸遙控車的運行方向是根據(jù)動力傳動系統(tǒng)中離合器所處的嚙合位置來控制動力的傳動方向從而改變山地單軌運輸遙控車的運行方向，即使得山地單軌運輸遙控車由前進方向轉(zhuǎn)變成后退方向或者是脫離動力處于空檔狀態(tài)。因此對于山地單軌運輸遙控車的運行方向控制而言，也要滿足三個動作要求，即前進、后退、空檔的控制來控制山地單軌運輸遙控車動力傳動系統(tǒng)中離合器的嚙合位置。 可見山地單軌運輸遙控車在工作過程中不同工作狀態(tài)之間的轉(zhuǎn)換是通過對動力傳動系統(tǒng)中離合器的三個嚙合位置的控制和對汽油發(fā)動機油門三種開啟大小程度的控制來實現(xiàn)的，所以在設計山地單軌運輸遙控車的車載控制儀時只要對這六個動作進行控制，便可滿足山地單軌運輸遙控車運動控制的要求。所發(fā)明的山地單軌運輸遙控車車載控制儀運動控制裝置中的第一舵機控制動力傳動系統(tǒng)中離合器的嚙合位置，運動控制裝置中的第二舵機來控制汽油發(fā)動機油門開啟大小程度，使得方向控制信號和速度控制信號相互獨 山地單軌運輸遙控車車載控制儀運動控制裝置中的第一舵機、第二舵機均固定在山地單軌運輸遙控車上，運動控制裝置中的第一舵機的輸出軸上安裝有第一機電接口裝置，運動控制裝置中的第二舵機的輸出軸上安裝有第二機電接口裝置，其中第一機電接口裝置和第二機電接口裝置結(jié)構(gòu)完全相同，因此第一機電接口裝置、第二機電接口裝置相同部件采用同一附圖標記，如附圖9所示，機電接口裝置包括軸銷a、撥桿b、撥桿銷c、扭簧d
9和承力桿e，其中軸銷a和每臺舵機輸出軸連在一起，當舵機的輸出軸旋轉(zhuǎn)時帶動機電接口裝置中的軸銷a推動撥桿b繞撥桿銷c來回擺動，從而通過扭簧d使得承力桿e也繞撥桿銷c來回擺動，第一機電接口裝置的承力桿e帶動山地單軌運輸遙控車動力傳動系統(tǒng)中的連桿實現(xiàn)離合器三個嚙合位置的改變，第二機電接口裝置中的承力桿e帶動山地單軌運輸遙控車動力傳動系統(tǒng)中的油門彈簧來實現(xiàn)汽油發(fā)動機油門三種開啟大小程度的變換，從而完成山地單軌運輸遙控車運動控制的要求。
山地單軌運輸遙控車遙控裝置運動控制方法 山地單軌運輸遙控車的運動控制分為遙控運行工作模式和車載運行工作模式。在遙控運行工作模式下車載控制儀通過GPRS模塊無線接收手持控制器發(fā)送的運動控制信號并實時控制運動控制裝置中第一舵機和第二舵機的旋轉(zhuǎn)方向和旋轉(zhuǎn)角度，從而控制山地單軌運輸遙控車的運行方向和運行速度；在車載運行工作模式下由操作人員操作車載控制儀控制面板的5*4鍵盤輸入運動控制命令來控制運動控制裝置中第一舵機和第二舵機的旋轉(zhuǎn)方向和旋轉(zhuǎn)角度，無線控制信號此時失效。 山地單軌運輸遙控車車載控制儀通過控制運動控制裝置中第一舵機和第二舵機輸出軸旋轉(zhuǎn)不同的角度來實現(xiàn)離合器嚙合位置或汽油機油門開啟大小不同工作狀態(tài)之間的切換。運動控制裝置中第一舵機和第二舵機控制線的輸入是一個寬度可調(diào)的周期性方波脈沖信號，方波脈沖信號的周期為20ms(即頻率為50Hz)。當方波的脈沖寬度改變時，運動控制裝置中第一舵機和第二舵機輸出軸的角度發(fā)生改變，輸出軸角度變化與脈沖寬度的變化成正比。在控制過程中，通過山地單軌運輸遙控車車載控制儀ARM9處理器S3C2410芯片的P0RT B0(T0UT0)和PORT B1(T0UT1)產(chǎn)生不同寬度的P麗波驅(qū)動運動控制裝置中第一舵機和第二舵機轉(zhuǎn)至相應的角度。運動控制裝置中第一舵機和第二舵機剛開始工作(即系統(tǒng)上電時)時處于初始狀態(tài)即第一舵機處于空檔位置和第二舵機處于怠速位置，而且當檢測到障礙物或切斷車載控制儀控制電源時，運動控制裝置中第一舵機和第二舵機無論正處于何種工作位置，都必須先復位即第一舵機自動回到空檔位置、第二舵機自動回到怠速位置。
山地單軌運輸遙控車車載控制儀控制山地單軌運輸遙控車運行在固定的軌道上，所述車載控制儀中障礙物檢測裝置可以將獲得的軌道上障礙物存在性的信息輸入到車載控制儀ARM9處理器S3C2410芯片，由車載控制儀ARM9處理器S3C2410芯片控制軟件做出相應的故障處理決策。所述車載控制儀中障礙物檢測裝置采用紅外傳感器獲取山地單軌運輸遙控車運行前方軌道上的障礙物信息，當有障礙物的時候，車載控制儀中障礙物檢測裝置輸出的為高電平，沒有障礙物的時候，車載控制儀中障礙物檢測裝置輸出的為低電平。山地單軌運輸遙控車車載控制儀ARM9處理器S3C2410芯片通過障礙物檢測裝置輸入的高低電平的判斷來識別是否有障礙物。所述車載控制儀中障礙物檢測裝置中紅外傳感器檢測到的障礙物信號輸入ARM9處理器S3C2410X芯片的外部中斷EXTINT1后產(chǎn)生中斷控制。如附圖10所示，當所述車載控制儀的ARM9處理器S3C2410X芯片的EXTINT1輸入為高電平時，向車載控制儀的ARM9處理器S3C2410X處理器發(fā)出中斷請求，車載控制儀控制系統(tǒng)進入故障處理中斷子程序，車載控制儀的ARM9處理器S3C2410X芯片將運動控制裝置中第一舵機和第二舵機復位、經(jīng)所述報警電路輸出報警信號并驅(qū)動山地單軌運輸遙控車緊急停車，等待障礙物排除后即車載控制儀的ARM9處理器S3C2410X芯片的EXTINT1輸入為低電平時經(jīng)所述報警電路停止報警，系統(tǒng)返回控制主程序控制運動控制裝置中第一舵機和第二舵機按照相應的控制指令進行山地單軌運輸遙控車的運行。 山地單軌運輸遙控車緊急停車控制電路如附圖11所示，當山地單軌運輸遙控車檢測到障礙物存在時，車載控制儀將運動控制裝置中第一舵機和第二舵機復位至初始狀態(tài)的同時并熄滅汽油發(fā)動機來緊急停車，圖11中繼電器J的一個常閉觸點并聯(lián)在點火線圈兩端，當有障礙物時車載控制儀控制器ARM9處理器芯片輸出緊急停車信號JT，該信號反相后與晶體管N9013來控制繼電器J線圈電壓。當產(chǎn)生緊急停車信號時JT為高電平則晶體管N9013截止，繼電器J的線圈失電，其常閉觸點將點火線圈短路，汽油發(fā)動機熄火。當沒有產(chǎn)生緊急停車信號時JT為低電平則晶體管N9013飽和導通，繼電器J的線圈得電，其常閉觸點斷開未將點火線圈短路，汽油發(fā)動機能正常點火啟動。 如附圖12所示，系統(tǒng)初始化后首先開故障處理中斷，接著判斷車載控制儀的工作模式，在車載運行工作模式下車載控制儀根據(jù)5*4鍵盤輸入的控制命令控制運動控制裝置中第一舵機和第二舵機；在遙控運行工作模式下車載控制儀初始化GPRS模塊后首先向手持控制器發(fā)送準備好信息，然后接收手持控制器發(fā)送的控制命令控制運動控制裝置中第一舵機和第二舵機。
技術(shù)效果 本發(fā)明通過ARM9嵌入式控制系統(tǒng)和GPRS無線通訊技術(shù)來實現(xiàn)經(jīng)濟林果山地單軌運輸遙控車的控制，可完成山地單軌運輸遙控車驅(qū)動輪轉(zhuǎn)速及位置信息實時檢測、運行中障礙物檢測、無線發(fā)送/接收數(shù)據(jù)并顯示、山地單軌運輸遙控車的運動控制。該發(fā)明可以有效提高經(jīng)濟林果運輸系統(tǒng)的自動化程度、大大降低工人的勞動強度，從而大幅度提高生產(chǎn)率。該控制方法亦可適用于其它各種林區(qū)單軌運輸車的遠距離控制，例如單軌觀光旅游車、農(nóng)藥或化肥運輸車等的控制。
1權(quán)利要求
一種山地單軌運輸遙控車遙控裝置，其特征在于所述山地單軌運輸遙控車遙控裝置包括車載控制儀和手持控制器兩大部分；所述車載控制儀向所述手持控制器無線發(fā)送山地單軌運輸遙控車的位置、請求運行及故障信息，接收所述手持控制器發(fā)出的控制數(shù)據(jù)、執(zhí)行所述手持控制器發(fā)送的控制命令；所述車載控制儀包括ARM9處理器S3C2410X芯片、車載控制儀LCD顯示器、旋轉(zhuǎn)編碼器檢測裝置、轉(zhuǎn)換檢測電路及鑒相電路、5*4鍵盤、障礙物檢測裝置、報警電路、運動控制裝置、GPRS模塊以及電源電路；所述車載控制儀LCD顯示器顯示山地單軌運輸遙控車當前的具體位置及驅(qū)動輪的轉(zhuǎn)速；所述旋轉(zhuǎn)編碼器檢測裝置安裝于所述山地單軌運輸遙控車驅(qū)動輪上，所述旋轉(zhuǎn)編碼器檢測裝置測定所述山地單軌運輸遙控車驅(qū)動輪的轉(zhuǎn)速及所述山地單軌運輸遙控車位置及轉(zhuǎn)向；所述障礙物檢測裝置檢測所述山地單軌運輸遙控車運行中前方障礙物的信息，所述車載控制儀的ARM9處理器S3C2410X芯片處理檢測到的所述信息數(shù)據(jù)，當檢測到的障礙物阻礙所述山地單軌運輸遙控車正常運行時，經(jīng)所述報警電路報警；所述運動控制裝置控制所述山地單軌運輸遙控車的運行速度和運行方向，所述山地單軌運輸遙控車由汽油發(fā)動機作為動力源，所述的山地單軌運輸遙控車的運行速度控制是在運行過程中通過控制所述汽油發(fā)動機的油門開啟大小來輸出不同的功率改變所述山地單軌運輸遙控車的運行速度的大??；所述山地單軌運輸遙控車的運行方向是由動力傳動系統(tǒng)中離合器所處的嚙合位置來控制動力的傳動方向從而改變所述山地單軌運輸遙控車的運行方向；所述車載控制儀運動控制裝置中的第一舵機控制所述動力傳動系統(tǒng)中離合器，所述車載控制儀運動控制裝置中的第二舵機控制所述汽油發(fā)動機油門；所述GPRS模塊控制所述車載控制儀、所述手持控制器之間的無線數(shù)據(jù)傳輸；所述手持控制器包括ARM9處理器S3C2410X芯片、手持控制器LCD顯示器、GPRS模塊、功能鍵盤、電源電路；所述手持控制器由控制人員在遠距離操作控制，對所述山地單軌運輸遙控車驅(qū)動輪轉(zhuǎn)速及位置信息無線實時采集，所述手持控制器LCD顯示器遠距離觀察所述山地單軌運輸遙控車運行情況并及時發(fā)出控制命令。
2. 根據(jù)權(quán)利要求1所述的山地單軌運輸遙控車遙控裝置，其中所述車載控制儀具有遙 控運行工作模式和車載運行工作模式；在所述遙控運行工作模式時所述車載控制儀在所述 手持控制器控制下完成對所述山地單軌運輸遙控車驅(qū)動輪轉(zhuǎn)速及位置實時檢測、控制及狀 態(tài)顯示；在所述遙控運行工作模式時所述車載控制儀中的ARM9處理器S3C2410X芯片接收 所述GPRS模塊的運動控制指令，通過所述運動控制裝置輸出所述山地單軌運輸遙控車運 動命令；在所述山地單軌運輸遙控車運行過程中通過所述障礙物檢測裝置中的紅外傳感器 自動檢測前方障礙物信息并進行處理、報警并通過所述GPRS模塊將報警信息發(fā)送至所述 手持控制器，在所述手持控制器LCD顯示器上顯示報警信息；在運行過程中通過所述旋轉(zhuǎn) 編碼器檢測裝置及轉(zhuǎn)換檢測電路自動檢測所述山地單軌運輸遙控車當前的具體位置及驅(qū) 動輪的轉(zhuǎn)速，并通過所述GPRS模塊將所述山地單軌運輸遙控車位置及驅(qū)動輪的轉(zhuǎn)速信息 發(fā)送至所述手持控制器，在所述手持控制器LCD顯示器上顯示所述山地單軌運輸遙控車當前的位置及驅(qū)動輪的轉(zhuǎn)速信息。
3. 根據(jù)權(quán)利要求2所述的山地單軌運輸遙控車遙控裝置，其中所述車載運行工作模 式，在所述車載運行工作模式時所述車載控制儀獨立完成對所述山地單軌運輸遙控車驅(qū)動 輪轉(zhuǎn)速及位置實時檢測、控制及狀態(tài)顯示；在所述車載運行工作模式時所述車載控制儀中 的ARM9處理器S3C2410X芯片接收所述5*4鍵盤輸入的運動控制指令，通過所述運動控制 裝置輸出所述山地單軌運輸遙控車運動命令；在所述山地單軌運輸遙控車運行過程中通過 所述障礙物檢測裝置中的紅外傳感器自動檢測前方障礙物信息；通過所述旋轉(zhuǎn)編碼檢測裝 置及轉(zhuǎn)換檢測電路自動檢測所述山地單軌運輸遙控車當前的具體位置及驅(qū)動輪的轉(zhuǎn)速并 在所述車載控制儀LCD顯示器上顯示。
4. 根據(jù)權(quán)利要求2或3所述的山地單軌運輸遙控車遙控裝置，其中所述障礙物檢測裝 置采用紅外傳感器獲取所述山地單軌運輸遙控車運行前方軌道上的障礙物信息；當有障礙 物的時候，所述障礙物檢測裝置輸出的為高電平，沒有障礙物的時候，所述障礙物檢測裝置 輸出的為低電平；所述山地單軌運輸遙控車車載控制儀ARM9處理器S3C2410芯片通過所述 障礙物檢測裝置輸入的高低電平的判斷來識別是否有障礙物。
5. 根據(jù)權(quán)利要求4所述的山地單軌運輸遙控車遙控裝置，所述障礙物檢測裝置中紅外 傳感器檢測到有障礙物信號時向所述車載控制儀的ARM9處理器S3C2410X芯片輸入高電平 發(fā)出中斷請求，所述車載控制儀的ARM9處理器S3C2410X芯片進行中斷處理后將所述山地 單軌運輸遙控車車載控制儀運動控制裝置中的第一舵機、所述山地單軌運輸遙控車車載控 制儀運動控制裝置中的第二舵機均復位、經(jīng)所述報警電路輸出報警信號并控制所述山地單 軌運輸遙控車緊急停車；障礙物排除后所述障礙物檢測裝置中的紅外傳感器向所述車載控 制儀的ARM9處理器S3C2410X芯片輸入低電平，所述車載控制儀的ARM9處理器S3C2410X 芯片進行處理后經(jīng)所述報警電路停止報警并繼續(xù)驅(qū)動所述山地單軌運輸遙控車按照控制 指令運行。
6. 根據(jù)權(quán)利要求4所述的山地單軌運輸遙控車遙控裝置，所述山地單軌運輸遙控車運 行在固定的軌道上。
全文摘要
一種山地單軌運輸遙控車遙控裝置，在無人駕駛的情況下安全、靈活地控制并掌握山地單軌運輸遙控車具體的運行情況，該山地單軌運輸遙控車遙控裝置包括車載控制儀和手持控制器兩大部分；車載控制儀向手持控制器無線發(fā)送山地單軌運輸遙控車的位置、請求運行及故障信息，接收手持控制器發(fā)出的控制數(shù)據(jù)、執(zhí)行手持控制器發(fā)送的控制命令；手持控制器由控制人員在遠距離操作控制，對山地單軌運輸遙控車轉(zhuǎn)速及位置信息無線實時采集。
文檔編號G08C17/02GK101774382SQ20101010802
公開日2010年7月14日 申請日期2010年2月10日 優(yōu)先權(quán)日2010年2月10日
發(fā)明者姚立紅, 張俊梅, 李文彬, 楊柳, 楊鍇, 薛慧霞, 高林 申請人:北京林業(yè)大學