專利名稱：山地單軌運輸遙控車遙控裝置的制作方法
技術領域：
本發(fā)明涉及一種山地單軌運輸遙控車遙控裝置，以降低勞動強度、提高運輸效率，
確保山地單軌運輸遙控車在無人駕駛的情況下安全、靈活的控制及掌握山地單軌運輸遙控 車的運行情況。
背景技術：
經(jīng)濟林果的種植在山區(qū)經(jīng)濟發(fā)展中占有舉足輕重的地位，而林果采摘及運輸問題 是林果種植中必須要考慮的問題。目前一些地區(qū)還存在的林果運輸技術裝備落后的現(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顯示器、旋轉編碼器檢測 裝置、轉換檢測電路及鑒相電路、5*4鍵盤、障礙物檢測裝置、報警電路、運動控制裝置、GPRS 模塊以及電源電路；所述車載控制儀LCD顯示器顯示所述山地單軌運輸遙控車當前的具體 位置及驅動輪的轉速；所述旋轉編碼器檢測裝置安裝于所述山地單軌運輸遙控車驅動輪 上，所述旋轉編碼器檢測裝置測定所述山地單軌運輸遙控車的轉速及所述山地單軌運輸遙 控車位置及轉向； 所述障礙物檢測裝置采用紅外傳感器獲取山地單軌運輸遙控車運行前方軌道上 的障礙物信息；當檢測到有障礙物時，車載控制儀中障礙物檢測裝置輸出的為高電平，沒有 障礙物的時候，車載控制儀中障礙物檢測裝置輸出的為低電平；山地單軌運輸遙控車車載 控制儀ARM9處理器S3C2410芯片通過障礙物檢測裝置輸入的高低電平的判斷來識別是否 有障礙物。當所述障礙物檢測裝置中的紅外傳感器檢測到有障礙物信號時向車載控制儀的 ARM9處理器S3C2410X芯片輸入高電平發(fā)出中斷請求，車載控制儀的ARM9處理器S3C2410X 芯片進行中斷處理后將所述山地單軌運輸遙控車車載控制儀運動控制裝置中的第一舵機、 所述山地單軌運輸遙控車車載控制儀運動控制裝置中的第二舵機均復位、經(jīng)所述報警電路 輸出報警信號并驅動山地單軌運輸遙控車緊急停車；障礙物排除后障礙物檢測裝置中的紅 外傳感器向車載控制儀的ARM9處理器S3C2410X芯片輸入低電平，車載控制儀的ARM9處理 器S3C2410X芯片進行處理后經(jīng)所述報警電路停止報警并繼續(xù)驅動所述山地單軌運輸遙控 車按照控制指令運行； 所述運動控制裝置控制山地單軌運輸遙控車的運行速度和運行方向，所述山地單軌運輸遙控車由汽油發(fā)動機作為動力源，所述的山地單軌運輸遙控車的運行速度控制是在 運行過程中通過控制汽油發(fā)動機的油門開啟大小程度來輸出不同的功率改變山地單軌運 輸遙控車的運行速度的大??；所述山地單軌運輸遙控車的運行方向是由動力傳動系統(tǒng)中 離合器所處的嚙合位置來控制動力的傳動方向從而改變山地單軌運輸遙控車的運行方向； 所述山地單軌運輸遙控車車載控制儀運動控制裝置中的第一舵機控制動力傳動系統(tǒng)中離 合器，所述山地單軌運輸遙控車車載控制儀運動控制裝置中的第二舵機控制汽油發(fā)動機油 門；所述山地單軌運輸遙控車車載控制儀運動控制裝置中的第一舵機、第二舵機均固定在 所述山地單軌運輸遙控車減速器上；運動控制裝置中的第一舵機的輸出軸上安裝第一機電 接口裝置，運動控制裝置中的第二舵機的輸出軸上安裝第二機電接口裝置，其中所述第一 機電接口裝置和所述第二機電接口裝置結構完全相同，所述第一機電接口裝置、第二機電 接口裝置均包括軸銷、撥桿、撥桿銷、扭簧和承力桿，其中第一機電接口裝置中的軸銷與運 動控制裝置中的第一舵機輸出軸連在一起，第二機電接口裝置中的軸銷與運動控制裝置中 的第二舵機輸出軸連在一起，當運動控制裝置中的第一舵機的輸出軸旋轉時帶動第一機電 接口裝置中的軸銷推動撥桿繞撥桿銷來回擺動，從而通過扭簧使得承力桿也繞撥桿銷來回 擺動，當運動控制裝置中的第二舵機的輸出軸旋轉時帶動第二機電接口裝置中的軸銷推動 撥桿繞撥桿銷來回擺動，從而通過扭簧使得承力桿也繞撥桿銷來回擺動，第一機電接口裝 置的承力桿帶動山地單軌運輸遙控車動力傳動系統(tǒng)中的連桿實現(xiàn)離合器嚙合位置的改變 以改變運行方向，第二機電接口裝置中的承力桿帶動山地單軌運輸遙控車動力傳動系統(tǒng)中 的油門彈簧來實現(xiàn)汽油發(fā)動機油門運行速度的變化； 所述GPRS模塊控制所述車載控制儀、所述手持控制器之間的無線數(shù)據(jù)傳輸；所述 手持控制器包括ARM9處理器S3C2410X芯片、手持控制器LCD顯示器、GPRS模塊、功能鍵盤、 電源電路；所述手持控制器由控制人員在遠距離操作控制，對所述山地單軌運輸遙控車轉 速及位置信息無線實時采集，所述手持控制器LCD顯示器遠距離觀察所述山地單軌運輸遙 控車運行情況并及時發(fā)出控制命令。 其中所述的山地單軌運輸遙控車的運行速度有高速、低速、怠速三種情況。
其中所述的山地單軌運輸遙控車的運行方向有前進、后退、空檔三種情況。
該發(fā)明具有如下控制功能 遠距離遙控山地單軌運輸遙控車沿單軌無人自動運行，包括山地單軌運輸遙控 車的啟動、停止、換檔、制動； 將山地單軌運輸遙控車運行的狀態(tài)，如山地單軌運輸遙控車驅動輪的轉速、山地 單軌運輸遙控車具體運行的位置、山地單軌運輸遙控車運行中的障礙物信息實時發(fā)送到手 持控制器上，并通過手持控制器LCD顯示器遠距離觀察山地單軌運輸遙控車運行情況；
手持控制器攜帶方便，控制者可在地面不同位置對山地單軌運輸遙控車進行控 制，無須固定在地面山地單軌運輸遙控車控制室中，也無須連接Internet網(wǎng)絡。
本發(fā)明的目的是基于山地林果生產(chǎn)的特點，利用該發(fā)明實現(xiàn)山地單軌運輸遙控 車的運動速度和方向的控制，可控制山地單軌運輸遙控車裝載果農(nóng)及果品等物資往返，能 滿足經(jīng)濟林果大規(guī)模生產(chǎn)的需要。


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