TW201807523A - 移動式機器人的即時導航方法 - Google Patents
移動式機器人的即時導航方法 Download PDFInfo
- Publication number
- TW201807523A TW201807523A TW105126812A TW105126812A TW201807523A TW 201807523 A TW201807523 A TW 201807523A TW 105126812 A TW105126812 A TW 105126812A TW 105126812 A TW105126812 A TW 105126812A TW 201807523 A TW201807523 A TW 201807523A
- Authority
- TW
- Taiwan
- Prior art keywords
- mobile robot
- obstacle
- real
- navigation method
- moving direction
- Prior art date
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/06—Safety devices
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/86—Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/4808—Evaluating distance, position or velocity data
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
Abstract
本發明揭露一種移動式機器人的即時導航方法,包括:移動式機器人取得目標位置;經由超寬頻通訊模組自外部信標裝置接收定位訊號並計算當前位置;依據目標位置及當前位置計算移動方向;於經由移動式機器人的雷射感測模組偵測到障礙物時,校正移動方向,並依據校正後的移動方向移動以避開障礙物;及,重複執行上述偵測、校正及移動,直到抵達目標位置。本發明經由主動偵測障礙物,可有效避免移動式機器人誤入無定位訊號區域,而導航失敗。
Description
本發明係與移動式機器人有關,特別有關於移動式機器人的即時導航方法。
不同於採用全球定位系統(Global Positioning System,GPS)的戶外定位技術,由於在室內空間(如建築物內)中無法準確接收GPS訊號,因此無法採用相同的技術於室內進行定位。
為解決上述問題,目前已有一種室內定位技術被提出。前述室內定位技術係使用複數定位信標(beacon)來發射不同的定位訊號。具體而言,複數定位信標係超寬頻(Ultra-Wideband,UWB)訊號發射器,分別被安裝於建築物的不同位置,並分別被設定為發出對應所安裝位置的超寬頻定位訊號。藉此,使用者可使用室內導航裝置來自複數定位信標取得定位訊號,以進行室內定位。
另,目前已有一種可自動進行室內導航的移動式機器人被提出。所述移動式機器人於收到目標位置後,可依據上述定位訊號規劃導航路線,並依據所規劃的導航路線自動移動至目標位置。
雖上述移動式機器人可自動移動至目標位置,然而,由於超寬頻通訊的限制,前述定位訊號與實際位置間可能存在誤差。上述存在誤差的定位訊號將導致移動式機器人規劃出錯誤的導航路線,而無法精準地移動至目標位置,或誤入禁止區域(如管制區域或無定位訊號區域)。
圖1為現有的移動式機器人的自動導航示意圖,用以示例性說明前段所述狀況。如圖1所示,目標位置10的座標為(Xt,Yt),移動式機器人12位於複數貨架140-148間的主要走道,且其實際座標為(X1,Y1)。因此,若移動式機器人12朝移動方向V1移動時,可順利抵達目標位置(Xt,Yt)。
由於定位訊號存在誤差,移動式機器人12可能誤認其所在座標為(X2,Y2),並規劃出錯誤的移動方向V2。當朝錯誤的移動方向V2移動後,移動式機器人12將從實際座標(X1,Y1)移動至錯誤位置(座標為(X3,Y3))。
當移動式機器人12處於錯誤位置時,由於定位訊號被貨架146、148遮蔽,移動式機器人12將因無法收到定位訊號而無法再次規劃導航路線,這使得移動式機器人12無法自貨架146、148間脫困而導致導航失敗。
本發明提供一種移動式機器人的即時導航方法,可主動偵測障礙物位置並即時修正移動方向。
於本發明實施例中,本發明的一種移動式機器人的即時導航方法,包括步驟:a) 於一移動式機器人取得一目標位置;b) 依據經由一超寬頻通訊模組接收的一定位訊號決定該移動式機器人的一當前位置;c) 依據該目標位置及該當前位置計算一移動方向;d) 於經由一雷射感測模組偵測到一障礙物時,校正該移動方向,並控制該移動式機器人朝校正後的該移動方向移動;及e) 重複執行該步驟b至該步驟d直到該移動式機器人抵達該目標位置。
本發明經由主動偵測障礙物,可有效避免移動式機器人誤入無定位訊號區域,而無法自動導航至目標位置。
茲就本發明之一較佳實施例,配合圖式,詳細說明如後。
請參閱圖2,為本發明第一實施例的移動式機器人的架構圖。本發明揭露了一種移動式機器人的即時導航方法(下稱即時導航方法),應用於如圖2所示的移動式機器人2。本發明中,移動式機器人2包括超寬頻通訊模組200、雷射感測模組202、人機介面204、驅動模組206、近距離感測模組208、記憶模組210及電性連接上述元件的控制模組212。
超寬頻(Ultra-Wideband,UWB)通訊模組200用以收發超寬頻訊號(如6.5GHz射頻訊號)。較佳地,超寬頻通訊模組200係超音波收發器,並可自複數外部信標裝置3接收以超音波傳輸的定位訊號。
具體而言,複數外部信標裝置3係分別被安裝於特定區域(如建築物內)的不同位置,並分別被設定為發出不同的定位訊號。較佳地,使用者可預先將上述特定區域座標化,以將各外部信標裝置3所在位置對應至一組虛擬的座標。接著,使用者可對複數外部信標裝置3分別進行設定,以使各外部信標裝置3所發送的定位訊號包括其所對應的座標。
雷射感測模組202用以偵測障礙物。具體而言,雷射感測模組202可依據是否收到反射光來判斷掃描範圍內是否有障礙物。更進一步地,雷射感測模組202還可依據發射的雷射光與反射光的時間差來計算障礙物的距離。
較佳地,雷射感測模組202包括用以發射雷射光的雷射模組及稜鏡模組(圖未標示),使用者可經由控制稜鏡模組的複數稜鏡旋轉方式來調整雷射感測模組202的掃瞄維度。
舉例來說,當雷射感測模組202控制所有稜鏡皆水平旋轉或垂直旋轉時,可轉換點光源的雷射光為二維雷射光,並對外部環境進行平面掃描;當雷射感測模組202控制部分稜鏡水平旋轉且部分稜鏡垂直旋轉時,可轉換點光源的雷射光為三維雷射光,並對外部環境進行立體掃描。
較佳地,使用者可經由調整移動式機器人2的殼體(圖未標示)的覆蓋範圍(即不透光範圍),來調整雷射感測模組202的掃瞄範圍。
舉例來說,若雷射感測模組202的掃瞄範圍為360度,當殼體的覆蓋範圍為240度(即僅有120度可透光)時,可調整雷射感測模組202的掃瞄範圍為120度。
較佳地,使用者可經由調整雷射感測模組202的取樣角度,來調整雷射感測模組202的掃瞄精確度。具體而言,雷射感測模組202包括角度編碼器(圖未標示)。使用者可經由角度編碼器設定取樣角度(如每5度取樣或每10度取樣),來調整掃瞄精確度。
人機介面204(如鍵盤、觸控螢幕、顯示器、揚聲器或上述裝置的任意組合)用以接受輸入或輸出資訊。驅動模組206用以控制移動式機器人2移動。
近距離感測模組208(如距離感測器(proximity sensor)或光感測器)用以偵測近距離(如1公尺內)的障礙物。記憶模組210用以儲存資料。
值得一提的是,雷射感測模組202的掃描範圍係明顯小於超寬頻通訊模組200的傳輸範圍,並明顯大於近距離感測模組208的感測範圍。
控制模組212用以控制移動式機器人2。較佳地,控制模組212可控制移動式機器人2自動導航至目標位置(容後詳述)。
較佳地,控制模組212還可經由人機介面204(以觸控面板為例)與使用者互動,以提供服務或資訊。
以提供商品的陳列位置導引服務為例,當使用者經由人機介面204選擇特定商品後,控制模組212可自動取得特定商品的陳列位置,並做為目標位置。接著,控制模組212控制移動式機器人2自動導航至目標位置。並且,於導航過程中,控制模組212可經由人機介面204播放相關介紹資訊(如賣場資訊或特定商品資訊)。藉此,移動式機器人2可取代服務人員引導使用者至特定商品的陳列位置。
以線上客服為例,使用者可經由操作移動式機器人2的人機介面204來與遠端的客服人員取得聯繫,以獲得所需資訊。
較佳地,移動式機器人2還包括電池模組214。電池模組214電性連接控制模組212,用以提供移動式機器人2運作所需電力。記憶模組210可進一步儲存一組充電位置(如充電座的座標)。控制模組212於偵測電池模組214剩餘電力過低時,可由記憶模組210取得充電位置並作為目標位置,並控制移動式機器人2自動導航至目標位置,以自動進行充電。並且,於充電期間,移動式機器人2仍可持續提供部分服務(如商品查詢或線上客服)。藉此,本發明可有效避免移動式機器人2因電力不足而停止提供服務。
本發明各實施例的即時導航方法可採用硬體方式(如使用半導體技術、電子電路技術或數位電路技術)、軟體方式(如使用韌體或應用程式的方式)或軟硬體混合方式來加以實現。
較佳地,記憶模組210可進一步儲存電腦程式2100。電腦程式2100包括電腦可執行的程式碼。當控制模組212執行電腦程式2100後,可控制移動式機器人2來執行本發明各實施例的即時導航方法的各步驟。
續請參閱圖3,為本發明第一實施例的移動式機器人的即時導航方法的流程圖。本實施例的即時導航方法包括以下步驟。
步驟S10:控制模組212取得目標位置。較佳地,控制模組212可經由人機介面204接受使用者操作,以設定目標位置,或經由網路(如Wi-Fi網路或藍芽網路)自外部的使用者電子裝置接收目標位置。
步驟S12:控制模組212經由超寬頻通訊模組200接收定位訊號,並依據所接收的定位訊號決定當前位置。較佳地,控制模組212係分別自三個以上外部信標裝置3接收三個以上定位訊號,並依據三個以上定位訊號使用三點定位方式來決定當前位置(如計算當前位置的座標)。
步驟S14:控制模組212判斷是否抵達目標位置。較佳地,控制模組212係於當前位置與目標位置相符時,判斷抵達目標位置。
若控制模組212判斷未抵達目標位置,則執行步驟S16。否則,結束即時導航方法。
步驟S16:控制模組212依據當前位置及目標位置決定移動方向。較佳地,控制模組212計算當前位置及目標位置間的方位角,並作為移動方向。
步驟S18:控制模組212判斷是否經由雷射感測模組202偵測到至少一障礙物。若偵測到障礙物,則控制模組212執行步驟S20。否則,執行步驟S22。
步驟S20:控制模組212校正移動方向。較佳地,控制模組212可依據障礙物的數量、大小或位置來校正移動方向(如增加、減少或重新決定方位角),以使校正後的移動方向可避開障礙物。
步驟S22:控制模組212依據(校正後或未校正的)移動方向經由驅動模組206控制移動式機器人2朝移動方向移動。接著,控制模組212再次執行步驟S12以再次進行導航。
本發明經由主動偵測障礙物,可有效避免移動式機器人誤入無定位訊號區域,而無法自動導航至目標位置。
續請參閱圖4,為本發明第二實施例的移動式機器人的即時導航方法的流程圖。本實施例的即時導航方法包括以下步驟。
步驟S30:控制模組212取得目標位置。
步驟S32:控制模組212自外部接收定位訊號,並決定當前位置。
步驟S34:控制模組212判斷是否抵達目標位置。
若控制模組212判斷未抵達目標位置,則執行步驟S36。否則,結束即時導航方法。
步驟S36:控制模組212決定移動方向。
步驟S38:控制模組212經由雷射感測模組202偵測障礙物的數量,並判斷障礙物的數量是否小於預設的障礙閥值(如2)。
若控制模組212判斷障礙物的數量小於預設的障礙閥值,則執行步驟S40並進入校正模式。否則,執行步驟S44並進入避障模式。
較佳地,控制模組212還可進一步偵測障礙物是否位於雷射感測模組202的掃描範圍的邊緣,並於偵測障礙物位於掃描範圍的邊緣且障礙物的數量小於障礙閥值時才執行步驟S40。否則,執行步驟S44。
步驟S40:控制模組212進入校正模式,並依據該障礙物於雷射感測模組202的掃描範圍中所佔比例校正移動方向。
較佳地,於校正模式下,控制模組212可依據障礙物於雷射感測模組的掃描範圍中的角度比例及放大因子S校正移動方向,其中放大因子S係對應移動式機器人2所在的走道寬度。
具體而言,控制模組212係使用下述式1來校正移動方向。 δ’ = δ + S ╳ (α-α1)/α …………………………………(式1) 其中,δ’為校正後的移動方向;δ為校正前的移動方向;S為放大因子;α為掃瞄範圍(即最大有效掃描角度);α1為障礙物於掃瞄範圍中所占角度。
值得一提的是,雖於本實施例中係依據放大因子S來計算校正後的移動方向δ’,但不應以此為限。於本發明之另一實施例中,亦可不依據放大因子S來計算校正後的移動方向δ’,而僅依據掃描範圍中的角度比例進行校正。
步驟S42:控制模組212依據移動方向控制移動式機器人2移動。
若於步驟S38中,控制模組212判斷障礙物的數量不小於障礙閥值,則執行步驟S44:控制模組212於避障模式下經由雷射感測模組202判斷是否可識別前方不存在障礙物的無障礙方向。
具體而言,控制模組212可經由雷射感測模組202取得各障礙物的所在角度,並判斷各障礙物間的間隙是否夠大,而可允許移動式機器人2通過(如間隙大於10度)。若判斷任一間隙可允許移動式機器人2通過,則將上述間隙所對應方向設定為無障礙方向。
若控制模組212可識別任一無障礙方向,則執行步驟S46。否則,執行步驟S48。
步驟S46:控制模組212將所識別的無障礙方向作為新的移動方向。接著,控制模組212執行步驟S42,以控制移動式機器人2朝新的移動方向前進。
若於步驟S44中,控制模組21無法識別任一無障礙方向,則執行步驟S48:控制模組21控制移動式機器人2停止移動。
較佳地,控制模組21可於移動式機器人2停止移動後,進一步經由人機介面204發出警示訊息,以通知使用者。
較佳地,控制模組21可於移動式機器人2停止移動後,進一步控制移動式機器人2倒退,以藉由遠離障礙物來增加成功識別無障礙方向的機率。
較佳地,控制模組21可於移動式機器人2停止移動後,進入休眠模式一段時間,以等待障礙物被排除。
本發明經由選擇性切換校正模式及避障模式,可有效於障礙物的數量較少時校正移動方向,來避免因定位訊號的誤差而導航失敗,並可有效於障礙物的數量較多時積極地迴避障礙物,來避免碰撞障礙物。
續請參閱圖5,為本發明的校正模式示意圖,用以示例性說明本發明的校正模式。如圖所示,目標位置4的座標為(Xt,Yt),移動式機器人2位於複數貨架50-58間的主要走道,且實際座標為(X1,Y1)。並且,當定位訊號存在誤差時,移動式機器人2誤定位所在座標為(X2,Y2),並規劃出錯誤的移動方向δ1。
於依據錯誤的移動方向進行導航的過程中,若移動式機器人2經由雷射感測模組202主動偵測到障礙物(即貨架58),且判斷障礙物位於掃描範圍的邊緣時,會自動進入校正模式。於校正模式下,移動式機器人2可計算障礙物(於掃描範圍中占角度α1)於掃瞄範圍(最大掃描角度為角度α)中所佔比例來校正移動方向,而校正錯誤的移動方向δ1為正確的移動方向δ2,而可順利導航至目標位置(Xt,Yt)並避免碰撞障礙物。
續請參閱圖6,為本發明的避障模式示意圖,用以示例性說明本發明的避障模式。若移動式機器人2經由雷射感測模組202主動偵測到複數障礙物(如固定的貨架54、56及活動的貨架60)且複數障礙物的數量不小於障礙閥值時,會自動進入避障模式。於避障模式下,移動式機器人2可於貨架56、60的間隙中識別出無障礙方向δ,並作為新的移動方向。藉此,移動式機器人2可自座標(X1,Y1)沿所識別的無障礙方向δ移動至座標(X2,Y2),而可同時閃避複數障礙物。
續請參閱圖7,為本發明第三實施例的移動式機器人的即時導航方法的部分流程圖。相較於圖3所示之第一實施例,本實施例的即時導航方法更包括用以執行近距離障礙物迴避功能的以下步驟。並且,於導航過程中,控制模組212係持續且重複執行近距離障礙物迴避功能。
步驟S50:控制模組212經由近距離感測模組208判斷是否偵測到障礙物。若控制模組212判斷偵測到障礙物,則執行步驟S52。否則,結束本次偵測。
步驟S52:控制模組212控制移動式機器人2停止移動。更進一步地,控制模組212還可經由人機介面204發出警示訊息(如發出“請借過”的語音訊息),以使障礙物(如人員)主動迴避。
步驟S54:控制模組212判斷是否已發出警示訊息達預設的警示時間(如5秒)。若控制模組212判斷已發出警示訊息達預設的警示時間,則執行步驟S56。否則,再次執行步驟S54。
步驟S56:控制模組212再次經由近距離感測模組208判斷是否偵測到障礙物。若控制模組212判斷障礙物仍存在,則執行步驟S58。否則,結束本次偵測。
步驟S58:控制模組212控制移動式機器人2倒退預設距離,以遠離障礙物。於遠離障礙物後,移動式機器人2可經由執行圖3或圖4所示的即時導航方法來主動閃避障礙物。
本發明可即時偵測近距離的障礙物,並避免碰撞障礙物。並且,本發明經由倒退來遠離障礙物,可增加識別無障礙方向的機率,而可有效提升閃避障礙物的機率。
續請參閱圖8,為本發明的移動式機器人的即時導航示意圖,用以說明運用本發明的移動式機器人如何連續地經由避障模式及校正模式來閃避障礙物並完成導航。如圖所示,目標位置4的座標為(Xt,Yt),移動式機器人2位於複數貨架50-60間的主要走道,且起始座標為(X1,Y1)。
當移動式機器人2位於座標(X1,Y1)時,可經由雷射感測模組202偵測到複數障礙物(即貨架54及人員62、64),並進入避障模式。於避障模式下,移動式機器人2判斷無法識別無障礙方向,並朝移動方向δ1倒退至座標(X2,Y2)以遠離障礙物。於遠離障礙物後,移動式機器人2離開避障模式。
接著,移動式機器人2於座標(X2,Y2)經由雷射感測模組202偵測到正前方有複數障礙物(即貨架54及人員62、64),並再次進入避障模式。於避障模式下,移動式機器人2識別掃描範圍右側存在無障礙方向,將無障礙方向作為移動方向δ2,並朝移動方向δ2移動至座標(X3,Y3)以閃避障礙物並朝目標位置4接近。於本次移動後,移動式機器人2離開避障模式。
接著,移動式機器人2於座標(X3,Y3)經由雷射感測模組202偵測到正前方僅有一組障礙物(即相近的貨架58及人員66),且障礙物位於掃描範圍邊緣,而進入校正模式。於校正模式下,移動式機器人2將依據存在誤差的定位訊號所計算的移動方向δ3校正為移動方向δ4,並朝移動方向δ4移動至座標(X4,Y4),以補償定位訊號的誤差並朝目標位置4接近。於本次移動後,移動式機器人2離開校正模式。
最後,移動式機器人2於座標(X4,Y4)經由雷射感測模組202偵測到正前方有複數障礙物(即人員68、70),並再次進入避障模式。於避障模式下,移動式機器人2識別掃描範圍複數障礙物中間存在無障礙方向,將無障礙方向作為移動方向δ5,並朝移動方向δ5移動至目標位置4所在的座標(Xt,Yt)以完成本次導航。
續請參閱圖9,為本發明第四實施例的移動式機器人的即時導航方法的部分流程圖。相較於圖3所示之第一實施例,本實施例的即時導航方法更包括用以執行等待障礙物排除功能的以下步驟。並且,於導航過程中,控制模組212係持續且重複執行等待障礙物排除功能。
步驟S70:控制模組212經由近距離感測模組208判斷是否偵測到障礙物。
若控制模組212判斷偵測到障礙物,則執行步驟S72。否則,判斷結束本次偵測。並且,於結束偵測後,移動式機器人2可經由執行圖3或圖4所示的即時導航方法來繼續朝目標位置接近。
步驟S72:控制模組212控制移動式機器人2停止移動。
步驟S74:控制模組212控制移動式機器人2進入休眠模式。具體而言,於休眠模式下,移動式機器人2可節省電力消耗。較佳地,控制模組212係於移動式機器人2停止移動達預定的休眠啟動時間(如30秒)才進入休眠模式。
步驟S76:控制模組212判斷是否已進入休眠模式達預設的休眠時間(如30秒)。若控制模組212判斷已進入休眠模式達預設的休眠時間,則再次執行步驟S70,以偵測障礙物是否排除。否則,再次執行步驟S76。
本發明可即時偵測近距離的障礙物,並避免碰撞障礙物。並且,本發明經由休眠模式,可有效降低等待障礙物排除時的耗電量,進而有效提升續航力。
以上所述僅為本發明之較佳具體實例,非因此即侷限本發明之專利範圍,故舉凡運用本發明內容所為之等效變化,均同理皆包含於本發明之範圍內,合予陳明。
10‧‧‧目標位置
12、2‧‧‧移動式機器人
200‧‧‧超寬頻通訊模組
202‧‧‧雷射感測模組
204‧‧‧人機介面
206‧‧‧驅動模組
208‧‧‧近距離感測模組
210‧‧‧記憶模組
2100‧‧‧電腦程式
212‧‧‧控制模組
214‧‧‧電池模組
3‧‧‧外部信標裝置
4‧‧‧目標位置
140-148、50-60‧‧‧貨架
62-70‧‧‧人員
V1、V2‧‧‧移動方向
δ、δ1、δ2、δ3、δ4、δ5‧‧‧移動方向
α、α1‧‧‧角度
S10-S22‧‧‧第一即時導航步驟
S30-S48‧‧‧第二即時導航步驟
S10-S22‧‧‧第一即時導航步驟
S50-S58‧‧‧近距離障礙物迴避步驟
S70-S76‧‧‧等待障礙物排除步驟
圖1為現有的移動式機器人的自動導航示意圖。
圖2為本發明第一實施例的移動式機器人的架構圖。
圖3為本發明第一實施例的移動式機器人的即時導航方法的流程圖。
圖4為本發明第二實施例的移動式機器人的即時導航方法的流程圖。
圖5為本發明的校正模式示意圖。
圖6為本發明的避障模式示意圖。
圖7為本發明第三實施例的移動式機器人的即時導航方法的部分流程圖。
圖8為本發明的移動式機器人的即時導航示意圖。
圖9為本發明第四實施例的移動式機器人的即時導航方法的部分流程圖。
S10-S22‧‧‧第一即時導航步驟
Claims (10)
- 一種移動式機器人的即時導航方法,包括步驟: a) 於一移動式機器人取得一目標位置; b) 依據經由一超寬頻通訊模組接收的一定位訊號決定該移動式機器人的一當前位置; c) 依據該目標位置及該當前位置計算一移動方向; d) 於經由一雷射感測模組偵測到一障礙物時校正該移動方向,並控制該移動式機器人朝校正後的該移動方向移動;及 e) 重複執行該步驟b至該步驟d直到該移動式機器人抵達該目標位置。
- 如請求項1所述之移動式機器人的即時導航方法,其中該步驟d包括一步驟d1: 於偵測該障礙物的數量小於一障礙閥值時,依據該障礙物於該雷射感測模組的一掃描範圍中所佔比例校正該移動方向。
- 如請求項2所述之移動式機器人的即時導航方法,其中該步驟d1係於偵測該障礙物位於該掃描範圍的邊緣且該障礙物的數量小於2時,依據該障礙物於該掃描範圍中所佔比例校正該移動方向。
- 如請求項2所述之移動式機器人的即時導航方法,其中該步驟d1係依據該障礙物於該掃描範圍中的一角度比例及一放大因子校正該移動方向,該放大因子係對應該移動式機器人所在的一走道寬度。
- 如請求項1所述之移動式機器人的即時導航方法,其中該步驟d包括一步驟d2: 於偵測到該障礙物的數量不小於一障礙閥值時,識別前方不存在該障礙物的一無障礙方向,並以該無障礙方向作為新的該移動方向。
- 如請求項5所述之移動式機器人的即時導航方法,其中該步驟d更包括一步驟d3: 於該雷射感測模組的一掃描範圍中無法識別該無障礙方向時,控制該移動式機器人停止移動。
- 請求項1所述之移動式機器人的即時導航方法,其中更包括一步驟f:於經由一近距離感測模組偵測到該障礙物時,控制該移動式機器人停止移動。
- 如請求項7所述之移動式機器人的即時導航方法,其中於該步驟f後包括一步驟g:於該移動式機器人停止移動時,發出一警示訊息。
- 如請求項8所述之移動式機器人的即時導航方法,其中於該步驟g後包括一步驟h:於發出該警示訊息達一警示時間且仍然經由該近距離感測器偵測到該障礙物時,控制該移動式機器人倒退。
- 如請求項7所述之移動式機器人的即時導航方法,其中於該步驟f後包括下列步驟: i)於停止移動達一停止時間且經由該近距離感測器偵測到該障礙物時,控制該移動式機器人進入一休眠模式;及 j)於進入該休眠模式達一休眠時間時,重新於該掃描範圍中識別該無障礙方向。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW105126812A TW201807523A (zh) | 2016-08-22 | 2016-08-22 | 移動式機器人的即時導航方法 |
CN201610741473.6A CN107765683A (zh) | 2016-08-22 | 2016-08-26 | 移动式机器人的即时导航方法 |
US15/340,897 US9971350B2 (en) | 2016-08-22 | 2016-11-01 | Real-time navigating method for mobile robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW105126812A TW201807523A (zh) | 2016-08-22 | 2016-08-22 | 移動式機器人的即時導航方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
TW201807523A true TW201807523A (zh) | 2018-03-01 |
Family
ID=61191586
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
TW105126812A TW201807523A (zh) | 2016-08-22 | 2016-08-22 | 移動式機器人的即時導航方法 |
Country Status (3)
Country | Link |
---|---|
US (1) | US9971350B2 (zh) |
CN (1) | CN107765683A (zh) |
TW (1) | TW201807523A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112130559A (zh) * | 2020-08-21 | 2020-12-25 | 同济大学 | 一种基于uwb与激光雷达的室内行人跟随与避障方法 |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6818708B2 (ja) * | 2018-02-28 | 2021-01-20 | 株式会社東芝 | マニピュレータシステム、制御装置、制御方法、およびプログラム |
CN108957466B (zh) * | 2018-04-18 | 2022-01-25 | 广东宝乐机器人股份有限公司 | 移动机器人的雷达数据补偿方法、装置、设备和存储介质 |
CN108549088B (zh) * | 2018-04-27 | 2020-10-02 | 科沃斯商用机器人有限公司 | 基于机器人的定位方法、设备、系统及存储介质 |
EP3569366B1 (en) | 2018-05-17 | 2023-06-28 | Siemens Aktiengesellschaft | Robot control method and apparatus |
CN109276190A (zh) * | 2018-10-23 | 2019-01-29 | 中国人民解放军陆军工程大学 | 基于uwb的扫地机器人监控方法及其设备 |
CN109798894B (zh) * | 2018-12-28 | 2021-12-10 | 广东嘉腾机器人自动化有限公司 | 一种多区域跨楼层的agv定位方法、存储装置及agv定位系统 |
WO2020237397A1 (en) * | 2019-05-31 | 2020-12-03 | Amir Khajepour | Method and system for mobile reconfigurable robot for a large workspace |
KR102384525B1 (ko) | 2020-07-09 | 2022-04-08 | 엘지전자 주식회사 | 이동로봇의 제어방법 |
CN112631290A (zh) * | 2020-12-14 | 2021-04-09 | 云南昆船智能装备有限公司 | 自动标定和设置导航标记物的移动机器人及方法 |
CN112731270A (zh) * | 2021-01-12 | 2021-04-30 | 蔚来汽车科技(安徽)有限公司 | 自动标定装置、设备和服务器以及自动标定方法、存储介质 |
CN113323068B (zh) * | 2021-04-29 | 2023-02-21 | 中联重科土方机械有限公司 | 用于工程机械的控制方法、处理器及工程机械 |
US20220363273A1 (en) * | 2021-05-13 | 2022-11-17 | Ford Global Technologies, Llc | Scenario Discriminative Hybrid Motion Control for Mobile Robots |
CN113681557A (zh) * | 2021-08-17 | 2021-11-23 | Oppo广东移动通信有限公司 | 机器人控制方法、机器人和可读存储介质 |
KR20230046080A (ko) * | 2021-09-29 | 2023-04-05 | 삼성전자주식회사 | 로봇 및 그 제어 방법 |
Family Cites Families (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5279672A (en) * | 1992-06-29 | 1994-01-18 | Windsor Industries, Inc. | Automatic controlled cleaning machine |
EP1279081B1 (en) * | 2000-05-01 | 2012-01-04 | iRobot Corporation | Method and system for remote control of mobile robot |
AU2006274421B2 (en) * | 2005-07-26 | 2011-08-11 | Macdonald, Dettwiler And Associates Inc. | Traffic management system for a passageway environment |
CN100419609C (zh) * | 2007-03-23 | 2008-09-17 | 北京大学 | 一种基于流场的智能机器人避障方法 |
TWI372369B (en) | 2008-06-04 | 2012-09-11 | Univ Nat Chiao Tung | Intruder detection system and method |
JP5094658B2 (ja) * | 2008-09-19 | 2012-12-12 | 日立オートモティブシステムズ株式会社 | 走行環境認識装置 |
CN102445694A (zh) | 2011-09-20 | 2012-05-09 | 中南大学 | 导航机器人障碍探测方法及系统 |
CN102914967B (zh) | 2012-09-21 | 2015-01-28 | 浙江工业大学 | 采摘机器人的自主导航和人机协同采摘作业系统 |
JP5880498B2 (ja) | 2013-08-09 | 2016-03-09 | トヨタ自動車株式会社 | 自律移動体、障害物判別方法及び障害物回避方法 |
CN103777200A (zh) * | 2013-12-16 | 2014-05-07 | 重庆大学 | 面向移动机器人的rfid定位节点布置方法及辅助定位导航方法 |
CN204009577U (zh) * | 2014-04-14 | 2014-12-10 | 南京师范大学 | 智能小车复合式避障系统 |
TWM508319U (zh) | 2015-02-17 | 2015-09-11 | Tbi Motion Technology Co Ltd | 復健機器之導航輔助裝置 |
CN104967672A (zh) | 2015-06-01 | 2015-10-07 | 南京邮电大学 | 一种能优选信道和缓存数据的健康数据传输系统和方法 |
CN105607635B (zh) | 2016-01-05 | 2018-12-14 | 东莞市松迪智能机器人科技有限公司 | 自动导引车全景光学视觉导航控制系统及全向自动导引车 |
CN105629974B (zh) * | 2016-02-04 | 2018-12-04 | 重庆大学 | 一种基于改进型人工势场法的机器人路径规划方法及系统 |
-
2016
- 2016-08-22 TW TW105126812A patent/TW201807523A/zh unknown
- 2016-08-26 CN CN201610741473.6A patent/CN107765683A/zh active Pending
- 2016-11-01 US US15/340,897 patent/US9971350B2/en not_active Expired - Fee Related
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112130559A (zh) * | 2020-08-21 | 2020-12-25 | 同济大学 | 一种基于uwb与激光雷达的室内行人跟随与避障方法 |
Also Published As
Publication number | Publication date |
---|---|
US20180052466A1 (en) | 2018-02-22 |
CN107765683A (zh) | 2018-03-06 |
US9971350B2 (en) | 2018-05-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
TW201807523A (zh) | 移動式機器人的即時導航方法 | |
CN109508014B (zh) | 一种移动机器人的激光引导回充方法及芯片 | |
US11126198B2 (en) | Robot movement control method, apparatus and robot using the same | |
CN110573833B (zh) | 成像装置和监控装置 | |
CN109490825B (zh) | 定位导航方法、装置、设备、系统及存储介质 | |
US20150323934A1 (en) | Indoor robot and method for indoor robot positioning | |
CN107976999A (zh) | 一种移动机器人及其避障和路径规划方法和系统 | |
CN106444777A (zh) | 机器人自动回位充电方法和系统 | |
US20110231018A1 (en) | Control apparatus, control method and program | |
US8358268B2 (en) | Multi-touch detection | |
EP4283567A1 (en) | Three-dimensional map construction method and apparatus | |
Kang et al. | A robust obstacle detection method for robotic vacuum cleaners | |
WO2021248844A1 (zh) | 一种回充对接系统及激光对接方法 | |
CN112578392A (zh) | 一种基于远距离传感器的环境边界构建方法及移动机器人 | |
WO2017158949A1 (ja) | 物体検出装置、物体検出方法、及び、プログラム | |
KR101786516B1 (ko) | 이동 로봇 및 그 제어방법 | |
US20220334585A1 (en) | Robot navigation method, apparatus and system, electronic device and storage medium | |
JP2016191735A (ja) | 地図作成装置、自律走行体、自律走行体システム、携帯端末、地図作成方法、地図作成プログラム及びコンピュータ読み取り可能な記録媒体 | |
US20230140336A1 (en) | Method and laser tracking system for using laser level to track detector | |
KR101080366B1 (ko) | 초음파센서를 이용한 로봇의 위치 인식 방법 및 그 장치 | |
CN111830969A (zh) | 一种基于反光板及二维码的融合对接方法 | |
JP4755886B2 (ja) | 位置検出システムおよび位置検出方法 | |
JP2017173258A (ja) | 距離測定装置、距離測定方法及びプログラム | |
US20210129341A1 (en) | Robot localization method and apparatus and robot using the same | |
US20240126267A1 (en) | Mobile robot localization systems |