色哟哟视频在线观看-色哟哟视频在线-色哟哟欧美15最新在线-色哟哟免费在线观看-国产l精品国产亚洲区在线观看-国产l精品国产亚洲区久久

0
  • 聊天消息
  • 系統消息
  • 評論與回復
登錄后你可以
  • 下載海量資料
  • 學習在線課程
  • 觀看技術視頻
  • 寫文章/發帖/加入社區
會員中心
創作中心

完善資料讓更多小伙伴認識你,還能領取20積分哦,立即完善>

3天內不再提示

一種新型基于多點預瞄的最優路徑跟蹤控制方法

ml8z_IV_Technol ? 來源:lq ? 2019-01-07 17:03 ? 次閱讀

摘要:為在嵌入式控制器開發環境下提高智能車輛的路徑跟蹤精度,采用車輛動力學模型和多點道路預瞄模型,以 預瞄窗口內的跟蹤偏差為目標函數,結合 LQR 最優控制原理,提出了一種基于多點預瞄最優控制路徑跟蹤控制方法。針對實車應用,通過離線計算最優增益的方法,提高算法實時性。在仿真及紅旗 H7 實車環境下進行試驗,結果顯示,該方法在保證跟蹤精度的同時具有良好的算法實時性。

1.前言

路徑跟蹤作為自動駕駛系統中的關鍵執行層控制技術,是影響智能車輛安全性與舒適性的關鍵技術[1-3]。常見的路徑跟蹤方法按照使用模型不同可分為基于幾 何/運動學模型的方法和基于動力學模型的方法,其中 基于幾何/運動學模型的方法,通常將車輛簡化為四輪 機器人剛性結構,由于相對簡單計算量小,已有較多實 車應用,如名古屋大學的自動駕駛開源項目Autoware 中使用的純跟蹤方法[4]。

基于動力學模型的方法,考慮車 輛輪胎側偏等動力學特性,通常結合最優控制理論,如線性二次型調節器(LQR)[5]、模型預測控制(MPC)[6]等。百度的自動駕駛開源項目Apollo 中橫向控制器即提供了LQR 和MPC 兩種方法[7]。LQR 方法未考慮預瞄前方目標路徑,易出現跟蹤偏差較大問題;MPC方法需要消耗大量計算資源,在車輛嵌入式控制器的計算環境中難以實現。而基于預瞄的LQR控制方法[8],既能夠綜合考慮前方路徑特征,又不需要在線優化求解占用大量計算 資源,具有較強的嵌入式環境實車應用價值。

因此,本文在文獻[8]LQR預瞄控制方法的基礎上, 提出了一種新型基于多點預瞄的最優路徑跟蹤控制方 法,改進了道路模型中的預瞄偏差計算方式,以及采用 離線計算最優增益的方法,提高了算法的適應性及實時 性,更加適合實車路徑跟蹤控制應用。

2.車輛及道路預瞄模型

2.1車輛動力學模型

本文采用的車輛動力學模型如圖1 所示,假設車輛是一個在平面內沿一定速度向前行駛的剛體,可通過前輪轉角進行橫擺旋轉和側向平移運動。

圖1 車輛動力學模型

通過如圖1 所示的幾何關系,可推導出前后軸的側偏角αf、αr關系式:

式中,y為車輛橫向位置;a、b分別為車輛質心到前后軸的距離;ψ為車輛航向角;u為車輛縱向速度;δsw為轉向盤轉角;isteer為轉向傳動比。

然后由車輛前后軸的側偏剛度Cf、Cr ,可知前后軸的側向力Fvf、Fvr:

最后,根據牛頓第二定律進行側向力和橫擺力矩分析即可得到式(5)所示的動力學狀態方程。

式中:

其中,M為整車質量;I為車輛繞 Z軸橫擺的轉動慣量。

式(5)狀態方程為連續量,在控制器中采用的是離散數字控制,需要根據實際采樣時間T 對狀態方程進行離散化處理,如式(6)所示:

式中:

由此狀態方程即可確定車輛在一定速度下轉向盤轉角作為控制量,對車輛橫向位置及橫擺角速度狀態產生的影響。

2.2 道路預瞄模型

圖2(a)所示的為文獻[8]所使用的道路預瞄模型,以道路在局部坐標系下的未來n個周期的參考y軸方向橫向偏移作為道路狀態量,當前車輛在局部坐標系中的橫向坐標為y,朝向角為ψ,假設車輛縱向速度u恒定,當前車輛坐標為 y,第一個道路狀態量即為 yr0,第二個狀態量即車輛沿 x 軸方向移動 uT 后,對應的道路 y 坐標,即為圖中的yr1,以此類推再下一周期同樣x向移動uT,狀態量變為yr2,yr3,yrn。

