TWI725684B - 基於光源偵測之自走車編隊控制系統 - Google Patents
基於光源偵測之自走車編隊控制系統 Download PDFInfo
- Publication number
- TWI725684B TWI725684B TW108147804A TW108147804A TWI725684B TW I725684 B TWI725684 B TW I725684B TW 108147804 A TW108147804 A TW 108147804A TW 108147804 A TW108147804 A TW 108147804A TW I725684 B TWI725684 B TW I725684B
- Authority
- TW
- Taiwan
- Prior art keywords
- light source
- following
- car body
- leader
- processing module
- Prior art date
Links
Images
Landscapes
- Optical Radar Systems And Details Thereof (AREA)
Abstract
本發明提供一種基於光源偵測之自走車編隊控制系統，其係透過一領導車體周邊上的一定位光源模組提供一光源，且由跟隨該領導車體的一跟隨車體周邊上的一光源感測模組接收該光源而產生一電壓值變化，使得該跟隨車體內的一跟隨處理模組讀取且計算該電壓值變化，以判斷該跟隨車體跟隨該領導車體的跟隨狀態，且依據所述跟隨狀態控制該跟隨驅動系統調整該跟隨車體的移動方式，藉此，判斷跟隨車體的跟隨狀態，且當跟隨車體與領導車體之間的角度或距離出現偏移或偏差時，可即時調整該跟隨車體的移動方式。
Description
本發明係提供一種基於光源偵測之自走車編隊控制系統，尤指一種利用光源感測模組接收光源，且依據光源感測模組的電壓值變化判斷領導車體與跟隨車體之間的跟隨狀態之自走車編隊控制系統。
隨著工業技術的快速發展，近年來，機器人應用的範圍也越趨廣泛，例如應用於軍事任務、運輸任務、救援任務或未知環境探勘。現今，機器人已經成為人們生活中不可或缺的對象，而在眾多種類的機器人中，以輪型機器人或稱自走車最為常見，其特性是易控制、機動性高及價格便宜。
目前國內外的研究以多機器人系統為研究重點，其相較於單一機器人，多機器人協調合作的優點是可以完成單一機器人難以完成的任務，提高任務效率及透過個體間資訊的傳遞減少感測器的使用等優點，但在編隊上，則是多機器人協同合作的一個典型問題，所謂的編隊控制是指多個機器人在達到目的的過程中，保持某種隊形的同時又要適應環境因素約束的重要控制技術。
如此，如何有效地同時操控多台自走車，以合作搬運大型貨物和軍事任務探勘等合作任務，即是現今必須解決的問題。
為解決前揭之問題，本發明之目的在於提供一種基於光源偵
測之自走車編隊控制系統，其係利用領導車體上的定位光源模組提供一光源，再利用跟隨該領導車體的跟隨車體上的光源感測模組接收該光源且產生一電壓值變化，進而利用跟隨處理模組讀取且計算電壓值變化，以判斷跟隨車體跟隨領導車體的跟隨狀態，且依據所述跟隨狀態控制該跟隨驅動系統調整該跟隨車體的移動方式，進以解決先前技術之問題。
為達上述之目的者，本發明係提供一種基於光源偵測之自走車編隊控制系統，其包括：一領導車體，其被設置以領導至少一跟隨車體，該領導車體包括：一領導驅動系統，其被設置於該領導車體內，控制該領導車體的移動方式；一領導處理電路，其被設置於該領導車體內；一領導處理模組，其被設置於該領導處理電路上，且與該領導驅動系統相連接；一定位光源模組，其被設置於該領導車體的周邊上，且與該領導處理模組相連接，該定位光源模組提供一光源至該跟隨車體上的一光源感測模組；其中，當該光源感測模組接收到該光源時，該光源感測模組會產生一電壓值變化，使得該跟隨車體內的一跟隨處理模組讀取且計算該電壓值變化，以判斷該跟隨車體跟隨該領導車體的跟隨狀態，且依據所述跟隨狀態控制該跟隨驅動系統調整該跟隨車體的移動方式。
較佳地，該定位光源模組係包括複數光源元件及設於各該光源元件上的一聚光體，該光源元件係提供該光源，該聚光體則被設置以聚集該光源至該光源感測模組上。
較佳地，該領導車體進一步包括一傳輸元件，其被設置於該領導處理電路上，且與該領導處理模組相連接，該傳輸元件被設置以傳輸或接收訊號，且該傳輸元件與一遙控元件相連接，該遙控元件係傳輸一控制訊
號予該傳輸元件，使得該領導處理模組依據該控制訊號控制該領導驅動系統移動該領導車體的移動方式。
為達上述之目的者，本發明係提供另一種基於光源偵測之自走車編隊控制系統，其包括：至少一跟隨車體，其被設置以跟隨一領導車體，其包括：一跟隨驅動系統，其被設置於該跟隨車體內，以控制該跟隨車體的移動方式；一跟隨處理電路，其被設置於該跟隨車體內；一跟隨處理模組，其被設置於該跟隨處理電路上，且與該跟隨驅動系統相連接；一光源感測模組，其被設置於該跟隨車體的周邊上，且與該跟隨處理模組相連接，該光源感測模組接收從該領導車體之一定位光源模組提供的一光源，當該光源感測模組接收到該光源時，該光源感測模組會產生一電壓值變化；其中，該跟隨處理模組係讀取且計算該電壓值變化，以判斷該跟隨車體跟隨該領導車體的跟隨狀態，且依據所述跟隨狀態控制該跟隨驅動系統調整該跟隨車體的移動方式。
較佳地，該光源感測模組包括一正偏移感測部、一基準感測部及一負偏移感測部，當該正偏移感測部或該負偏移感測部接收到該光源時，該跟隨處理模組則讀取且計算該正偏移感測部或該負偏移感測部的該電壓值變化，且判斷該跟隨車體跟隨該領導車體的角度已偏移，當該基準感測部接收到該光源時，該跟隨處理模組則讀取且計算該基準感測部的該電壓值變化，且判斷該跟隨車體跟隨該領導車體的角度並無偏移。
較佳地，該正偏移感測部包括有一第一正偏移感測部、一第二正偏移感測部及一第三正偏移感測部，該跟隨處理模組讀取且計算該第一正偏移感測部、該第二正偏移感測部、該第三正偏移感測部或任二者組合
接收到該光源產生的該電壓值變化，以判斷該跟隨車體跟隨該領導車體的偏移角度。
較佳地，該負偏移感測部包括有一第一負偏移感測部、一第二負偏移感測部及一第三負偏移感測部，該跟隨處理模組讀取且計算該第一負偏移感測部、該第二負偏移感測部、該第三負偏移感測部或任二者組合接收到該光源產生的該電壓值變化，以判斷該跟隨車體跟隨該領導車體的偏移角度。
較佳地，當該跟隨處理模組判斷該跟隨車體跟隨該領導車體的角度已偏移時，該跟隨處理模組發送一角度調整訊號予該跟隨驅動系統，該跟隨驅動系統依據該角度調整訊號調整該跟隨車體跟隨該領導車體的角度，使得該基準感測部接收該光源。
較佳地，該光源感測模組係為太陽能光源感測器。
較佳地，該跟隨車體進一步包括一距離量測裝置，其被設置於該跟隨車體的周邊上，且與該跟隨處理模組相連接，該距離量測裝置提供一測距訊號至該領導車體上，以依據該測距訊號量測的結果生成一距離資訊，該跟隨處理模組讀取該距離資訊，且判斷該距離資訊是否符合一車距閾值，若不符合時，該跟隨處理模組則發送一距離調整訊號予該跟隨驅動系統，該跟隨驅動系統依據該距離調整訊號調整該跟隨車體跟隨該領導車體之間的距離，使得該距離資訊符合該車距閾值。
較佳地，該距離量測裝置係為超聲波距離量測裝置。
100:領導車體
11:領導驅動系統
12:領導處理電路
13:領導處理模組
14:定位光源模組
141:光源元件
142:聚光體
15:傳輸元件
200:跟隨車體
21:跟隨驅動系統
22:跟隨處理電路
23:跟隨處理模組
231:角度調整訊號
232:車距閾值
233:距離調整訊號
24:光源感測模組
241:正偏移感測部
242:基準感測部
243:負偏移感測部
25:距離量測裝置
251:測距訊號
252:距離資訊
30:遙控元件
31:控制訊號
L:光源
θ:偏移角度
圖1係為本發明之領導車體之架構方塊圖；圖2係為本發明之領導車體與遙控元件相連接示意圖；圖3係為本發明之定位光源模組示意圖；圖4係為本發明之跟隨車體之架構方塊圖；圖5係為本發明之跟隨車體之訊號傳遞示意圖；圖6係為本發明之跟隨車體之角度偏移判斷流程圖；圖7係為本發明之跟隨車體之距離偏差判斷流程圖；圖8係為本發明之太陽能光源感測模組之布置示意圖；圖9係為本發明之領導車體與跟隨車體角度偏移示意圖；圖10係為本發明之領導車體與跟隨車體距離偏差示意圖；圖11係為本發明之一實施例之三角陣型示意圖；圖12係為本發明之另一實施例之橫列陣型示意圖。
以下將描述具體之實施例以說明本發明之實施態樣，惟其並非用以限制本發明所欲保護之範疇。
請參閱圖1至圖3，其係為本發明之領導車體之架構方塊圖、領導車體與遙控元件相連接示意圖、定位光源模組示意圖。如圖所示，本發明揭露了一種基於光源偵測之自走車編隊控制系統，其包括了一領導車體100，其主要是被設置以領導至少一跟隨車體200，該領導車體100主要是由一領導驅動系統11、一領導處理電路12、一領導處理模組13及一定位光源模組14所組成，該領導驅動系統11係被設置於該領導車體100內，以控制該領導車體100的移動方式，如此，該領導驅動系統11係可具有微控制器、驅動
電路、伺服馬達以及馬達上的編碼器等，該微控制器是用於接收訊號，以透過該微控制器進行該領導車體100的移動控制，伺服馬達是用於提供該領導車體100移動的動力，而該編碼器則是用於量測該領導車體100右輪及左輪的速率。
該領導處理模組13具體為具有54個數位輸入/輸出引腳(其中12可作為脈衝寬度調變(Pulse Width Modulation，簡稱PWM)輸出)、12個模擬輸入、4個硬體序列埠(UART)、1個振盪器、1個USB OTG連接、2個數位類比轉換器(Digital to analog converter，簡稱DAC)、2個雙線接口(Two-Wire Interface，簡稱TWI)、1個電源插座、1個SPI頭、1個JTAG頭、1個重置按鈕和1個清除按鈕的微控制器板，其被設置於該領導處理電路12上，以接收、傳輸或處理相關訊號。
該定位光源模組14係由複數光源元件141及設於各該光源元件上的一聚光體142所組成，其中該光源元件141具體係為一種能發光的半導體電子元件，於本發明中，主要是利用一般比較不常見的白光高功率高亮度的球泡燈，但因一般球泡燈的光照角度範圍為140度，對於被設置成為定位的燈具來說，其光照角度過於廣泛，如此，於各該光源元件141上則會額外裝設該聚光體142，以將該光源元件141所提供的一光源L的光照角度壓縮至15度以內，以形成一聚光光束形態的該光源L。該定位光源模組14是被設置於該領導車體100的周邊上，且與該領導處理模組13相連接，以提供該光源L至一跟隨車體200上的一光源感測模組24。
為實現該領導車體100可利用外部的遙控裝置進行遙控，以便於使用者操控該領導車體100，該領導車體100進一步可包括一傳輸元件
15，其具體為一藍芽模組，以透過RF藍芽4.0的技術來傳輸或接收訊號。該傳輸元件15係被設置於該領導處理電路12上，且與該領導處理模組13相連接以傳輸或接收訊號，且該傳輸元件15與一遙控元件30相連接，以透過該遙控元件30傳輸的一控制訊號31至該傳輸元件15，使得該領導處理模組13依據該控制訊號31控制該領導驅動系統11移動該領導車體100的移動方式。其中，該遙控元件30具體為可安置於人體手指或手部上的遙控元件，在此實施例中，該遙控元件30為一戒指結構的設計，以藉由其該遙控元件30所設有的一環套部套於手指上，使得使用者僅須利用手指的揮動，即可生成該控制訊號31，以控制該領導車體100的移動方式。
請參閱圖4至圖10，其係為本發明之跟隨車體之架構方塊圖、跟隨車體之訊號傳遞示意圖、跟隨車體之角度偏移判斷流程圖、跟隨車體之距離偏差判斷流程圖、太陽能光源感測模組之布置示意圖、領導車體與跟隨車體角度偏移示意圖、領導車體與跟隨車體距離偏差示意圖。如圖所示，本發明揭露的至少一跟隨車體200，是被設置以跟隨該領導車體100，其主要是由一跟隨驅動系統21、一跟隨處理電路22、一跟隨處理模組23及一光源感測模組24所組成，該跟隨驅動系統21係被設置於該跟隨車體200內，以控制該跟隨車體200的移動方式，而該跟隨驅動系統21係可如同該領導驅動系統11相同或相似的結構(微控制器、驅動電路、伺服馬達以及馬達上的編碼器)。
該跟隨處理模組23則是被設置於該跟隨處理電路22上，且與該跟隨驅動系統21相連接，該跟隨處理模組23係可為如該領導處理模組13相同或相似的結構，以接收、傳輸或處理相關訊號。
該光源感測模組24係被設置於該跟隨車體200的周邊上，且
與該跟隨處理模組23相連接，以用於接收從該定位光源模組14提供的該光源L，且當該光源感測模組24接收到該光源L時，該光源感測模組24會產生一電壓值變化，使得該跟隨處理模組23可讀取且計算該電壓值變化，進而判斷該跟隨車體200跟隨該領導車體100的跟隨狀態，且依據所述跟隨狀態控制該跟隨驅動系統21調整該跟隨車體200的移動方式。
具體來說，該光源感測模組24係為太陽能光源感測器，由於太陽能板主要材料是高純度的半導體組成，在半導體內加入不同的物質會形成不同類型的半導體，構成太陽能電池的半導體主要是P型半導體與N型半導體，P型半導體是在半導體內加入「硼」，N型半導體是在半導體內加入「磷」，將PN兩型半導體結合在一起，PN兩型半導體的接觸面會形成P-N鍵結。當太陽射入到P-N鍵結時，擁有足夠能量的光子可將其共價鍵結破壞而產生電子與電洞，此時帶負電的電子會往N型半導體移動，帶正電的電洞會往P型半導體移動，此時兩型半導體存在電位差，以導線連接時，電子會經由導線跑道P型半導體，因而產生電流。
而本發明使用的太陽能光源感測模組主要是利用太陽能的發電原理，以當該光源L照射在太陽能光源感測模組上，使得太陽能光源感測模組吸收該光源L能透過p-型半導體及n-型半導體，使其產生電子(負極)及電洞(正極)，同時分離電子與電洞而形成電壓降。
如此，當太陽能光源感測模組的電壓正端與該跟隨處理模組23連接後，該跟隨處理模組23即可讀取且計算太陽能光源感測模組的電壓值，以進行後續的判斷分析。
在該跟隨車體200跟隨該領導車體100的過程中，該光源感測
模組24會不斷地回傳該光源L照射的資訊，故當該光源照射至該光源感測模組24上時，在此實施例中，該光源感測模組24係可被區分為一正偏移感測部241、一基準感測部242及一負偏移感測部243，其中該基準感測部242係設於該正偏移感測部241及該負偏移感測部243之間，具體來說，該基準感測部242是設在該光源感測模組24中央，該正偏移感測部241是設於該光源感測模組24的左半部，而該負偏移感測部243是設於該光源感測模組24的右半部。當該正偏移感測部241或該負偏移感測部243接收到該光源L時，該跟隨處理模組23則讀取且計算該正偏移感測部241或該負偏移感測部243的該電壓值變化，且判斷該跟隨車體200跟隨該領導車體100的角度已偏移，當該基準感測部242接收到該光源L時，該跟隨處理模組23則讀取且計算該基準感測部242的該電壓值變化，且判斷該跟隨車體200跟隨該領導車體100的角度並無偏移。
舉例來說，該正偏移感測部241可被細分為一第一正偏移感測部2411、一第二正偏移感測部2412及一第三正偏移感測部2413，該負偏移感測部243則可被細分一第一負偏移感測部2431、一第二負偏移感測部2432及一第三負偏移感測部2433，其中，該第一正偏移感測部2411、該第二正偏移感測部2412及該第三正偏移感測部2413可被定義為θ0=45、θ1=30、θ2=15，該基準感測部242可被定義為θ3=0，該第一負偏移感測部2431、該第二負偏移感測部2432及該第三負偏移感測部2433則可被定義為θ4=-15、θ5=-30、θ6=-45。當該光源感測模組24接收到該光源L時，其中Vi為編號i的太陽能光源感測模組所產生的電壓值，Viw為其一太陽能光源感測模組在所有太陽能光源感測模組所產生的電壓值中占的權重值(如下公式3.3)，再透過公式3.4把各
個太陽能光源感測模組當下讀到的電壓值權重乘上所定義的角度後，再進行加總，以計算出該光源L的偏移角度θ。
當該跟隨處理模組23讀取且計算該光源L的偏移角度θ後，即判斷該跟隨車體200跟隨該領導車體100的角度已偏移，此時，該跟隨處理模組23發送一角度調整訊號231予該跟隨驅動系統21，使得該跟隨驅動系統21依據該角度調整訊號231調整該跟隨車體200跟隨該領導車體100的角度，使其偏移角度θ收斂至0(即使得該光源L僅照射至該基準感測部上)。
為了維持該跟隨車體200跟隨該領導車體100之間的距離，例如該跟隨車體200與該領導車體100之間距離10cm，使得該光源L可有效地照射於該光源感測模組24上，避免因距離過大時，當該跟隨車體200的角度產生偏移時，該光源L可能有超出該光源感測模組24可感測位置的情形發生。該跟隨車體200進一步包括一距離量測裝置25，其被設置於該跟隨車體200的周邊上，且與該跟隨處理模組23相連接，該距離量測裝置25是用於提供一測距訊號251至該領導車體100周邊的任意位置上，以依據該測距訊號251量測的結果生成一距離資訊252，其後，再利用該跟隨處理模組23讀取該距離資訊252，以判斷該距離資訊252是否符合該跟隨處理模組23所設定的一車距閾值232(例如10cm)，若不符合時，該跟隨處理模組23則發送一距離調整訊號233予該跟隨驅動系統11，該跟隨驅動系統21依據該距離調整訊號233調整該跟隨車體200跟隨該領導車體100之間的距離，使得該距離資訊252符合該車距閾值232。
其中，該距離量測裝置25具體為超聲波距離量測裝置，超聲波測距原理主要是透過感測器發出人耳聽不到的超聲波，從感測器到待測物，藉由接收回波所需要的時間來判斷距離，在此實施例中，該跟隨車體200係具有5個超聲波距離量測裝置，前方3個負責前方該領導車體或另一該跟隨車體200的距離，側邊2個則負責偵測側邊該領導車體100或另一該跟隨車體200的間距。
如此，該跟隨車體200則可利用以下流程判斷該跟隨車體200與該領導車體100之間的角度或距離，進而進行相關的調整作業：S601：利用光源感測模組接收從定位光源模組提供的一光源；S602：跟隨處理模組讀取光源感測模組的電壓值變化；S603：跟隨處理模組計算光源感測模組的電壓值變化，以判斷跟隨處體與領導車體之間是否偏移；S604：當跟隨處理模組判斷跟隨處體與領導車體之間具有偏移角度時，跟隨處理模組則發送一角度調整訊號予跟隨驅動系統，使得該跟隨驅動系統依據角度調整訊號調整該跟隨車體跟隨該領導車體的角度，以將偏移角度收斂至0(使得基準感測部接收該光源)；S605：利用距離量測裝置提供測距訊號至該領導車體上；S606：依據測距訊號量測的結果生成距離資訊；S607：跟隨處理模處讀取距離資訊，且判斷距離資訊是否符合一車距閾值；S608：當距離資訊不符合車距閾值時，跟隨處理模組則發送
一距離調整訊號予該跟隨驅動系統，使得跟隨驅動系統依據該距離調整訊號調整該跟隨車體跟隨該領導車體之間的距離至該距離資訊符合該車距閾值。
但當該領導車體100與該跟隨車體200之間的角度並無偏移，且該距離資訊252符合車距閾值232時，該光源感測模組24則會持續感測該光源L，而該距離量測裝置25則持續量測距離，藉以不斷地監控其角度及距離。
請參閱圖11，其係為本發明之一實施例之三角陣型示意圖。如圖所示，在此實施例中，本發明揭露了一領導車體100及二個跟隨車體200，其可利用二該跟隨車體200橫向排列至該領導車體100後面，以形成一三角陣型的排列方式，該領導車體100可設置有二個定位光源模組14至該領導車體100的後側上，且個別提供一光源L各該跟隨車體200上，此時，該跟隨車體200所設置的基準感測部並非設置於該光源感測模組24的中央處，而是設置於偏左或偏右的位置上，使得各該跟隨車體200可與該領導車體100之間保持三角陣型的方式移動。
請參閱圖12，其係為本發明之另一實施例之橫列陣型示意圖。如圖所示，在此另一實施例中，本發明亦揭露了一領導車體100及二個跟隨車體200，其可利用二該跟隨車體200橫向排列至該領導車體100的左右側，且將該領導車體100夾至二該跟隨車體200之間，以形成一橫條狀的橫列陣型，此時，該領導車體100可設置有二個定位光源模組14至該領導車體100的左右側上，且利用二該定位光源模組14個別提供一光源L，以照射至各該跟隨車體200上，此時，光源感測模組則是設於該跟隨車體200面向該領導車
體100的一側上，藉以保持橫列陣型的方式移動，
藉由上述之各實施例所載之技術內容，本發明可隨時判斷跟隨車體的跟隨狀態，且當跟隨車體與領導車體之間的角度或距離出現偏移或偏差時，以即時調整跟隨車體的移動方式。
在本發明的描述中，需要理解的是，術語「順」、「逆」、「中心」、「橫向」、「上」、「下」、「左」、「右」、「頂」、「底」、「內」、「外」等指示的方位或位置關係為基於圖式所示的方位或位置關係，僅是為了便於描述本發明和簡化描述，而不是指示或暗示所指的裝置或元件必須具有特定的方位、以特定的方位構造和操作，因此不能理解為對本發明的限制。
在上列詳細說明係針對本發明之一可行實施例之具體說明，惟該實施例並非用以限制本發明之專利範圍，凡未脫離本發明技藝精神所為之等效實施或變更，均應包含於本案之專利範圍中。
200‧‧‧跟隨車體
21‧‧‧跟隨驅動系統
22‧‧‧跟隨處理電路
23‧‧‧跟隨處理模組
231‧‧‧角度調整訊號
232‧‧‧車距閾值
233‧‧‧距離調整訊號
24‧‧‧光源感測模組
25‧‧‧距離量測裝置
251‧‧‧測距訊號
252‧‧‧距離資訊
Claims (10)
- 一種基於光源偵測之自走車編隊控制系統，其包括：一領導車體，其被設置以領導至少一跟隨車體，該領導車體包括：一領導驅動系統，其被設置於該領導車體內，控制該領導車體的移動方式；一領導處理電路，其被設置於該領導車體內；一領導處理模組，其被設置於該領導處理電路上，且與該領導驅動系統相連接；一定位光源模組，其被設置於該領導車體的周邊上，且與該領導處理模組相連接，該定位光源模組提供一光源至該跟隨車體上的一光源感測模組；其中，當該光源感測模組接收到該光源時，該光源感測模組會產生一電壓值變化，使得該跟隨車體內的一跟隨處理模組讀取且計算該電壓值變化，以判斷該跟隨車體跟隨該領導車體的跟隨狀態，且依據所述跟隨狀態控制一跟隨驅動系統調整該跟隨車體的移動方式。
- 如申請專利範圍第1項所述之基於光源偵測之自走車編隊控制系統，其中，該定位光源模組係包括複數光源元件及設於各該光源元件上的一聚光體，該光源元件係提供該光源，該聚光體則被設置以聚集該光源至該光源感測模組上。
- 如申請專利範圍第1項所述之基於光源偵測之自走車編隊控制系統，其中，該領導車體進一步包括一傳輸元件，其被設置於該領導處理電路上，且與該領導處理模組相連接，該傳輸元件被設置以傳輸或接收訊號，且該傳輸元件與一遙控元件相連接，該遙控元件係傳輸一控制訊號予該傳輸元件，使得該領導處理模組依據該控制訊號控制該領導驅動系統移動 該領導車體的移動方式。
- 一種基於光源偵測之自走車編隊控制系統，其包括：至少一跟隨車體，其被設置以跟隨該領導車體，其包括：一跟隨驅動系統，其被設置於該跟隨車體內，以控制該跟隨車體的移動方式；一跟隨處理電路，其被設置於該跟隨車體內；一跟隨處理模組，其被設置於該跟隨處理電路上，且與該跟隨驅動系統相連接；一光源感測模組，其被設置於該跟隨車體的周邊上，且與該跟隨處理模組相連接，該光源感測模組接收從該領導車體之一定位光源模組提供的一光源，當該光源感測模組接收到該光源時，該光源感測模組會產生一電壓值變化；其中，該跟隨處理模組係讀取且計算該電壓值變化，以判斷該跟隨車體跟隨該領導車體的跟隨狀態，且依據所述跟隨狀態控制該跟隨驅動系統調整該跟隨車體的移動方式。
- 如申請專利範圍第4項所述之基於光源偵測之自走車編隊控制系統，其中，該光源感測模組包括一正偏移感測部、一基準感測部及一負偏移感測部，當該正偏移感測部或該負偏移感測部接收到該光源時，該跟隨處理模組則讀取且計算該正偏移感測部或該負偏移感測部的該電壓值變化，且判斷該跟隨車體跟隨該領導車體的角度已偏移，當該基準感測部接收到該光源時，該跟隨處理模組則讀取且計算該基準感測部的該電壓值變化，且判斷該跟隨車體跟隨該領導車體的角度並無偏移。
- 如申請專利範圍第5項所述之基於光源偵測之自走車編隊控制系統，其中，該正偏移感測部包括有一第一正偏移感測部、一第二正偏移感測部 及一第三正偏移感測部，該跟隨處理模組讀取且計算該第一正偏移感測部、該第二正偏移感測部、該第三正偏移感測部或任二者組合接收到該光源產生的該電壓值變化，以判斷該跟隨車體跟隨該領導車體的偏移角度；該負偏移感測部包括有一第一負偏移感測部、一第二負偏移感測部及一第三負偏移感測部，該跟隨處理模組讀取且計算該第一負偏移感測部、該第二負偏移感測部、該第三負偏移感測部或任二者組合接收到該光源產生的該電壓值變化，以判斷該跟隨車體跟隨該領導車體的偏移角度。
- 如申請專利範圍第5項所述之基於光源偵測之自走車編隊控制系統，其中，當該跟隨處理模組判斷該跟隨車體跟隨該領導車體的角度已偏移時，該跟隨處理模組發送一角度調整訊號予該跟隨驅動系統，該跟隨驅動系統依據該角度調整訊號調整該跟隨車體跟隨該領導車體的角度，使得該基準感測部接收該光源。
- 如申請專利範圍第4項所述之基於光源偵測之自走車編隊控制系統，其中，該光源感測模組係為太陽能光源感測器。
- 如申請專利範圍第4項所述之基於光源偵測之自走車編隊控制系統，其中，該跟隨車體進一步包括一距離量測裝置，其被設置於該跟隨車體的周邊上，且與該跟隨處理模組相連接，該距離量測裝置提供一測距訊號至該領導車體上，以依據該測距訊號量測的結果生成一距離資訊，該跟隨處理模組讀取該距離資訊，且判斷該距離資訊是否符合一車距閾值，若不符合時，該跟隨處理模組則發送一距離調整訊號予該跟隨驅動系統，該跟隨驅動系統依據該距離調整訊號調整該跟隨車體跟隨該領導車體之間的距離，使得該距離資訊符合該車距閾值；其中，該距離量測裝置係為超聲波距離量測裝置。
- 一種具有如申請專利範圍第1至9項中任一項所述之基於光源偵測之自走車編隊控制系統。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| TW108147804A TWI725684B (zh) | 2019-12-26 | 2019-12-26 | 基於光源偵測之自走車編隊控制系統 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| TW108147804A TWI725684B (zh) | 2019-12-26 | 2019-12-26 | 基於光源偵測之自走車編隊控制系統 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| TWI725684B true TWI725684B (zh) | 2021-04-21 |
| TW202124916A TW202124916A (zh) | 2021-07-01 |
Family
ID=76604648
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| TW108147804A TWI725684B (zh) | 2019-12-26 | 2019-12-26 | 基於光源偵測之自走車編隊控制系統 |
Country Status (1)
| Country | Link |
|---|---|
| TW (1) | TWI725684B (zh) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| TWI832564B (zh) * | 2022-11-17 | 2024-02-11 | 艾訊股份有限公司 | 自走車的精度量測方法、運算裝置及自走車 |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| TW200839184A (en) * | 2007-03-21 | 2008-10-01 | Mitac Int Corp | Navigation aids method applied to electronic navigation system |
| TWI316479B (en) * | 2007-12-27 | 2009-11-01 | Ind Tech Res Inst | Car-following device and method thereof |
| TW200948648A (en) * | 2008-05-28 | 2009-12-01 | Ming-Zhi Lu | Vehicle distance measuring safety system |
| US20120059545A1 (en) * | 2010-09-03 | 2012-03-08 | Hitachi Plant Technologies, Ltd. | Automatic guided vehicle and method for drive control of the same |
| CN104991557A (zh) * | 2015-07-02 | 2015-10-21 | 深圳乐行天下科技有限公司 | 一种自主跟随小车及其系统 |
| CN105584481A (zh) * | 2014-11-10 | 2016-05-18 | 沃尔沃汽车公司 | 控制自主车辆的控制装置、自主驾驶装置、车辆和方法 |
| CN107406077A (zh) * | 2015-02-26 | 2017-11-28 | 沃尔沃卡车集团 | 控制车队中的车辆之间间隙的方法 |
-
2019
- 2019-12-26 TW TW108147804A patent/TWI725684B/zh active
Patent Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| TW200839184A (en) * | 2007-03-21 | 2008-10-01 | Mitac Int Corp | Navigation aids method applied to electronic navigation system |
| TWI316479B (en) * | 2007-12-27 | 2009-11-01 | Ind Tech Res Inst | Car-following device and method thereof |
| TW200948648A (en) * | 2008-05-28 | 2009-12-01 | Ming-Zhi Lu | Vehicle distance measuring safety system |
| US20120059545A1 (en) * | 2010-09-03 | 2012-03-08 | Hitachi Plant Technologies, Ltd. | Automatic guided vehicle and method for drive control of the same |
| CN105584481A (zh) * | 2014-11-10 | 2016-05-18 | 沃尔沃汽车公司 | 控制自主车辆的控制装置、自主驾驶装置、车辆和方法 |
| CN107406077A (zh) * | 2015-02-26 | 2017-11-28 | 沃尔沃卡车集团 | 控制车队中的车辆之间间隙的方法 |
| CN104991557A (zh) * | 2015-07-02 | 2015-10-21 | 深圳乐行天下科技有限公司 | 一种自主跟随小车及其系统 |
Also Published As
| Publication number | Publication date |
|---|---|
| TW202124916A (zh) | 2021-07-01 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Escobedo et al. | Energy generating electronic skin with intrinsic tactile sensing without touch sensors | |
| EP2415327B1 (en) | Current source to drive a light source in an optical sensor system | |
| CN204009577U (zh) | 智能小车复合式避障系统 | |
| TWI725684B (zh) | 基於光源偵測之自走車編隊控制系統 | |
| CN105128032A (zh) | 具有核设备管道检测功能的蛇形机器人 | |
| CN206406060U (zh) | 一种基于肌电信号的六足机器人控制系统 | |
| CN203502825U (zh) | 一种循线轨迹车 | |
| RU2487007C1 (ru) | Мобильный робот | |
| CN104850121A (zh) | 一种具有定位与循迹功能的微小型移动机器人运动底盘 | |
| CN108072372A (zh) | 一种用于微小卫星的集成姿态测量系统 | |
| JP2008091670A (ja) | 混合式追跡制御装置付きの光学追跡設備 | |
| JP2009210280A (ja) | 方位センサ装置 | |
| TWI436015B (zh) | 全向式太陽位置感測器與控制器及其追日之方法 | |
| Ma | Line following and beacon tracking robot based on Arduino Mega 2560 | |
| Kokare et al. | Line follower with obstacle information system using ZigBee | |
| KR100427690B1 (ko) | 렌즈를 이용한 태양광 추적장치 | |
| CN204650274U (zh) | 一种具有定位与循迹功能的微小型移动机器人运动底盘 | |
| CN105929749A (zh) | 一种基于微处理器人工智能控制智能饮水机器 | |
| CN106527433B (zh) | 多机器人搜救系统 | |
| CN216352218U (zh) | 一种基于红外对管的鼠标键盘灯效切换电路 | |
| CN207113796U (zh) | 一种基于psd激光位置探测装置 | |
| CN105352474B (zh) | 一种适用于高精度增量式adc的接近传感器电路 | |
| CN205679994U (zh) | 一种智能测距及避障装置的电路 | |
| CN105929742A (zh) | 一种基于微处理器人工智能控制系统器 | |
| CN106054835A (zh) | 一种基于微处理器人工智能控制智能防霾器 |