The authors of Sub-Goal Trees -- a Framework for Goal-Directed Trajectory Prediction and Optimization have not publicly listed the code yet.
Request code directly from the authors:
Get an expert to implement this paper:
(OR if you have code to share with the community, please add it here 😊🙏 )