TW202242580A - 無人自走車之導引控制方法 - Google Patents
無人自走車之導引控制方法 Download PDFInfo
- Publication number
- TW202242580A TW202242580A TW110115173A TW110115173A TW202242580A TW 202242580 A TW202242580 A TW 202242580A TW 110115173 A TW110115173 A TW 110115173A TW 110115173 A TW110115173 A TW 110115173A TW 202242580 A TW202242580 A TW 202242580A
- Authority
- TW
- Taiwan
- Prior art keywords
- center
- car body
- vehicle body
- vehicle
- steering
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 21
- 238000006243 chemical reaction Methods 0.000 claims abstract description 4
- 230000001133 acceleration Effects 0.000 claims description 4
- 238000013519 translation Methods 0.000 claims description 4
- 239000011159 matrix material Substances 0.000 claims description 2
- 238000012545 processing Methods 0.000 abstract description 4
- 238000010586 diagram Methods 0.000 description 21
- 238000012937 correction Methods 0.000 description 8
- 238000004364 calculation method Methods 0.000 description 6
- 230000006870 function Effects 0.000 description 5
- 230000003287 optical effect Effects 0.000 description 5
- 238000004519 manufacturing process Methods 0.000 description 3
- 230000000007 visual effect Effects 0.000 description 3
- 238000001514 detection method Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012552 review Methods 0.000 description 2
- 230000001131 transforming effect Effects 0.000 description 2
- 238000013473 artificial intelligence Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 231100001261 hazardous Toxicity 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 239000003973 paint Substances 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本發明係提供一種無人自走車之導引控制方法，該導引控制方法係以自動導引裝置取得車體中心的位置建立車輛坐標系，並進行坐標系轉換建立本地坐標系，即可計算車體中心至預定規畫的目標路徑其中一目標點的最短距離、車體中心至目標點間之轉角及車體中心至目標點的旋轉半徑，再根據車體中心至任一個舵輪中心的距離計算車體當前的航向與舵輪中心間之夾角，便可判斷車體需要轉彎的方向，並根據餘弦定理得到二個舵輪的旋轉半徑及轉角，使轉向驅動系統可根據計算得到的轉角及速率控制二個舵輪轉向至對應的位置，從而實現對無人自走車依循預定規劃的目標路徑運行之導引控制，且不需大量複雜的運算或較長的處理週期，可有效提升整體之導航效率。
Description
本發明係提供一種導引控制方法，特別是指一種雙舵輪無人自走車之導引控制方法。
按，現今全球少子化浪潮所導致的勞動力資源短缺與人力成本逐年提升，並逐漸由勞力密集轉型成技術密集的產業，基於各項營運成本不斷升高，要如何降低各項的成本，已成為企業是否能獲利的關鍵，而隨著自動化科技的導入、物聯網和人工智慧的快速發展，使智慧製造與智慧工廠已逐漸應用於工業生產端與製造端，也有越來越多的任務被工業機器人所取代，藉以解決勞動力資源短缺的問題。
然而，自動導引車(Automatic Guided Vehicle；AGV)或稱無人搬運車，指的是配置有電磁式或光學式等自動導引裝置，並集合了環境感知、路徑規劃決策及無人自動操控等功能的運輸車，屬於輪式移動機器人(WMR-Wbeeled Mobile Robot)的範疇，主要功能表現為在電腦或車載系統的監控下，按照路徑規劃和作業要求，自動行走並停靠到指定地點或工作站，並完成一系列作業功能，一般自動導引車可透過車載系統或電腦控制其行進的路線，或是可利用牆壁、支柱或地面上沿著其行進的路線設立的指示標記(如電磁軌道、具有反光特性的反光片、塗漆或色帶
等定位標誌)作為導引，並在自動導引車上裝設電磁式或光學式感測器(如電磁感測器、視覺感測器、超音波感測器或雷射感測器等)，以偵測指示標記作為車輛運行的定位及位置修正，除了可使車體沿著預定規畫的導引路徑自動行駛之外，且因活動區域內無需鋪設軌道、支架等固定裝置，不會受到場地、道路和空間的限制，故自動導引車被廣泛地應用於物料的自動運輸、倉庫的監視巡邏與有害場所的作業等。
傳統的自動導引車大多數的路徑規劃係為網格式點對點間相連接的線所組成的路徑，並利用上述之導引方式使自動導引車能沿著預定的路徑前進，不過上述之導引方式需使用大量複雜的運算來擷取環境中的實體標記或特徵物，才能確定自動導引車應走的方向與速度，運算處理週期較長，反而降低了整體的導航效率，且該路徑規劃也並非平滑曲線，導致自動導引車在行進的過程中會有較不平順的轉彎，其實際行進的路徑會與預定的路徑產生偏離，便需要不斷地進行位置及航向的比對與修正，即為從事於此行業者所亟欲研究改善之方向所在。
故，發明人有鑑於上述缺失，乃搜集相關資料，經由多方的評估及考量，並以從事於此行業累積之多年經驗，持續的試作與修改，始設計出此種無人自走車之導引控制方法的發明專利誕生。
本發明之主要目的乃在於無人自走車之車體包含二個用於驅動與控制轉向之舵輪及至少二個輔助轉輪，並由自動導引裝置對車體進行位置與姿態的定位，以及生成預定規畫的目標路徑，當自動導引裝置取得車體中心的位置(如坐標與姿態角等)建立車輛坐標系，並進行坐標系
轉換建立本地坐標系，即可計算得到車體中心至預定規畫的目標路徑其中一目標點的最短距離、車體中心至目標點間之轉角，以及車體中心至目標點的旋轉半徑，再根據車體中心至任一個舵輪中心的距離計算得到車體當前的航向與舵輪中心間之夾角，便可判斷車體需要轉彎的方向，並根據餘弦定理得到二個舵輪的旋轉半徑及轉角，使轉向驅動系統可根據計算得到的轉角及速率控制二個舵輪轉向至對應的位置，從而實現對無人自走車依循預定規劃的目標路徑運行之導引控制，且不需大量複雜的運算或較長的處理週期，可有效提升整體之導航效率。
本發明之次要目的乃在於由於車體中心與二個舵輪的幾何關係皆為固定，並在車體中心的速度V、車體中心至目標點的旋轉半徑R已知的情況下，可以得到：
其中該θa為車體當前的航向與車體中心至任一個舵輪中心連線間之夾角；d為車體中心至任一個舵輪中心的距離。
然後，可根據車體當前的航向與車體中心至目標點連線間之夾角θS，判斷車體需要轉彎的方向，假設θS為大於0，根據餘弦定理則可以得到：
假設θS為小於0，根據餘弦定理則可以得到：
其中該Rlf為前方舵輪的旋轉半徑；Rrr為後方舵輪的旋轉半徑；θlf為前方舵輪沿著旋轉半徑Rlf轉彎時所需的轉角；θrr為後方舵輪沿著旋轉半徑Rrr轉彎時所需的轉角。
此外，由於車體中心以等速率圓周運動時的角速率為等於二個舵輪的角速率(即ω=ωlf=ωrr)，並根據車體中心的速度V、旋轉半徑R與角速率ω間的關係(即V=R＊ω)可以得到：
其中該Vf為前方舵輪的速率；Vr為後方舵輪的速率。
因此，自動導引裝置可先求得車體二個舵輪行進時所需的旋轉半徑，並回推得到二個舵輪所需的轉角，再根據速率、旋轉半徑與角速率間的關係得到二個舵輪的速率，便可藉由轉向驅動系統來控制二個舵輪轉向至對應的位置，並於轉彎時以不同的轉角與速率行進(即速度差)，使車體穩定的保持在預定規劃的目標路徑上。
本發明之另一目的乃在於當車體二個舵輪的姿態為平移前進時，係先將車體在本地坐標系中的YL軸旋轉到與起始點至目標點連線形成的目標直線平行之夾角θ，且二個舵輪旋轉至夾角θ，假設目標直線分
割二段，並以夾角θ為基準，便可計算得到二個舵輪的控制量分別為θ+arctan(x/y)；當車體二個舵輪的姿態為轉彎時，若是車體的姿態偏差為大於設定角度的偏差，係將二個舵輪根據車體要修正的姿態方向將控制量乘上負號，以供車體向左或向右轉彎時，其中一個舵輪的控制量為θ+arctan(x/y)，而另一個舵輪的控制量則為-〔θ+arctan(x/y)〕。
本發明之再一目的乃在於當轉向驅動系統完成二個舵輪轉角的控制轉向，可由自動導引裝置計算出車體當前的位置、旋轉半徑與目標路徑間之誤差量，並根據該誤差量採用PID控制可得到車體修正後的速度及旋轉半徑，再採用逆運動學以反推的方式計算車體移動至目標路徑所需的速度或加速度，使轉向驅動系統可控制二個舵輪來修正調整車體當前的位置與旋轉半徑，直到完成該車體之路徑導引控制。
1:無人自走車
11:車體
111:舵輪
111a:左前輪
111b:右後輪
112:轉輪
12:自動導引裝置
121:感測器模組
122:路徑規劃單元
13:轉向驅動系統
〔第1圖〕係本發明無人自走車系統之示意圖。
〔第2圖〕係本發明較佳實施例之步驟流程圖。
〔第3圖〕係本發明車體的位置與姿態進行坐標系轉換之示意圖。
〔第4圖〕係本發明車體控制舵輪轉向驅動之演算法示意圖。
〔第5圖〕係本發明目標路徑閉迴路導引控制之方塊圖。
〔第6圖〕係本發明修正車體轉彎的旋轉半徑之示意圖(一)。
〔第7圖〕係本發明修正車體轉彎的旋轉半徑之示意圖(二)。
〔第8圖〕係本發明車體進行直線控制之示意圖。
〔第9圖〕係本發明車體相對於目標路徑的姿態方向之示意圖。
〔第10圖〕係本發明車體的姿態為平移前進之轉向控制示意圖。
〔第11圖〕係本發明車體的姿態修正為向左轉彎之示意圖。
〔第12圖〕係本發明車體的姿態修正為向右轉彎之示意圖。
為達成上述之目的及其功效，本發明所採用之技術手段及詳細構造，茲繪圖就本發明之較佳實施例來詳加說明其構造與功能如下，俾利完全瞭解。
請參閱如第1~4圖所示，係分別為本發明無人自走車系統之示意圖、較佳實施例之步驟流程圖、車體的位置與姿態進行坐標系轉換之示意圖及車體控制舵輪轉向驅動之演算法示意圖，由圖中可清楚看出，本發明之無人自走車1為包括有車體11、自動導引裝置12及轉向驅動系統13，並於車體11下方車輪模組包含二個前後對角設置之舵輪111(即驅動與控制轉向的主動輪)，且二個舵輪111的轉軸上分別連接有另一對角設置之二個轉輪112(即承載或輔助轉向的從動輪)，但並不以此為限，亦可在車體11適當位置單獨設置有二個或二個以上之轉輪112，且自動導引裝置12以通訊介面接收到控制管理中心下達的任務指令後，可通過車載系統或車載控制器操控轉向驅動系統13驅動車輪模組，使車體11依循預定規畫的目標路徑運行，以構成一自動導引車(AGV)、自主移動機器人(Automated Mobile Robot，AMR)或移動載具等。
在本實施例中，無人自走車1係將車體11前方左側的舵輪111作為左前輪111a，車體11後方對角右側的舵輪111作為右後輪111b，用於驅動及控制轉向，但並不以此為限，亦可依車體11實際的設計來將二個舵
輪111位置改為右前輪與左後輪對角設置，再配合車體11另一對角設置的二個轉輪112或其他適當位置的轉輪112，用於承載或輔助轉向，為了使車體11具有更好的穩定性，也可在車體11的貨叉上安裝有二個轉輪112(如貨叉輪)來起到支撐的作用，以構成一適用於重載貨物搬運或移載之叉車式自動導引車、拖板式或堆高機式自動導引車。
此外，無人自走車1之車體11使用的舵輪111可為臥式舵輪或立式舵輪，並包含驅動輪、驅動單元(如驅動電機、齒輪箱等)及轉向機構(如轉向電機、編碼器等)組成，同時帶有驅動及控制轉向，可以二個自由度來實現車體11的直線移動與轉向功能，而自動導引裝置12包含感測器模組121及路徑規劃單元122，其中感測器模組121包含裝載在車體11上的內部感測器〔如編碼器、慣性測量單元(Inertial Measurement Unit，IMU)等〕及外部感測器〔如雷射感測器、光學雷達(Light Detection and Ranging，LiDAR)掃描儀、超聲波(Sonar)感測器或3D視覺感測器(3D Camera)等〕，並由內部感測器對車體11進行位置與姿態的定位，使自動導引裝置12可在此一定位的基礎上利用外部感測器獲取的環境資訊進行位置或姿態的修正，又路徑規劃單元122係採用演算法依預先設定規劃車體移動的路徑並進行導航/導引，且該路徑導航/導引控制的方式可為固定路徑或虛擬路徑，以供轉向驅動系統13可依循預定規劃的目標路徑來驅動舵輪111，從而實現對車體11的定位及位置控制。
具體而言，無人自走車1固定路徑導航/導引控制係利用移動路徑上設立的實體標記(如電磁軌道、磁帶、反光片等)作為導引，並由自動導引裝置12之感測器模組121偵測標記對車體11進行位置與姿態的
定位，以沿著路徑規劃單元122預定規畫的目標路徑運行，包含但不限於直接坐標導引(即笛卡爾坐標導引，Cartesian Guidance)、電磁導引(Wire Guidance)、磁帶導引(Magnetic Tape Guidance)或光學導引(Optical Guidance)，而無人自走車1虛擬路徑導航/導引控制則沒有存在實體標記，係將車體11移動路徑的配置圖資料存放在資料庫或自動導引裝置12內的地圖庫路線資料，並由感測器模組121對車體11進行位置與姿態偵測，使路徑規劃單元122自行決定預定規畫的目標路徑，包含但不限於慣性導航(Inertial Navigation)、雷射導航(Laser Navigation)或超聲波導航、視覺導航(Visual Navigation)或地理導航〔如全球定位系統導航(Global Position System)〕，惟該無人自走車1路徑導航/導引控制的方式很多，在此則不作一贅述。
如第2圖所示，本發明上述無人自走車系統所採用之導引控制方法，係包括下列之實施步驟：
(S101)無人自走車1之自動導引裝置12先取得車體11中心的位置在全域坐標系中建立車輛坐標系，並進行坐標系轉換以建立本地坐標系。
(S102)計算車體11中心至預定規畫的目標路徑其中一目標點的最短距離，車體11當前的航向與車體11中心至目標點連線間之轉角，以及車體11中心至目標點的旋轉半徑。
(S103)取得車體11中心的速度，並根據車體11中心至任一個舵輪111中心的距離，計算得到車體11當前的航向與舵輪111中心間之夾角。
(S104)判斷車體11轉彎的方向，並根據餘弦定理得到二個舵輪111的旋轉半徑及轉彎時所需的轉角。
(S105)根據車體11中心的速度、旋轉半徑與角速率間的關係得到二個舵輪111的速率。
(S106)轉向驅動系統13根據計算得到的轉角及速率來控制二個舵輪111轉向至對應的位置，使車體11中心能穩定的依循目標路徑前進。
(S107)自動導引裝置12計算車體11當前的位置、旋轉半徑與目標路徑間之誤差量，並採用PID控制得到修正後的速度及旋轉半徑，再採用逆運動學反推計算車體11的速度，使轉向驅動系統13可控制二個舵輪111來修正調整該車體11當前的位置與旋轉半徑。
由圖中及上述之實施步驟可清楚得知，本發明以下說明書內容之無人自走車1較佳實施係以叉車式自動導引車為例，並利用自動導引裝置12之感測器模組121對車體11進行位置與姿態的定位，以及路徑規劃單元122產生預定規畫的目標路徑，由於車體11的驅動機構主要是利用前方一個舵輪111(即主動輪)帶有轉向的功能，並配合後方二個轉輪112(即從動輪)運行，其實際移動的路徑軌跡只和前方舵輪111轉角或航向角有關，因此只要對舵輪111的轉角或航向角進行控制，即可實現無人自走車1之路徑導引控制。
在本實施例中，係利用自動導引裝置12先在無人自走車1所處的環境中建立一個全域坐標系(Global Coordinate System)(如第3圖中之XGYG坐標平面)，並取得車體11中心(即車輛之幾何中心)在全域坐
標系中之坐標(XC，YC)作為中心點C，以及目標點P作為預定規畫的目標路徑其中一目標點，且該預定規畫的目標路徑包含直線路徑及彎曲路徑，以建立車輛坐標系(如XGMYGM坐標平面)後，再利用旋轉矩陣進行坐標系轉換建立一個本地坐標系(Local Coordinate System)(如XLYL坐標平面)可以得到：
其中該θ為車體11當前的姿態角，可表示為車輛坐標系的XGM或YGM軸旋轉到本地坐標系的XL或YL軸的角度；XC為全域坐標系的YG軸與車輛坐標系的YGM軸之間距；YC為全域坐標系的XG軸與車輛坐標系的XGM軸之間距；XG，YG為預定規畫的目標路徑其中一目標點P在全域坐標系中之坐標(X，Y)；XL，YL為目標點P在本地坐標系中之坐標(X，Y)，以定位出車體11當前的位置與姿態。
根據直角三角形的幾何關係可以得到：
其中該D為車體11在本地坐標系中的中心點C(XC，YC)至目標點P(XL，YL)的最短路徑的距離；θS為本地坐標系的YL軸順時針旋轉到目標點P上的角度，可表示為車體11當前的航向與車體11中心(即中心點C)至目標點P連線間之轉角；由於車體11前後對角設置之二個舵輪111(即左前輪111a與右後輪111b)與車體11當前的航向為保持一致平行的
方向，在D、θS已知的情況下，根據幾何關係則可以得到R為車體11中心至目標點P的旋轉半徑。
如第4圖所示，當自動導引裝置12取得車體11中心當前的位置(如x、y、θ)、最短路徑的距離D及速度V後，由於車體11中心與二個舵輪111的幾何關係皆為固定，並在V、R已知，且車體11中心至舵輪111之幾何中心的距離為d的情況下，則可以得到：
其中該W為車體11中心至任一個舵輪111(即左前輪111a或右後輪111b)中心在水平方向上固定的距離；L為車體11中心至任一個舵輪111中心在垂直方向上固定的距離；θa為車體11在本地坐標系中的YL軸逆時針旋轉到任一個舵輪111中心上的角度，可表示為車體11當前的航向與車體11中心至任一個舵輪111中心連線間之夾角；d為車體11中心至任一個舵輪111中心固定的距離。
然後，可根據車體11當前的航向與車體11中心至目標點P連線間之夾角(即轉角或航向角)θS，判斷車體11需要轉彎的方向，假設判斷車體11的轉角θS為大於0(即正號為逆時針轉彎的方向)時，根據餘弦定理則可以得到：
假設判斷車體11的轉角θS為小於0(即負號為順時針轉彎的方向)時，根據餘弦定理則可以得到：
其中該Rlf為前方舵輪111(即左前輪111a)中心至車體11中心以旋轉半徑R環繞的圓心O的距離；Rrr為後方舵輪111(即右後輪111b)中心至車體11中心以旋轉半徑R環繞的圓心O的距離；θlf為前方舵輪111(即左前輪111a)沿著旋轉半徑Rlf轉彎時所需的轉角或航向角；θrr為後方舵輪111(即右後輪111b)沿著旋轉半徑Rrr轉彎時所需的轉角或航向角。
此外，由於車體11中心以等速率圓周運動時的角速率為等於前後二個舵輪111的角速率(即ω=ωlf=ωrr)，並在車體11中心當前的速度V已知的情況下，根據車體11中心的速度(即平均速率)V、旋轉半徑R與角速率ω間的關係(即V=R＊ω)可以得到：
其中該Vf為前方舵輪111(即左前輪111a)的速率；Vr為後
方舵輪111(即右後輪111b)的速率。因此，自動導引裝置12可先求得車體11二個舵輪111(即左前輪111a與右後輪111b)依循直線路徑或彎曲路徑行進時所需的旋轉半徑Rlf、Rrr，並回推得到二個舵輪111所需的轉角θlf、θrr後，再根據速率、旋轉半徑與角速率間的關係得到二個舵輪111所需的速率Vf、Vr，便可藉由轉向驅動系統13來控制車體11之二個舵輪111轉向至對應的位置，並於車體11轉彎時可以不同的轉角與速率行進(即速度差)，使車體11中心跟隨直線路徑或彎曲路徑，從而實現對無人自走車1依循預定規劃的目標路徑運行之導引控制，並且車載控制器或自動導引裝置12內建處理器採用的轉向驅動演算法，不需經由大量複雜的運算或較長的運算處理週期，對於車載控制器或處理器的運算性能要求相對降低，也可有效地提升整體之導航效率。
請搭配參閱如第5~7圖所示，係分別為本發明目標路徑閉迴路導引控制之方塊圖、修正車體轉彎的旋轉半徑之示意圖(一)及修正車體轉彎的旋轉半徑之示意圖(二)，由圖中可清楚看出，本發明之無人自走車1可根據車體11移動狀態與自動導引裝置12所生成預定規劃的目標路徑進行PID(比例、積分與微分)控制，以形成閉迴路的控制流程，從而實現對車體11週期性循環之控制調整。
當車體11依循目標路徑進行移動時，自動導引裝置12可將車體11當前的位置與旋轉半徑進行坐標轉換，並計算出車體11當前的位置、旋轉半徑與目標路徑間之誤差量(errord及errorR)，再根據該誤差量進行PID控制得到車體11修正後的速度V*及旋轉半徑R*，便可採用逆運動學(Inverse Kinematics)以反推的方式計算車體11移動至目標路徑上所需之
速度V或加速度A，例如車體11前方舵輪111(即左前輪111a)的速率Vf、後方舵輪111(即右後輪111b)的速率Vr，以及前後二個舵輪111的加速度Af、Ar，使轉向驅動系統13可控制二個舵輪111來修正調整車體11當前的位置與旋轉半徑，如此反覆修正使車體11移動狀態符合期望的目標路徑，直到完成車體11之路徑導引控制。
在本實施例中，自動導引裝置12所生成預定規劃的目標路徑可導引車體11依循直線路徑或彎曲路徑運行，並給予車體11當前的位置與旋轉半徑，且可不斷地偵測車體11當前的位置、旋轉半徑與目標路徑間之誤差量，其中該errord為車體11當前的位置與目標路徑的最終位置直線距離之誤差量，而errorR=R-Rfalse為車體11中心的旋轉半徑與車體11偏移產生的旋轉半徑的誤差量，再進行PID控制不同的演算法可計算得到車體11修正後的速度V*=KPR＊(errord)，以及車體11修正後的旋轉半徑R*=KPR＊(R-errorR)，其中該KPR為增益量(比例係數)。
當車體11行進於彎曲路徑時，可利用調整旋轉半徑來改變車體11的轉彎幅度，例如車體11中心的旋轉半徑變大時，表示車體11已偏移到彎曲路徑外側，則車體11調整改變的轉彎幅度要變小；換言之，當車體11的旋轉半徑變小時，表示車體11已偏移到彎曲路徑內側，則車體11調整改變的轉彎幅度要變大，至於車體11中心轉彎的方向則可在演算法中作判斷，因此可利用車體11中心的旋轉半徑當作變化量來修正車體11的轉向，使車體11在偏移彎曲路徑時，能快速且準確將偏離修正，並穩定的保持在預定規劃的目標路徑上。
請同時參閱如第8~12圖所示，係分別為本發明車體進行直
線控制之示意圖、車體相對於目標路徑的姿態方向之示意圖、車體的姿態為平移前進之轉向控制示意圖、車體的姿態修正為向左轉彎之示意圖及車體的姿態修正為向右轉彎之示意圖，由圖中可清楚看出，上述之自動導引裝置12所生成預定規劃的目標路徑係利用複數目標點P0~P9來劃分成多個線段，並將多個線段連接形成一直線路徑軌跡，其中該目標點P0可表示為直線路徑的起始點，而目標點P9則可表示為直線路徑的最終點，並根據直線方程式y=ax+b依預定長度劃分，當車體11行進時，依車輛坐標系來看第一個目標點P1在車體11的左邊(如第9圖所示)，並計算得到車體11中心至該目標點P1間之夾角〔arctan(x/y)〕作為車體11之二個舵輪111的控制，也可藉此判斷車體11轉彎的方向，一般係將逆時針轉彎的方向取為正號，順時針轉彎的方向取為負號。
在本實施例中，無人自走車1係將車體11前後對角設置之二個舵輪111作為右前輪與左後輪為例，並將車體11中心(即中心點C)至目標點P1的距離作為直角三角形的斜邊，以及直角三角形的對邊與鄰邊垂直相交的點作為起始點S(如第10圖所示)，當車體11追蹤直線路徑上之目標點P1平移前進時，係先將車體11在本地坐標系中的YL軸逆時針旋轉到與起始點S至目標點P1連線形成的目標直線平行，可表示為車體11當前的航向旋轉至與目標直線平行之夾角θ，並使車體11之二個舵輪111(即右前輪與左後輪)以平移的方式旋轉至夾角θ後，假設將目標直線分割成二段，並以夾角θ為基準，根據直角三角形的幾何關係可以計算得到車體11之二個舵輪111的控制量分別為θ+arctan(x/y)，其中該x為車體11中心至起始點S的距離，y為起始點S至目標直線的中點M的距離。
此外，當車體11進行轉彎時，若是車體11的姿態偏差為大於設定角度的偏差，則二個舵輪111(即右前輪與左後輪)便需要根據車體11要修正的姿態方向將其控制量乘上負號，例如當車體11為向左轉彎時(如第11圖所示)，右前輪的控制量為θ+arctan(x/y)，左後輪的控制量為-〔θ+arctan(x/y)〕；同理，當車體11為向右轉彎時(如第12圖所示)，右前輪的控制量為-〔θ+arctan(x/y)〕，左後輪的控制量為θ+arctan(x/y)，使車體11中心能穩定的依循目標路徑前進。
上述詳細說明為針對本發明一種較佳之可行實施例說明而已，惟該實施例並非用以限定本發明之申請專利範圍，凡其他未脫離本發明所揭示之技藝精神下所完成之均等變化與修飾變更，均應包含於本發明所涵蓋之專利範圍中。
綜上所述，本發明之無人自走車之導引控制方法使用時為確實能達到其功效及目的，故本發明誠為一實用性優異之發明，為符合發明專利之申請要件，爰依法提出申請，盼 審委早日賜准本案，以保障發明人之辛苦發明，倘若 鈞局審委有任何稽疑，請不吝來函指示，發明人定當竭力配合，實感德便。
Claims (8)
- 一種無人自走車之導引控制方法，該無人自走車包括車體、自動導引裝置及轉向驅動系統，並於該車體包含前後對角設置用於驅動與控制轉向之二個舵輪及至少二個輔助用轉輪，該自動導引裝置用於對該車體進行位置與姿態的定位，並生成一預定規畫的目標路徑，以供該轉向驅動系統驅動該車體的舵輪能依循該目標路徑運行，該導引控制方法包括下列之步驟：(A)該自動導引裝置取得該車體中心的位置在全域坐標系中建立車輛坐標系，並取得該車體當前的姿態角進行坐標系轉換以建立本地坐標系；(B)計算得到該車體中心至該目標路徑其中一目標點的最短距離D，該車體當前的航向與該車體中心至該目標點連線間之轉角θS，以及該車體中心至該目標點的旋轉半徑R；(C)取得該車體中心的速度V，並根據該車體中心至該任一個舵輪中心的距離d，計算得到該車體當前的航向與該車體中心至該任一個舵輪中心連線間之夾角θa；(D)根據該車體的轉角θS判斷該車體轉彎的方向，假設θS為大於0時，根據餘弦定理得到：
(E)由於該車體中心以等速率圓周運動的角速率為等於該二個舵輪的角速率，根據該車體中心的速度V、旋轉半徑R與角速率間的關係得到：
(F)該轉向驅動系統根據該計算得到的轉角θlf、θrr及速率Vf、Vr來控制該二個舵輪轉向至對應的位置，使該車體中心能依循該目標路徑前進。 - 如請求項1所述之無人自走車之導引控制方法，其中該自動導引裝置包含用於對該車體的位置與姿態進行定位之感測器模組及用於生成該目標路徑之路徑規劃單元。
- 如請求項1所述之無人自走車之導引控制方法，其中該步驟(A)係利用旋轉矩陣進行坐標系轉換：
- 如請求項1所述之無人自走車之導引控制方法，其中該步驟(B)根據直角三角形的幾何關係得到：
- 如請求項1所述之無人自走車之導引控制方法，其中該步驟(C)根據該車體中心與該二個舵輪的幾何關係得到：
- 如請求項1所述之無人自走車之導引控制方法，其中該步驟(D)當該車體之二個舵輪的姿態為平移前進時，係先將該車體在本地坐標系中的YL軸旋轉到與一起始點至該目標點連線形成的一目標直線平行之夾角θ，並使該二個舵輪以平移的方式旋轉至該夾角θ，假設將該目標直線分割成二段，並以該夾角θ為基準，根據直角三角形的幾何關係計算得到該二個舵輪的控制量分別為θ+arctan(x/y)，其中該x為該車體中心至該起始點的距離，y為該起始點至目標直線的中點的距離。
- 如請求項6所述之無人自走車之導引控制方法，當該車體之二個舵輪的姿態為進行轉彎時，若是該車體的姿態偏差為大於設定角度的偏差，係將該二個舵輪根據該車體要修正的姿態方向將其控制量乘上負號，以供該車體為向左轉彎或向右轉彎時，其中一個該舵輪的控制量為θ+arctan(x/y)，而另一個該舵輪的控制量為-〔θ+arctan(x/y)〕。
- 如請求項1所述之無人自走車之導引控制方法，其中該步驟(F)完成該車體的二個舵輪轉向，再執行下一步驟：(G)該自動導引裝置計算該車體當前的位置、旋轉半徑與該目標路徑間之誤差量，並根據該誤差量採用PID控制得到該車體修正後的速度及旋轉半徑，再採用逆運動學以反推的方式計算該車體移動至該目標路徑上所需的速度或加速度，使該轉向驅動系統可控制該車體的二個舵輪來修正調整該車體當前的位置與旋轉半徑，直到完成該車體之路徑導引控制。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| TW110115173A TWI770966B (zh) | 2021-04-27 | 2021-04-27 | 無人自走車之導引控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| TW110115173A TWI770966B (zh) | 2021-04-27 | 2021-04-27 | 無人自走車之導引控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| TWI770966B TWI770966B (zh) | 2022-07-11 |
| TW202242580A true TW202242580A (zh) | 2022-11-01 |
Family
ID=83439345
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| TW110115173A TWI770966B (zh) | 2021-04-27 | 2021-04-27 | 無人自走車之導引控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| TW (1) | TWI770966B (zh) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| TWI844336B (zh) * | 2023-04-17 | 2024-06-01 | 財團法人精密機械研究發展中心 | 無駕駛移動載具的節能路徑的規劃方法 |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| TWI831424B (zh) * | 2022-10-20 | 2024-02-01 | 財團法人車輛研究測試中心 | 磁導式轉轍系統及磁導式轉轍方法 |
Family Cites Families (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP6769659B2 (ja) * | 2016-04-27 | 2020-10-14 | 日本電産シンポ株式会社 | 移動体の管理システム、方法、およびコンピュータプログラム |
| CN107450549A (zh) * | 2017-08-25 | 2017-12-08 | 英华达（上海）科技有限公司 | 一种agv控制系统及控制方法、agv系统 |
| TWI671066B (zh) * | 2018-01-24 | 2019-09-11 | 緯創資通股份有限公司 | 移動載具 |
| CN108279563B (zh) * | 2018-01-25 | 2019-01-29 | 武汉理工大学 | 一种速度自适应的无人车轨迹跟踪pid控制方法 |
| JP2019148881A (ja) * | 2018-02-26 | 2019-09-05 | 日本電産シンポ株式会社 | 移動体、移動体を制御する方法およびコンピュータプログラム |
| CN108710294B (zh) * | 2018-04-13 | 2021-03-05 | 四川智动木牛智能科技有限公司 | 一种无人车路径跟踪前馈控制方法 |
| CN108791289B (zh) * | 2018-04-28 | 2021-03-30 | 华为技术有限公司 | 一种车辆控制方法和装置 |
| TWI693493B (zh) * | 2019-03-11 | 2020-05-11 | 整技科技股份有限公司 | 導引載具控制系統與方法 |
| CN111213101A (zh) * | 2019-04-26 | 2020-05-29 | 深圳市大疆创新科技有限公司 | 可移动平台的巡线控制方法、设备、可移动平台及系统 |
| CN110471426B (zh) * | 2019-09-02 | 2020-11-24 | 哈尔滨工程大学 | 基于量子狼群算法的无人驾驶智能车自动避碰方法 |
-
2021
- 2021-04-27 TW TW110115173A patent/TWI770966B/zh active
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| TWI844336B (zh) * | 2023-04-17 | 2024-06-01 | 財團法人精密機械研究發展中心 | 無駕駛移動載具的節能路徑的規劃方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| TWI770966B (zh) | 2022-07-11 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN108673496B (zh) | 一种基于纯追踪模型的工业机器人路径跟踪方法 | |
| CN106020200B (zh) | 采用轮毂电机驱动的agv小车及路径规划方法 | |
| Paromtchik et al. | Motion generation and control for parking an autonomous vehicle | |
| CN112130559A (zh) | 一种基于uwb与激光雷达的室内行人跟随与避障方法 | |
| CN109144078B (zh) | 一种基于二维码导航共线双舵轮agv路线纠偏方法及系统 | |
| CN205880660U (zh) | 一种采用轮毂电机驱动的agv小车 | |
| CN111679676A (zh) | 一种agv运动轨迹控制方法 | |
| CN111634331B (zh) | 一种自动驾驶车辆的转向控制方法、装置及系统 | |
| WO2022252220A1 (zh) | 一种多轴线平板车精准停靠系统及方法 | |
| CN110320906A (zh) | 一种基于麦克纳姆轮的四驱agv小车差速直线行驶姿态调整方法 | |
| CN112666934A (zh) | 一种汽车搬运agv控制系统、调度系统及控制方法 | |
| CN214846390U (zh) | 基于自动导引小车的动态环境避障系统 | |
| TWI770966B (zh) | 無人自走車之導引控制方法 | |
| CN116300871A (zh) | 一种工业移动机器人的路径跟踪方法 | |
| CN114371702B (zh) | 一种应用于视觉伺服的非线性模型预测控制方法 | |
| JPH02105904A (ja) | 移動体の誘導方法及びその装置 | |
| JP4264399B2 (ja) | 無人搬送車 | |
| CN115237110B (zh) | 一种运输导航机器人及其航向修正方法 | |
| Juntao et al. | Research of AGV positioning based on the two-dimensional Code Recognition Method | |
| TWI770965B (zh) | 無人自走車之導引控制方法 | |
| CN115431969B (zh) | 无人自走车的导引控制方法 | |
| Fnadi et al. | Local obstacle-skirting path planning for a fast Bi-steerable rover using bézier curves | |
| CN106325269A (zh) | 基于里程计和磁传感器的两轮平衡车路径校正装置及方法 | |
| CN115437362A (zh) | 无人自走车的导引控制方法 | |
| JP4269170B2 (ja) | 軌道追従制御方法および装置 |