Trapezoidal Motion Profiles in WPILib - https://docs.wpilib.org/en/stable/docs/software/advanced-controls/controllers/trapezoidal-profiles.html