2．3 動(dòng)作規(guī)劃

動(dòng)作規(guī)劃接收行為規(guī)劃的目標(biāo)，生成車輛安全運(yùn)動(dòng)軌跡。其主要分為兩種工作場(chǎng)景：一種是正常道路（on－road）模式，一種是非結(jié)構(gòu)化道路（unstructured driving）模式。主要步驟為：

1． 根據(jù)任務(wù)規(guī)劃和行為規(guī)劃給定的運(yùn)動(dòng)目標(biāo)，規(guī)劃一條合理路徑；

2． 基于軌跡生成算法生成一系列的軌跡去跟蹤這條路徑 ；

3． 根據(jù)判定準(zhǔn)則從生成的軌跡中選取最優(yōu)軌跡。

BOSS采用的軌跡生成算法是模型預(yù)測(cè)軌跡生成。通過(guò)設(shè)計(jì)合理的評(píng)價(jià)函數(shù)，在滿足各種約束條件下，實(shí)現(xiàn)避障功能且盡量減小車輛與全局路徑的偏差。模型預(yù)測(cè)軌跡生成主要是為了使得規(guī)劃結(jié)果滿足車輛動(dòng)力學(xué)和運(yùn)動(dòng)學(xué)約束，因此可以采用較低精度的車輛模型。

On－road planning：

路徑生成：獲取車道中心線作為目標(biāo)路徑。

軌跡生成：從中心線路徑衍生出多組局部目標(biāo)的軌跡。局部目標(biāo)沿著中心線路徑放置在一個(gè)固定的縱向距離上，但在與路徑的橫向偏移上有所不同。

軌跡速度：根據(jù)環(huán)境上下文和各種限制條件，包括當(dāng)前跟隨距離的最大速度、路段速度限制、路徑曲率的最大速度、目標(biāo)點(diǎn)速度等，進(jìn)行速度的配置。

軌跡評(píng)估：根據(jù)與障礙物的距離、與中心線的距離、平滑度、最終點(diǎn)誤差（endpoint error）以及軌跡速度等，進(jìn)行最優(yōu)軌跡評(píng)估，選擇最優(yōu)軌跡。

在行駛過(guò)程中進(jìn)行合理的變道、U行轉(zhuǎn)彎、異常檢測(cè)與恢復(fù)等操作。

基礎(chǔ)路線三：系統(tǒng)開(kāi)發(fā)流程與測(cè)試

BOSS車整套無(wú)人駕駛系統(tǒng)從頭開(kāi)始開(kāi)發(fā)，為了滿足DARPA城市挑戰(zhàn)賽的需求，使用了螺旋系統(tǒng)開(kāi)發(fā)過(guò)程，著重于定期的、回歸的系統(tǒng)測(cè)試。

測(cè)試和開(kāi)發(fā)緊密地交織在一起，遵循如圖所示的循環(huán)開(kāi)發(fā)過(guò)程。

在算法開(kāi)發(fā)開(kāi)始之前，團(tuán)隊(duì)定義了BOSS需要完成的能力需求（Requirements Definition）。

需求推動(dòng)了算法的開(kāi)發(fā)。算法通過(guò)模擬或數(shù)據(jù)重放進(jìn)行離線測(cè)試（Development ＆ Offline Debugging）。

一旦算法足夠成熟，就進(jìn)行車載測(cè)試，全面評(píng)估系統(tǒng)和環(huán)境之間的相互作用（Online Developmental Testing）。這些測(cè)試通常會(huì)發(fā)現(xiàn)在離線測(cè)試中并不明顯的算法問(wèn)題或?qū)崿F(xiàn)bug，通常會(huì)導(dǎo)致大量的返工周期和進(jìn)一步的離線調(diào)試。

一旦開(kāi)發(fā)人員對(duì)算法的工作感到滿意，對(duì)算法的測(cè)試就被添加到正式的、定期安排的系統(tǒng)測(cè)試中（Formal System Testing）。對(duì)算法進(jìn)行獨(dú)立測(cè)試過(guò)程中發(fā)現(xiàn)新的缺陷，這需要一些返工。

回歸系統(tǒng)測(cè)試是開(kāi)發(fā)過(guò)程的基石。在循環(huán)開(kāi)發(fā)過(guò)程之后，每個(gè)研究人員都可以自由地實(shí)現(xiàn)和測(cè)試盡可能獨(dú)立于整個(gè)系統(tǒng)，但是為了判斷系統(tǒng)整體能力并驗(yàn)證單獨(dú)的組件更改不會(huì)降低整個(gè)系統(tǒng)性能，團(tuán)隊(duì)執(zhí)行了回歸系統(tǒng)測(cè)試。系統(tǒng)測(cè)試的頻率與系統(tǒng)就緒程度成比例。BOSS車從2007年2月到10月，進(jìn)行了65天的系統(tǒng)測(cè)試。正式的測(cè)試時(shí)間在系統(tǒng)的完善過(guò)程中進(jìn)行調(diào)整，例如，在二月份，團(tuán)隊(duì)進(jìn)行了不到16公里的系統(tǒng)測(cè)試。相比之下，在10月的前3周，該團(tuán)隊(duì)進(jìn)行了超過(guò)1500公里的自動(dòng)測(cè)試。