File size: 2,621 Bytes
8356d7b
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
---

language: en
tags:
- robotics
---



# 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.

[![Next Servo motion replay preview](preview.png)](replay.mp4)

[Watch the 14-second replay](replay.mp4)

## 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.

~~~bash

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.


[Open the demo](https://huggingface.co/spaces/thelamapi/Next-Servo)