基于模型預測控制的移動機器人路徑跟蹤控制
發(fā)布時間：2019-03-13 12:14
【摘要】：在控制理論中,路徑跟蹤(Path Following)是繼設定點鎮(zhèn)定、軌跡跟蹤之后一類重要的運動控制問題。同軌跡跟蹤相比,路徑跟蹤控制器需要同時確定待跟蹤期望路徑的信息和控制運動對象的系統(tǒng)動態(tài)。路徑跟蹤控制廣泛存在于數(shù)控機床跟蹤磨削、移動機器人運動控制、飛機或輪船的航跡控制和智能車自主駕駛等領域,對路徑跟蹤及其分支問題進行研究,不僅可以豐富運動控制的理論成果,還可以滿足多領域?qū)\動控制技術(shù)越來越高的要求,具有重大的理論和工程意義。輪式移動機器人是非線性約束系統(tǒng)的典型代表,本文將其選擇為運動控制對象,對其路徑跟蹤控制問題進行了研究。同其他控制方法相比,非線性模型預測控制(Nonlinear Model Predictive Control,NMPC)具有滾動優(yōu)化和反饋校正的機理,能夠處理系統(tǒng)的狀態(tài)約束和輸入約束。本文將NMPC控制方案應用于輪式移動機器人的運動控制,實現(xiàn)了機器人對期望路徑的跟蹤控制。本文按照如下的系統(tǒng)設計步驟完成了輪式移動機器人路徑跟蹤控制系統(tǒng)的設計:問題描述、建立被控對象數(shù)學模型、依據(jù)控制目標設計控制器、閉環(huán)系統(tǒng)穩(wěn)定性分析和仿真驗證。本文首先對路徑跟蹤控制進行了問題描述,推導并建立了輪式移動機器人的運動學模型,確立了路徑跟蹤的控制任務。在本文中,存在路徑跟蹤任務的輪式移動機器人是Unicycle型機器人,它由兩個獨立驅(qū)動后輪和一個萬向輪構(gòu)成,機械結(jié)構(gòu)簡單,運動形式靈活可控。分析所建立的數(shù)學模型,本文的運動控制對象在本質(zhì)上屬于非線性、多輸入多輸出,同時具有狀態(tài)和輸入約束的系統(tǒng)。然后,針對具有非線性動態(tài)和約束條件的控制任務,本文建立了基于NMPC方案的閉環(huán)控制結(jié)構(gòu),給出了開環(huán)優(yōu)化問題具體的數(shù)學形式和程序求解步驟,并對優(yōu)化問題的可行性和系統(tǒng)的性能進行了分析。本文基于非線性多面體描述和線性矩陣不等式求解了保證NMPC方案可行性和收斂性的非零終端要素,并通過仿真實驗對比分析了基于終端不等式約束的NMPC和基于終端等式約束的NMPC在系統(tǒng)動態(tài)和計算負擔方面的不同特點。仿真實驗表明,基于終端不等式約束的NMPC和基于終端等式約束的NMPC均可使移動機器人在容許控制輸入的作用下跟蹤參考路徑。但基于終端不等式約束的NMPC控制方案只能解決光滑路徑的跟蹤問題,而基于終端等式約束的NMPC控制方案計算負擔重、在線求解時間長。另外,由于期望路徑是實時變化的,路徑跟蹤問題的本質(zhì)具有時變性。無論是基于非零終端的NMPC還是基于零終端NMPC,它們的終端域都是固定形式的,在整個優(yōu)化問題求解的過程中始終保持不變,這對于時變的路徑跟蹤問題而言具有保守性。因此本文最后設計了基于時變終端的NMPC方案,以解決上述問題。仿真結(jié)果表明時變終端不僅兼顧了路徑跟蹤問題的時變實質(zhì)和控制需求,并且系統(tǒng)的終端域得以擴大。
[Abstract]:In control theory, path tracking (Path Following) is an important motion control problem after stabilization and trajectory tracking. Compared with the trajectory tracking, the path tracking controller needs to determine the desired path information and control the system dynamics of the moving object at the same time. Path tracking control is widely used in CNC machine tool tracking grinding, mobile robot motion control, aircraft or ship track control, intelligent vehicle autonomous driving and other fields. Path tracking and its branches are studied. It can not only enrich the theoretical results of motion control, but also meet the increasing requirements of motion control technology in many fields, which is of great theoretical and engineering significance. Wheeled mobile robot is a typical representative of nonlinear constrained system. In this paper, the path tracking control problem of wheeled mobile robot is studied by choosing it as a motion control object. Compared with other control methods, nonlinear model predictive control (Nonlinear Model Predictive Control,NMPC) has the mechanism of rolling optimization and feedback correction, and can deal with the state constraints and input constraints of the system. In this paper, the NMPC control scheme is applied to the motion control of wheeled mobile robot, and the desired path tracking control of the robot is realized. In this paper, the path tracking control system of wheeled mobile robot is designed according to the following system design steps: the problem description, the establishment of the mathematical model of the controlled object, and the design of the controller according to the control target. Stability analysis and simulation verification of closed-loop system. This paper first describes the problem of path tracking control, deduces and establishes the kinematics model of wheeled mobile robot, and establishes the control task of path tracking. In this paper, the wheeled mobile robot with path tracking task is Unicycle type robot. It consists of two independent driving rear wheels and one universal wheel. The mechanical structure is simple and the motion form is flexible and controllable. By analyzing the established mathematical model, the motion control object in this paper is in essence nonlinear, multi-input and multi-output system with state and input constraints at the same time. Then, for the control task with nonlinear dynamic and constrained conditions, a closed-loop control structure based on NMPC scheme is established, and the specific mathematical form and program solving steps of open-loop optimization problem are given. The feasibility of the optimization problem and the performance of the system are analyzed. Based on the description of nonlinear polyhedron and linear matrix inequality, the non-zero terminal elements which guarantee the feasibility and convergence of NMPC scheme are solved in this paper. The different characteristics of NMPC based on terminal inequality constraint and NMPC based on terminal equality constraint in the aspects of system dynamics and computational burden are compared and analyzed by simulation experiments. Simulation results show that both NMPC based on terminal inequality constraint and NMPC based on terminal equality constraint can track the reference path of mobile robot under the action of allowable control input. However, the NMPC control scheme based on terminal inequality constraints can only solve the tracking problem of smooth paths, while the NMPC control scheme based on terminal equality constraints has a heavy computational burden and takes a long time to solve on-line. In addition, because the desired path is real-time varying, the nature of the path tracking problem is time-varying. Whether NMPC based on non-zero terminal or NMPC, based on zero terminal, their terminal domain is fixed and remains the same in the whole optimization process, which is conservative for time-varying path tracking problem. Finally, this paper designs a NMPC scheme based on time-varying terminals to solve the above problems. The simulation results show that the time-varying terminal not only takes into account the time-varying nature and control requirements of the path tracking problem, but also expands the terminal domain of the system.
【學位授予單位】：吉林大學
【學位級別】：碩士
【學位授予年份】：2016
【分類號】：TP242
本文編號：2439380
[Abstract]:In control theory, path tracking (Path Following) is an important motion control problem after stabilization and trajectory tracking. Compared with the trajectory tracking, the path tracking controller needs to determine the desired path information and control the system dynamics of the moving object at the same time. Path tracking control is widely used in CNC machine tool tracking grinding, mobile robot motion control, aircraft or ship track control, intelligent vehicle autonomous driving and other fields. Path tracking and its branches are studied. It can not only enrich the theoretical results of motion control, but also meet the increasing requirements of motion control technology in many fields, which is of great theoretical and engineering significance. Wheeled mobile robot is a typical representative of nonlinear constrained system. In this paper, the path tracking control problem of wheeled mobile robot is studied by choosing it as a motion control object. Compared with other control methods, nonlinear model predictive control (Nonlinear Model Predictive Control,NMPC) has the mechanism of rolling optimization and feedback correction, and can deal with the state constraints and input constraints of the system. In this paper, the NMPC control scheme is applied to the motion control of wheeled mobile robot, and the desired path tracking control of the robot is realized. In this paper, the path tracking control system of wheeled mobile robot is designed according to the following system design steps: the problem description, the establishment of the mathematical model of the controlled object, and the design of the controller according to the control target. Stability analysis and simulation verification of closed-loop system. This paper first describes the problem of path tracking control, deduces and establishes the kinematics model of wheeled mobile robot, and establishes the control task of path tracking. In this paper, the wheeled mobile robot with path tracking task is Unicycle type robot. It consists of two independent driving rear wheels and one universal wheel. The mechanical structure is simple and the motion form is flexible and controllable. By analyzing the established mathematical model, the motion control object in this paper is in essence nonlinear, multi-input and multi-output system with state and input constraints at the same time. Then, for the control task with nonlinear dynamic and constrained conditions, a closed-loop control structure based on NMPC scheme is established, and the specific mathematical form and program solving steps of open-loop optimization problem are given. The feasibility of the optimization problem and the performance of the system are analyzed. Based on the description of nonlinear polyhedron and linear matrix inequality, the non-zero terminal elements which guarantee the feasibility and convergence of NMPC scheme are solved in this paper. The different characteristics of NMPC based on terminal inequality constraint and NMPC based on terminal equality constraint in the aspects of system dynamics and computational burden are compared and analyzed by simulation experiments. Simulation results show that both NMPC based on terminal inequality constraint and NMPC based on terminal equality constraint can track the reference path of mobile robot under the action of allowable control input. However, the NMPC control scheme based on terminal inequality constraints can only solve the tracking problem of smooth paths, while the NMPC control scheme based on terminal equality constraints has a heavy computational burden and takes a long time to solve on-line. In addition, because the desired path is real-time varying, the nature of the path tracking problem is time-varying. Whether NMPC based on non-zero terminal or NMPC, based on zero terminal, their terminal domain is fixed and remains the same in the whole optimization process, which is conservative for time-varying path tracking problem. Finally, this paper designs a NMPC scheme based on time-varying terminals to solve the above problems. The simulation results show that the time-varying terminal not only takes into account the time-varying nature and control requirements of the path tracking problem, but also expands the terminal domain of the system.
【學位授予單位】：吉林大學
【學位級別】：碩士
【學位授予年份】：2016
【分類號】：TP242
【參考文獻】
相關期刊論文 前10條
1 楊震;劉繁明;王巖;;欠驅(qū)動船舶路徑跟蹤的神經(jīng)滑�？刂芠J];中國造船;2015年02期
2 劉楊;劉美杰;;基于領導跟隨的欠驅(qū)動船舶編隊跟蹤控制[J];控制工程;2013年05期
3 崔明月;孫棣華;李永福;劉衛(wèi)寧;;輪子縱向打滑條件下的移動機器人自適應跟蹤控制[J];控制與決策;2013年05期
4 孫棣華;崔明月;李永福;;具有參數(shù)不確定性的輪式移動機器人自適應backstepping控制[J];控制理論與應用;2012年09期
5 ;Adaptive tracking control for uncertain dynamic nonholonomic mobile robots based on visual servoing[J];Journal of Control Theory and Applications;2012年01期
6 劉楊;郭晨;沈智鵬;劉雨;郭迪;;欠驅(qū)動船舶路徑跟蹤的神經(jīng)網(wǎng)絡穩(wěn)定自適應控制[J];控制理論與應用;2010年02期
7 羅偉林;鄒早建;李鐵山;;基于神經(jīng)網(wǎng)絡和L_2增益的船舶航向自動舵設計[J];中國造船;2009年02期
8 于樹友;陳虹;張鵬;李學軍;;一種基于LMI的非線性模型預測控制終端域優(yōu)化方法[J];自動化學報;2008年07期
9 袁長清;李俊峰;王天舒;寶音賀西;;航天器編隊飛行多目標姿態(tài)快速跟蹤魯棒控制[J];應用數(shù)學和力學;2008年02期
10 荊武興 ,徐世杰;噴嘴為執(zhí)行機構(gòu)的空間飛行器基于誤差四元數(shù)的非線性姿態(tài)跟蹤控制(英文)[J];Chinese Journal of Aeronautics;2002年03期
相關會議論文 前1條
1 謝文靜;馬保離;;不確定輪式移動機器人的自適應集合鎮(zhèn)定[A];第二十九屆中國控制會議論文集[C];2010年
相關博士學位論文 前4條
1 于浩;非完整輪式移動機器人運動規(guī)劃與控制研究[D];中國海洋大學;2014年
2 馬海濤;非完整輪式移動機器人的運動控制[D];中國科學技術(shù)大學;2009年
3 王鴻鵬;復雜環(huán)境下輪式自主移動機器人定位與運動控制研究[D];南開大學;2009年
4 祝曉才;輪式移動機器人的運動控制[D];國防科學技術(shù)大學;2006年
相關碩士學位論文 前4條
1 劉蕊;智能車路徑跟蹤及其底層控制方法研究[D];北京工業(yè)大學;2013年
2 程英英;基于微分平坦的輪式移動機器人軌跡規(guī)劃[D];吉林大學;2008年
3 王虎;基于滾動優(yōu)化的輪式移動機器人軌跡跟蹤控制[D];吉林大學;2007年
4 唐述博;非完整移動機器人點鎮(zhèn)定和軌跡跟蹤控制研究[D];大連理工大學;2005年
，本文編號：2439380
本文鏈接：http://sikaile.net/kejilunwen/zidonghuakongzhilunwen/2439380.html
最近更新
教材專著
