I made a few changes:
I fixed a few bugs with ending paths with the A* pathing
I added a few unit tests to allow me to test the code without the robot
I added velocity profiles for the paths run, so that the robot can be tuned for paths
Update: The tests dont work at all :(
So I was able to implement Bidirectional A* pathing, from unidirectional, and Im pretty proud of the change. I also wrote a small visualizer to help show how the pathing works
I was able to write out a robot detecting class for my pathing :D