什么是路徑規(guī)劃？

        路徑規(guī)劃（也叫運(yùn)動(dòng)學(xué)規(guī)劃），任務(wù)是確定控制輸入，以驅(qū)動(dòng)機(jī)器人從初始配置和速度到目標(biāo)配置和速度，同時(shí)服從基于物理的動(dòng)力學(xué)模型，且能確保機(jī)器人在環(huán)境中避開障礙。說白了，就是給你一張地圖，且已知障礙物分布，以及起始點(diǎn)和目標(biāo)點(diǎn)的坐標(biāo)，希望你根據(jù)這些信息，找到一條從起點(diǎn)到終點(diǎn)的能繞開障礙物的有效路徑，如果可以，還希望這條有效路徑盡可能最優(yōu)（最短），并且希望找到這條有效路徑的時(shí)間盡可能短（算法足夠高效）

        目前流行的路徑規(guī)劃分為兩大類：基于采樣的路徑規(guī)劃和基于搜索的路徑規(guī)劃。

運(yùn)動(dòng)規(guī)劃的狀態(tài)空間是應(yīng)用于機(jī)器人變換的集合，稱為位姿空間（configuration space），引入了 C-空間、C-空間障礙物、自由空間等一系列概念，下面介紹一些概念：

位姿（configuration）

機(jī)器人一個(gè)位姿指的是一組相互獨(dú)立的參數(shù)集，它能完全確定機(jī)器人上所有的點(diǎn)在工作空間 W 中的位置，這些參數(shù)用來完整描述機(jī)器人在工作空間 W 中的狀態(tài)。一個(gè)位姿通常表示為帶有位置和方向參數(shù)的一個(gè)向量(vector)，用 q 表示。

自由度（degrees of freedom）

機(jī)器人的自由度定義為機(jī)器人運(yùn)動(dòng)過程中決定其運(yùn)動(dòng)狀態(tài)的所有獨(dú)立參數(shù)的數(shù)目，即 q 的維數(shù)。

位姿空間（configuration space）

位姿空間是機(jī)器人所有可能位姿組成的集合，代表了機(jī)器人所有可能的運(yùn)動(dòng)結(jié)果，稱為 C-空間，也可簡記為 C。

距離函數(shù)（distance function）

C-空間中的距離函數(shù)定義為該空間中的一個(gè)映射