Next Servo
Next Servo plans how a two-joint robot arm can carry a circular payload around a stationary fixture. Select one of four scenarios and scrub through the motion to see how the elbow and payload move. The replay shows the actual planner output.
How it plans
The planner computes both inverse-kinematics branches at the start and destination. It searches a 5-degree joint grid with breadth-first search, then connects the grid route to the exact endpoints. Each edge is checked for link and payload clearance. A bound on motion between samples gives a conservative clearance check for the full interpolated edge.
The baseline tries a single straight interpolation in joint space for each pair of inverse-kinematics branches, with the same edge check. It can complete easy transfers with a single move. The grid planner can use intermediate poses when the direct moves fail.
Results
| Simulated workload | Grid planner accepted | Direct interpolation accepted |
|---|---|---|
| Four selected detour examples | 4/4 | 0/4 |
| Random workload, seed 19 | 63/80 | 51/80 |
| Random workload, seed 73 | 59/80 | 46/80 |
| Random workload, seed 149 | 63/80 | 54/80 |
| Random workload total | 185/240 | 151/240 |
The four replay examples were selected to show cases where direct interpolation was rejected. The random workload includes instances that may be infeasible. Four additional checks passed for a clear transfer, blocked pickup, blocked destination and blocked base. A rejection means the algorithm did not certify a route under its constraints. Every accepted grid route passed the conservative edge check. Maximum numerical endpoint error was 7.03e-16 length units across accepted runs.
Reproduce
Install the requirements and run the scripts from this directory.
pip install -r requirements.txt
python evaluate.py
python render.py
Rendering requires FFmpeg on PATH. The evaluator exports the sampled inputs and results to evaluation.json.
Scope
A planar geometric simulation with rigid, unit-length, zero-width links, a circular payload and one static circular obstacle. The payload starts attached at the pickup location. Motion is kinematic, and playback time is illustrative. A physical arm needs its own geometry, collision model, dynamics, speed limits, grasping and hardware validation.
