Working on adding the velocity angle cost using cross product and a scaling factor
Working on velocity...
Add the euclidean distance to the cost? Also update the cost to go heuristic
Added euclidean distance to cost and heuristic to include velocity cost, this should help have positive y body velocity motions.
not working as well as i would hope
Comitting before switching to the branch to work on using unique pointers
I guess Ubuntu is just reclaiming all the memory when the program ends anyway, dont need to delete nodes. They are killed anyways.
In the process of doing the shooting method
Starting new convex hull stuff. Not using CGAL