Repository navigation
Commit 52832fa
feat: mobile wave roadmap items (F1, W1–W10, E2, M24) (#38)
* build: bump numerical-toolbox to dc147fb for SE2Transform (NT66)
Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
* feat(mobile): add PlanarOdometry (F1)
New mobile module. Dead reckoning on SE(2): exact arc integration of a
body twist with the SE(2) exponential and per-step renormalisation,
body-frame odometry increments through the logarithm, and the
increment noise model shared by the localization filters.
Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
* feat(mobile): add DifferentialDrive (W1)
Unicycle kinematics of a two-wheel axle: forward and inverse maps,
curvature-preserving wheel saturation through the shared ScaleToLimit,
the achievable twist and the speed envelope.
Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
* feat(mobile): add CarLikeKinematics (W2)
Kinematic bicycle twist at the rear axle or any point ahead of it (the
SE(2) adjoint), steering for a curvature, steering angle and rate
limits, Ackermann wheel angles and the minimum turning radius.
Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
* feat(mobile): add OmnidirectionalKinematics (W3)
Swedish-wheel and mecanum kinematics for any layout of three or more
wheels: wheel Jacobian, pseudo-inverse from one Cholesky factorization,
least-squares forward kinematics, slip residual and uniform saturation.
Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
* feat(mobile): add SkidSteerKinematics (W4)
ICR model for skid-steered and tracked vehicles: forward kinematics with
lateral slip, inverse kinematics, shared curvature-preserving saturation
and a closed-form least-squares ICR estimator with an excitation check.
Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
* docs(mobile): wrap long SkidSteerKinematics line
Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
* feat(mobile): add PurePursuit and PlanarPath (W5)
PlanarPath: bounded polyline with cumulative arc lengths, windowed
closest-point projection with signed cross-track, and interpolation by
arc length. PurePursuit: speed-scheduled look-ahead, monotone progress,
circle-exit goal with end-of-path and off-path fallbacks, and the
tangent-arc curvature command. The roadmap canonical example now points
at OdometryFusion.
Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
* feat(mobile): add KanayamaController (W7)
Lyapunov-stable trajectory tracking for unicycle-type bases: the
reference is expressed in the robot frame and the feedforward velocity
is corrected along track, cross track and in heading, with a critically
damped gain helper. The roadmap index now links the shipped upstream
SE2Transform doc instead of its removed spec.
Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
* feat(mobile): add StanleyController (W6)
Front-axle Stanley steering law for car-like vehicles on a PlanarPath:
heading error plus a speed-softened arctangent of the cross-track error,
monotone path progress, and the vehicle's steering angle and rate
limits. Coverage instantiates the test path size alongside the spec's.
Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
* feat(planning): add DubinsPath and CarPath (W8)
CarPath: up to five steering segments with signed lengths, total length
and sampling by arc length with the SE(2) exponential. DubinsPlanner:
closed-form evaluation of the six Dubins words with float-tolerant
existence tests and 2*pi snapping. LSL and RSR take their straight
length as a hypotenuse, since their discriminant is a sum of squares,
and coincident positions use the start heading as the reference
direction so any start equal to its goal gives a zero-length path.
Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
* feat(localization): add OccupancyGridMap (E2)
New localization module. Bounded log-odds occupancy grid updated from
range scans at known sensor poses: integer Bresenham rays clear the
crossed cells and mark the end cell, readings at maximum range only
clear, rays stop at the grid border and every cell is clamped. Cell
queries give log odds, probability and an occupancy test.
Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
* feat(planning): add DynamicWindowApproach (W9)
Reactive local obstacle avoidance for unicycle-type bases: the dynamic
window of reachable velocities is sampled on a fixed grid, each sample's
closed-form arc clearance to body-frame obstacle points decides whether
it can still stop, and the admissible samples are scored on normalised
goal heading, clearance and speed. The README overview now lists the
shipped families.
Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
* feat(planning): add ReedsSheppPath (W10)
Shortest paths for a bounded-curvature car that may reverse: the eight
Reeds-Shepp base formulas in OMPL's corrected form, expanded by time
flip, reflection and the backwards variants into 44 candidates, with
float-tolerant existence tests and the shared CarPath result. The
emptied wheeled and planning roadmap tables now point at the shipped
docs.
Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
* feat(kinematics): add MobileManipulatorKinematics (M24)
Combined world-frame Jacobian of a differential-drive base carrying an
arm: forward-speed and yaw-rate columns with the tool lever arm, and the
arm's geometric Jacobian rotated into the world through the base heading
and the mount. Also the composed tool pose and the no-slip base
constraint. Two long names in the README kinematics row are abbreviated
to keep the table under the 400-character line limit.
Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
* refactor(planning): address Sonar findings in ReedsSheppPath and DynamicWindowApproach
ReedsSheppPlanner::Consider takes the formula and the length builder as
template parameters instead of function pointers, the radius scaling
loop iterates the segments directly, and Mirror uses 'using enum'.
DynamicWindowApproach loops to a compile-time sample count and assigns
each sample before reading it.
Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
---------
Co-authored-by: Claude <noreply@anthropic.com>1 parent a3ebb6f commit 52832fa
113 files changed
Lines changed: 5052 additions & 2437 deletions
File tree
- doc
- kinematics
- localization
- mobile
- planning
- roadmap
- kinematics/MobileManipulatorKinematics
- localization/OccupancyGridMap
- mobile
- CarLikeKinematics
- DifferentialDrive
- KanayamaController
- OmnidirectionalKinematics
- PlanarOdometry
- PurePursuit
- SkidSteerKinematics
- StanleyController
- planning
- DubinsPath
- DynamicWindowApproach
- ReedsSheppPath
- robotics
- kinematics
- test
- localization
- test
- mobile
- test
- planning
- test
Some content is hidden
Large Commits have some content hidden by default. Use the searchbox below for content that may be hidden.
| Original file line number | Diff line number | Diff line change | |
|---|---|---|---|
| |||
47 | 47 | | |
48 | 48 | | |
49 | 49 | | |
50 | | - | |
| 50 | + | |
51 | 51 | | |
52 | 52 | | |
53 | 53 | | |
| |||
| Original file line number | Diff line number | Diff line change | |
|---|---|---|---|
| |||
3 | 3 | | |
4 | 4 | | |
5 | 5 | | |
6 | | - | |
7 | | - | |
8 | | - | |
9 | | - | |
| 6 | + | |
| 7 | + | |
| 8 | + | |
| 9 | + | |
10 | 10 | | |
11 | 11 | | |
12 | 12 | | |
| |||
35 | 35 | | |
36 | 36 | | |
37 | 37 | | |
38 | | - | |
39 | | - | |
40 | | - | |
41 | | - | |
42 | | - | |
43 | | - | |
44 | | - | |
| 38 | + | |
| 39 | + | |
| 40 | + | |
| 41 | + | |
| 42 | + | |
| 43 | + | |
| 44 | + | |
| 45 | + | |
| 46 | + | |
45 | 47 | | |
46 | 48 | | |
47 | 49 | | |
| |||
0 commit comments