此模型采用的局部坐標系方向固定不變,車體坐標 系與局部坐標系夾角位置關系隨著車輛運動不斷變化, 當車輛朝向角與x軸夾角過大時,車輛的每一時刻x向參考位置的變化將與uT 差別較大,使得算法對于這種情況的適應性較差。因此本文的局部坐標系直接采用車體坐標系作為參考,車輛的初始y向坐標為0,航向角ψ也為0,這樣車輛沿x軸的參考位置uT對應橫向參考坐標隨著車體坐標系的不斷變化而不斷變化,縱向速度假設更加合理,算法適應性更強。

圖2 道路預瞄關系圖

對于車輛而言,k時刻的道路狀態yrn即為k+1時刻的道路狀態yrn-1,只需將前一時刻的道路狀態整體向前移動一個周期,同時補充最后一時刻的狀態yr_n+1,可將道路狀態整理為如下矩陣形式:

式中:

3.LQR最優預瞄控制

整合第2 章的車輛模型和道路預瞄模型的狀態方程(6)和(7),可得下式:

此狀態方程僅描述了車輛和道路間狀態量的變化關系,而車輛和道路則需要通過式(9)所示的目標函數產生關聯:

式中:

該目標函數為LQR 標準的二次型形式,一共包含兩項,第一項目標為路徑跟蹤的橫向與角度的綜合偏差,C矩陣的第一行與式(8)的狀態相乘,即連接了車輛的y軸坐標與道路參考點的y 軸坐標差,得到車輛橫向偏差;第二行連接了車輛的航向角與道路朝向角的差, 得到車輛角度偏差,同時Q矩陣中的兩個元素q1和q2決定了橫向偏差與角度偏差的權重;第二項表示控制量轉 向盤轉角的懲罰項,目的為減少轉向盤轉角輸出,提高系統穩定性,R為該項權重標量。

由上述目標函數和線性狀態方程,即可構成標準的離散LQR 控制問題,從而求得由最優增益 K 和狀態量[X(k),yr(k)]T構成的最優控制量u(k):

最優增益K=[R+BTPB]-1BTPA,其中P矩陣可通過代數黎卡提方程求解:

當道路預瞄窗口較大時,上述矩陣維數將明顯增多, 求解黎卡提方程將消耗較多計算資源,在嵌入式硬件環 境中實時求解難度較大。通過對最優增益矩陣中的元素 進行分析,可以發現只有車速u是動態變化的,其他元素均為車輛固有參數,因此,本文采用離線計算不同速度u下的增益矩陣K,然后通過在線查表的方式使用與當前車速u最鄰近的離線增益K,然后與當前車輛狀態、道路狀態[X(k),yr(k)]T按式(10)計算即可獲得控制輸出轉向盤轉角,大幅提升算法實時性。

4.仿真及實車驗證

4.1仿真結果

為驗證本文算法的跟蹤精度與算法實時性,在CarSim 和Simulink 聯合仿真的環境下,將本文方法與文獻[9]所提出的模型預測控制方法進行了對比測試,仿真對比結果見圖3 和圖4。

仿真所使用的為CarSim中的車輛,其質量為1 723 kg,轉動慣量為4175kg·m2,質心距前后軸距分別為1.232m和1.468m,前后軸側偏剛度分別為119552N/rad和109 548 N/rad。

仿真試驗工況選用雙移線軌跡進行車輛路徑跟蹤能力測試。分別選用常規小側向力工況和達到路面附著極限的工況進行仿真,縱向速度分別為 60km/h和80km/h,路面附著系數為1,控制周期為20ms,MPC控制器的預測時域和控制時域均為50,權重矩陣Q和R的取值與文獻[9]中保持一致;本文LQR控制器預瞄周期也為1s,權重矩陣系數q1=0.001,q2=0,R=1。

圖4 側向加速度仿真結果曲線

從路徑跟蹤結果中可以看出60km/h時LQR控制器與MPC控制器均能較好的跟蹤目標路徑,其中LQR控制器的最大跟蹤偏差為0.36m,而MPC控制器的最大跟蹤偏差為0.64m;而圖4中可以看出最大側向加速度約為0.7g,尚未達到路面附著極限,提出的LQR控制器能夠較好地跟蹤目標路徑;而在80km/h的仿真試驗可以看出最大側向加速度達到1g左右,已經達到了路面附著極限,LQR控制器由于不具有MPC控制器的側偏角約束,未能保持車輛穩定性,出現側滑現象。另一方面,本文提出的LQR控制器與MPC控制器仿真單步運行時間分別為8.5ms和89ms,LQR方法具有明顯的實時性優勢。由此可見,本文提出的LQR控制器由于具有與MPC 控制器相同的優化目標,較為適合實車在附著良好的且未達到附著極限的行駛工況下進行實時控制。

4.2實車試驗

