Point to point navigation calculations are easy enough, but controlling the robot and making it drive the path is where the results are.
Make a class/system/test code that can use navigational utilities to control the robot as it drives the path. This will probably use PID to correct for error in heading in the simplest cases. In the future, this will need to predict turns before they happen so the robot can stay on path, while also integrating well with the obstacle avoidance/cone detection system. Please make this modular.
Point to point navigation calculations are easy enough, but controlling the robot and making it drive the path is where the results are.
Make a class/system/test code that can use navigational utilities to control the robot as it drives the path. This will probably use PID to correct for error in heading in the simplest cases. In the future, this will need to predict turns before they happen so the robot can stay on path, while also integrating well with the obstacle avoidance/cone detection system. Please make this modular.