I’ve made a small example showing how one can control joints in a servo/robot - controller thru your own add-on.
The project uses the IoC.Get<ISimulationService>().PropertyChanged and Elapsed time to get a time slice from the simulation and then multiplies that with the actual speed of the joint to interpolate the movement of each joint.
Works with 1-6 joints.
MoveJoints.rar (51.2 KB)