Update README.md
Browse files
README.md
CHANGED
|
@@ -5,48 +5,49 @@ tags:
|
|
| 5 |
- motion-planning
|
| 6 |
---
|
| 7 |
|
| 8 |
-
|
| 9 |
-
|
| 10 |
-
|
| 11 |
-
|
| 12 |
-
|
| 13 |
-
|
| 14 |
-
|
| 15 |
-
|
| 16 |
-
|
| 17 |
-
|
| 18 |
-
|
| 19 |
-
|
| 20 |
-
|
| 21 |
-
|
| 22 |
-
|
| 23 |
-
|
| 24 |
-
|
| 25 |
-
|
| 26 |
-
|
|
| 27 |
-
|
|
| 28 |
-
|
|
| 29 |
-
| Random workload, seed
|
| 30 |
-
| Random workload, seed
|
| 31 |
-
|
|
| 32 |
-
|
| 33 |
-
|
| 34 |
-
|
| 35 |
-
|
| 36 |
-
|
| 37 |
-
|
| 38 |
-
|
| 39 |
-
|
| 40 |
-
|
| 41 |
-
|
| 42 |
-
python
|
| 43 |
-
|
| 44 |
-
|
| 45 |
-
|
| 46 |
-
|
| 47 |
-
|
| 48 |
-
|
| 49 |
-
|
|
|
|
| 50 |
|
| 51 |
|
| 52 |
[Open the live planner](https://huggingface.co/spaces/thelamapi/Next-Servo)
|
|
|
|
| 5 |
- motion-planning
|
| 6 |
---
|
| 7 |
|
| 8 |
+

|
| 9 |
+
|
| 10 |
+
# Next Servo
|
| 11 |
+
|
| 12 |
+
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.
|
| 13 |
+
|
| 14 |
+
[](replay.mp4)
|
| 15 |
+
|
| 16 |
+
[Watch the 14-second replay](replay.mp4)
|
| 17 |
+
|
| 18 |
+
## How it plans
|
| 19 |
+
|
| 20 |
+
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.
|
| 21 |
+
|
| 22 |
+
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.
|
| 23 |
+
|
| 24 |
+
## Results
|
| 25 |
+
|
| 26 |
+
| Simulated workload | Grid planner accepted | Direct interpolation accepted |
|
| 27 |
+
|---|---:|---:|
|
| 28 |
+
| Four selected detour examples | 4/4 | 0/4 |
|
| 29 |
+
| Random workload, seed 19 | 63/80 | 51/80 |
|
| 30 |
+
| Random workload, seed 73 | 59/80 | 46/80 |
|
| 31 |
+
| Random workload, seed 149 | 63/80 | 54/80 |
|
| 32 |
+
| **Random workload total** | **185/240** | **151/240** |
|
| 33 |
+
|
| 34 |
+
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.
|
| 35 |
+
|
| 36 |
+
## Reproduce
|
| 37 |
+
|
| 38 |
+
Install the requirements and run the scripts from this directory.
|
| 39 |
+
|
| 40 |
+
~~~bash
|
| 41 |
+
pip install -r requirements.txt
|
| 42 |
+
python evaluate.py
|
| 43 |
+
python render.py
|
| 44 |
+
~~~
|
| 45 |
+
|
| 46 |
+
Rendering requires FFmpeg on PATH. The evaluator exports the sampled inputs and results to evaluation.json. The notebook runs evaluation and replay generation in Colab.
|
| 47 |
+
|
| 48 |
+
## Scope
|
| 49 |
+
|
| 50 |
+
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.
|
| 51 |
|
| 52 |
|
| 53 |
[Open the live planner](https://huggingface.co/spaces/thelamapi/Next-Servo)
|