[Tom Bottiglieri]

We have alleviated some of the issues with timing by measuring dt for every iteration of the control loop. This still isn't good enough to use any derivative in the controller, but it makes the motion a bit smoother. (You will probably over/undershoot the expected position part of your profile and get a bunch of error out of nowhere, causing the jerky motion.