實車控制器采用的是MicroAutoBox快速原型,LQR控制方法可在該平臺下良好地實時運行,傳感器為RTK- IMU 組合導航記錄位姿,目標路徑采用人工駕駛過程中錄制組合導航的位置姿態數據,試驗場地為一汽NBD 園區內,試驗車輛為紅旗H7 摯途試驗車,如圖5 所示。

圖5 紅旗H7 摯途試驗車

園區內試驗最大車速為30km/h,覆蓋了長直線、長彎、環島和直角彎等城市道路典型工況,試驗結果如圖6所示,整車最大側向加速度在0.2 g 以內,橫向控制偏差在0.35 m 以內,具有良好的跟蹤精度;以120 s 附近的過環島工況為例,轉向盤最大轉角為281°,路徑跟蹤的最大橫向偏差為0.28m,轉向盤轉動較為平穩。

圖6 實車路徑跟蹤結果曲線

圖7所示為LQR控制器在彎曲道路換道工況下的實車路徑跟蹤結果圖,圖7a 所示為參考路徑和跟蹤路徑,車速及跟蹤的橫向偏差如圖7b所示,換道時車速約為60km/h,整體跟蹤偏差在0.3m以內,最大側向加速度約3.2m/s2。說明本文方法適合在實車嵌入式實時環境下,平穩地控制車輛實現良好精度的路徑跟蹤功能。

圖7 彎曲道路換道工況路徑跟蹤結果圖

5.結束語

本文針對嵌入式控制器環境下的智能車輛路徑跟蹤問題,基于LQR 最優控制方法并采用離線優化的方式,提出了一種基于多點預瞄最優路徑跟蹤控制方法, 構建了車輛及道路預瞄模型。仿真及實車試驗表明該 方法能夠適應常規工況下實車路徑跟蹤控制,具有良好 的跟蹤精度。下一步研究將針對輪胎和路面附著極限 工況下,優化輪胎模型,約束最終控制量輸出保證車輛 穩定性,提高算法對極限工況的適應能力。

聲明:本文內容及配圖由入駐作者撰寫或者入駐合作網站授權轉載。文章觀點僅代表作者本人,不代表電子發燒友網立場。文章及其配圖僅供工程師學習之用,如有內容侵權或者其他違規問題,請聯系本站處理。 舉報投訴
  • 傳感器
    +關注

    關注

    2550

    文章

    51041

    瀏覽量

    753097
  • 控制器
    +關注

    關注

    112

    文章

    16335

    瀏覽量

    177818
  • 嵌入式
    +關注

    關注

    5082

    文章

    19107

    瀏覽量

    304836

原文標題:基于多點預瞄最優控制的智能車輛路徑跟蹤

文章出處:【微信號:IV_Technology,微信公眾號:智車科技】歡迎添加關注!文章轉載請注明出處。

