A brief update. I've just finished working on a new version of the motor control firmware to give more precise, faster control. Here is an example of the results:
The motor controllers are now estimating the desired velocity from successive positions, which keeps the position on target without increasing the latency in processing position commands. The controllers also now have the option for a feed forward term for the motor torque, but that isn't used here.