什么是路徑規(guī)劃? 路徑規(guī)劃(也叫運動學規(guī)劃),任務(wù)是確定控制輸入,以驅(qū)動機器人從初始配置和速度到目標配置和速度,同時服從基于物理的動力學模型,且能確保機器人在環(huán)境中避開障礙。說白了,就是給你一張地圖,且已知障礙物分布,以及起始點和目標點的坐標,希望你根據(jù)這些信息,找到一條從起點到終點的能繞開障礙物的有效路徑,如果可以,還希望這條有效路徑盡可能最優(yōu)(最短),并且希望找到這條有效路徑的時間盡可能短(算法足夠高效) 目前流行的路徑規(guī)劃分為兩大類:基于采樣的路徑規(guī)劃和基于搜索的路徑規(guī)劃。運動規(guī)劃的狀態(tài)空間是應用于機器人變換的集合,稱為位姿空間(configuration space),引入了 C-空間、C-空間障礙物、自由空間等一系列概念,下面介紹一些概念:位姿(configuration)機器人一個位姿指的是一組相互獨立的參數(shù)集,它能完全確定機器人上所有的點在工作空間 W 中的位置,這些參數(shù)用來完整描述機器人在工作空間 W 中的狀態(tài)。一個位姿通常表示為帶有位置和方向參數(shù)的一個向量(vector),用 q 表示。自由度(degrees of freedom)機器人的自由度定義為機器人運動過程中決定其運動狀態(tài)的所有獨立參數(shù)的數(shù)目,即 q 的維數(shù)。位姿空間(configuration space)位姿空間是機器人所有可能位姿組成的集合,代表了機器人所有可能的運動結(jié)果,稱為 C-空間,也可簡記為 C。距離函數(shù)(distance function)C-空間中的距離函數(shù)定義為該空間中的一個映射