Explore alternative routing technique

[Gwilym-Rutherford]

Brief description of what the task
Look at manually publishing checkpoints and goal points instead of relying on the Autoware API which seems to have some