state lattice + OBVP 算法回顧

目標 給點起點和終點 先求出在起點做一次state lattice planning 的軌跡 再求在軌跡基礎上從軌跡終點到給定終點的OBVP問題 1. state lattice 將控制量a離散化 離散成discretize_step份 分別再xyz上進行積分求得p v,得到軌跡 2. OBVP 將第一段的軌跡終點作爲OBVP的起點 給定終點作爲OBVP終點 進行最優邊界值問題求解 起點 p v
相關文章
相關標籤/搜索