Reworked path planner plotting, some other cleanup

[studywolf]

• Mostly adjusting comments
• Also reran pyblack and isort
• removed a few scatterplot points that were not needed anymore
• removed ang parameter as we can just check the shape of the path