收藏 人收藏

    評論

    相關推薦

    一種新型的電力負荷控制與監測系統的設計方法

    本文著重給出了一種新型的電力負荷控制與監測系統的設計方法。該方法在性能可靠、高精度、低功耗、小體積的基礎上,更能適應負荷管理、電能分析、電量
    發表于 04-12 06:56

    一種結構化道路環境中的視覺導航系統詳解

    根據結構化道路環境的特點提出了一種將邊沿檢測和道路環境知識相結合的機器視覺算法 , 并結合基于行為響應的路徑規劃方法和智能
    發表于 09-25 07:23

    一種新型多點測溫系統的設計(基于DS18B20設計的多點測溫

    一種新型多點測溫系統的設計(基于DS18B20設計的多點測溫系統) 介紹DS18B20的基本特性,和基于DS18B20設計的多點測溫系統。
    發表于 10-15 23:50 ?1989次閱讀
    <b class='flag-5'>一種</b><b class='flag-5'>新型</b><b class='flag-5'>多點</b>測溫系統的設計(基于DS18B20設計的<b class='flag-5'>多點</b>測溫

    一種多點脈搏信號檢測方法

    一種多點脈搏信號檢測方法:
    發表于 03-30 15:41 ?22次下載
    <b class='flag-5'>一種</b><b class='flag-5'>多點</b>脈搏信號檢測<b class='flag-5'>方法</b>

    一種配電網拓撲跟蹤方法及其應用

    為了滿足實時跟蹤的需求,在分析了3配電網拓撲跟蹤算法的基礎上,提出了一種電網全局以母線為節點遍歷和設備單元局部更新相結合的新型實時
    發表于 05-27 16:39 ?19次下載
    <b class='flag-5'>一種</b>配電網拓撲<b class='flag-5'>跟蹤</b><b class='flag-5'>方法</b>及其應用

    一種新型SVPWM調制方法的研究與實現

    一種新型SVPWM調制方法的研究與實現。
    發表于 03-30 14:40 ?7次下載

    一種新型的電刷調整方法

    一種新型的電刷調整方法_周國玉
    發表于 01-02 16:09 ?0次下載

    一種新的光伏系統最大功率跟蹤控制方法_趙志

    一種新的光伏系統最大功率跟蹤控制方法_趙志
    發表于 01-08 10:18 ?2次下載

    一種基于最優路徑的物流管理與監督系統設計

    之間的響應,從而對配送過程進行監控。同時結合物流配送的油耗、路徑等各方面因素,提出一種最優路徑配送算法,實現對物流配送的最佳路徑選擇。最后通
    發表于 11-13 14:23 ?4次下載
    <b class='flag-5'>一種</b>基于<b class='flag-5'>最優</b><b class='flag-5'>路徑</b>的物流管理與監督系統設計

    基于路徑跟蹤方法路徑規劃算法

    為解決拖掛式移動機器人系統路徑規劃算法精準性低、穩定性差和無法考慮系統間安全性等的問題,提出一種基于路徑跟蹤方法
    發表于 12-04 14:18 ?6次下載
    基于<b class='flag-5'>路徑</b><b class='flag-5'>跟蹤</b><b class='flag-5'>方法</b>的<b class='flag-5'>路徑</b>規劃算法

    自主泊車路徑規劃方法

    目前對泊車方法的相關研究僅適用于平行泊車和垂直泊車中的一種泊車場景。為此,提出通用性的自主泊車路徑規劃方法。該方法融合車輛運動學約束和
    發表于 02-24 10:36 ?16次下載
    自主泊車<b class='flag-5'>路徑</b>規劃<b class='flag-5'>方法</b>

    一種多諧振最優伺服控制算法在中頻電源設計中應用

    針對標準線性二次型調節器( LQR)不能無靜差跟蹤參考以及比例諧振(PR)控制器帶非線性負載時輸出電壓總諧波畸變率過高的問題,提出一種多諧振最優伺服
    發表于 04-24 17:23 ?8次下載
    <b class='flag-5'>一種</b>多諧振<b class='flag-5'>最優</b>伺服<b class='flag-5'>控制</b>算法在中頻電源設計中應用

    一種用于彈道跟蹤新型非線性制導邏輯

    一種用于彈道跟蹤新型非線性制導邏輯
    發表于 06-30 09:42 ?0次下載

    自動駕駛路徑跟蹤控制之純追蹤控制

    就在于, 軌跡還包含了時間信息,軌跡點也是一種路徑點,它在路徑點的基礎上加入了 時間約束。 目前的主流軌跡跟蹤方法分為兩類: 基于幾何追蹤
    發表于 06-02 15:15 ?1次下載
    自動駕駛<b class='flag-5'>路徑</b><b class='flag-5'>跟蹤</b><b class='flag-5'>控制</b>之純追蹤<b class='flag-5'>控制</b>

    一種新型的最大功率跟蹤實現方法在太陽能充電器中的應用

    電子發燒友網站提供《一種新型的最大功率跟蹤實現方法在太陽能充電器中的應用.pdf》資料免費下載
    發表于 11-02 11:12 ?4次下載
    <b class='flag-5'>一種</b><b class='flag-5'>新型</b>的最大功率<b class='flag-5'>跟蹤</b>實現<b class='flag-5'>方法</b>在太陽能充電器中的應用
    主站蜘蛛池模板: 国产又黄又硬又粗| 青草伊人久久| 日本午夜福利无码高清| 99视频在线观看免费| 欧美18在线| 中文在线日韩亚洲制服| 黄色一级毛片免费| 中文字幕亚洲无线码在线| 久久xxxx| caoporn超碰在线| 桃花免费高清在线观看| 久久久97人妻无码精品蜜桃| 4399日本电影完整版在线观看免费| 极品色αv影院| 亚洲免费视频观看| 久久re这里视频只有精品首页| 久99久热只有精品国产99| 伊人热| 暖暖视频免费高清在线观看 视频 暖暖视频大全免费观看 | 丝瓜影院观看免费高清国际观察| seyeye高清视频在线| 人妻免费久久久久久久了| 2020年国产理论| 亚洲AV综合99一二三四区| 女人久久WWW免费人成看片| 国产人妻人伦精品熟女麻豆| 5g在线视讯年龄确认海外禁止进入 | 中国人泡妞www免费| 四虎永久在线精品国产| 色婷婷综合久久久中文字幕 | WWW污污污抽搐喷潮COM| caoporn 在线视频| 宝贝乖女好紧好深好爽老师| 菠萝菠萝蜜视频在线看1| 国产AV一区二区三区传媒| 国产高清视频在线观看不卡v | 中文字幕日本一区| 我的好妈妈8高清在线观看WWW| 狼与美女谐音歌词| 扒开双腿疯进出爽爽爽动态图| 久久 这里只精品 免费|