Fix jerk smoothing: correct finite difference formula and loop bounds#499

Copilot wants to merge 8 commits intomastertesseract-robotics/trajopt:masterfrom

copilot/compare-jerk-velocity-accelerationtesseract-robotics/trajopt:copilot/compare-jerk-velocity-accelerationCopy head branch name to clipboard