Hi Chris,

It sounds like you are understanding things. Maybe post an updated plot. I see your Velocity setting (9000000) is way too high - but you are not achieving more than ~400,000 because of distance and acceleration limits.

You might use a 2nd order low pass filter to reduce output spikes further than a first order filter will. Possibly 1000Hz Q 1.4.

Good luck.
Regards