v2.0.5
Changes:
Fix: Patch NaN on path completion interpolation
Fix: Change debugString() in ErrorCalculator and VectorCalculator to not mess with the derivative calculation
Fix: Make close callbacks execute in the correct order
Addition: Add setX(), setY(), and setHeading() to Follower and Localizer
Feature: Allow reusing lazily generated paths, i.e., paths with FuturePoses
Fix: Swap caught Exceptions for IllegalArgumentExceptions
Fix: Make setGlobalReversed() not broken
Refactor: Clean up piecewise heading
Fix: Correct stopping distance calculation
Fix: Allow Paths to have separate path constraints from the PathChain
Fix: Make turn and turnTo full speed