Takes a path planner CSV output and converts it to an x, y, theta format separated by 20ms for the MotionOfTheOcean library
To use, type in terminal:
python PathExtrapolator.py /path/to/pathplanner/output /path/to/exported/file
Or run
python PathExtrapolator.py
With your input csv named input.csv and it will output to export_path.csv