T. Uras and S. Koenig, “Fast Near-Optimal Path Planning on State Lattices with Subgoal Graphs”, SOCS, vol. 9, no. 1, pp. 106–114, Sep. 2021.