Files
TIR_PROJ/training
Johnny Fernandes ee77c8606c Gym mecanum kinematics matching to Webots roller-hinge proto
Mecanum proto rewrite in b3cf990 made the wheels truly omnidirectional
in Webots, but with asymmetric slip: forward command produces ~89% of
textbook speed while strafe produces only ~38% plus a consistent
~28% backward bleed-through. v1 BC/RL trained on perfect mecanum
gym kinematics could not herd the new dynamics. To unblock that:

* `mecanum_kinematics_step` gains two parameters that scale the
  realised motion to match a deployed-platform calibration:
    - strafe_efficiency  ∈ (0, 1]  default 1.0
    - strafe_to_forward_bleed     default 0.0
  Forward motion is untouched (textbook X-pattern continues to apply
  to vx_body); only the lateral channel is scaled and bleed is added.
* `RobotConfig` exposes both as drive-config fields with the same
  pass-through defaults so existing diff-drive code and existing
  mecanum training pipelines see no behaviour change.
* `HERDING_MEC_WEBOTS` preset bakes in the values measured against the
  current Webots mecanum proto (strafe_efficiency=0.4,
  strafe_to_forward_bleed=-0.28). Training mecanum BC/RL with this
  preset produces policies that compensate for the imperfect
  physical mecanum at deploy.
* `HerdingEnv` plumbs `RobotConfig.strafe_*` through to
  `mecanum_kinematics_step` so the preset takes effect.
* tools/gen_mecanum_wheels.py is added so the proto's 32 roller
  hinges can be regenerated by editing a single set of constants
  rather than hand-editing 1500+ lines of VRML.

Tests:
* 4 new mecanum_kinematics_step tests (default pass-through, strafe
  scaling, backward bleed, forward unaffected by strafe params).
* 3 new RobotConfig tests (defaults, validation, preset shape).
* Sanity check: gym strafe with HERDING_MEC_WEBOTS over 100 steps
  reproduces the Webots calibration to 2 decimal places.

126 unit tests pass (was 120).

Co-Authored-By: Claude Opus 4.7 <noreply@anthropic.com>
2026-05-17 01:09:47 +00:00
..
2026-05-07 22:00:10 +01:00
2026-05-13 07:49:17 +00:00
2026-05-12 22:41:03 +01:00
2026-05-11 12:21:51 +01:00

Training and Evaluation Details

This file is the command-level companion to the root README. It focuses on data collection, BC, PPO fine-tuning, evaluation flags, and generated artifacts; use the root README for the high-level architecture and Webots demo quick start.

Two stages, strictly sequential:

sim demos (Strömbom on tracker output, K=4 frame stack)
    │
    ▼
bc/pretrain.py  ──►  runs/bc   (Strömbom-imitated MLP)
    │
    ▼  KL-regularised PPO fine-tune
    │
runs/rl                        (deployed `rl` mode — beats BC and Strömbom)

Files

herding_env.py     — Gymnasium env (LiDAR raycast + tracker by default)
bc/pretrain.py     — MSE + cosine BC of (obs, action) demos into MlpPolicy
rl/train.py       — KL-regularised PPO fine-tune of a BC checkpoint
eval.py            — multi-seed analytic / learned policy comparison
runs/              — checkpoints (whitelisted entries in top-level .gitignore)

(Unit + integration tests live in the top-level ``tests/`` directory;
run with ``python -m pytest tests/``.)

End-to-end pipeline

The simplest way to run everything is the Makefile at the project root: make does the full chain, make rl rebuilds whatever's needed up to that point, etc. The individual stages below are kept explicit for cases where you want to tune a single step.

# 1. Sim demos with the active-scan + Strömbom teacher under LiDAR
#    perception. K=4 frame stack so the MLP has temporal context.
python -m training.bc.collect --teacher strombom \
    --out training/bc/demos.npz --seeds-per-n 15 --subsample 3 --frame-stack 4

# 2. Behaviour-clone.
python -m training.bc.pretrain --demos training/bc/demos.npz \
    --out training/runs/bc --epochs 60 --net-arch 512,512

# 3. KL-regularised PPO fine-tune of bc.
python -m training.rl.train \
    --bc training/runs/bc --out training/runs/rl \
    --total-timesteps 1000000

# 4. Multi-seed eval (env-side, fast).
python -m training.eval --policy training/runs/rl \
    --max-flock 10 --max-steps 15000 --n-seeds 10

bc/pretrain.py saves the best-val_cos snapshot, not the final epoch — multi-modal teachers make training noisy and the last epoch is often worse than an earlier one.

rl/train.py loads BC weights into both a trainable policy and a frozen reference, fixes log_std small, and adds β · KL(π‖π_ref) to the loss so the policy can only move within a trust region around BC. See the file header for hyperparameter rationale.

Available analytic teachers

Name What it does Notes
strombom Strömbom 2014 — collect when flock is scattered, drive CoM otherwise Default; works for n=110 under tight cohesion
sequential Pick the sheep closest to the pen and drive only it Alternative; needs loose-cohesion regime

Both are wrapped at demo-collection time in herding/control/active_scan.py:ActiveScanTeacher, which adds an opening in-place rotation, walk-to-centre when the LiDAR sees nothing, and near-sheep speed modulation (same modulation herding/control/modulation.py applies to every dog mode at inference).

Evaluating analytic teachers directly

python -m training.eval --policy strombom    --max-flock 10 --max-steps 15000 --n-seeds 10
python -m training.eval --policy sequential  --max-flock 10 --max-steps 15000 --n-seeds 10