Slides borrowed from my colleague William Pope
PRM
FMM
However: these methods don't work well for systems with differential constraints
Step 22
Step 66
Value function from solving HJB PDE:
Optimal paths from gradient of value function:
Sliced at θ=50°