My calling code will have a path of points over time, say (t, X, Y,
Z) for times t0, t1, t2, ... I want the servos to move such that:
1. They reach X, Y and Z at time t. Report deviation if not exactly at that position.
2. All servos are accelerating/decelerating OR all are at a steady speed at the same time
3. Speed of each servo at t minimizes the acceleration/deceleration needed to reach the next point
Each servo has its own AVR
chip, driver and a handful of sensors. Clocks are synced with an interrupt. A raspberry pi will send them each the next few points to follow, read deviation each reports from the last few points, and adjust the path accordingly.
I'll post some code once I have everything working.
I don't want to share a lib that uses a modified version of AccelStepper, so hopefully my change makes it into the repo.