Skip to content

Commit 52832fa

Browse files
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

Some content is hidden

Large Commits have some content hidden by default. Use the searchbox below for content that may be hidden.

‎CMakeLists.txt‎

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -47,7 +47,7 @@ if (NOT TARGET numerical.math)
4747
FetchContent_Declare(
4848
numerical_toolbox
4949
GIT_REPOSITORY https://github.com/embedded-pro/numerical-toolbox-cpp.git
50-
GIT_TAG 63c9b91f4f6f1b306bc15fbf59d01a106da02697 # main
50+
GIT_TAG dc147fb8672e983e5935290b94cc45ff00cbee29 # main
5151
)
5252

5353
set(NUMERICAL_TOOLBOX_ENABLE_OPTIMIZATIONS ${ROBOTICS_TOOLBOX_ENABLE_OPTIMIZATIONS} CACHE BOOL "" FORCE)

‎README.md‎

Lines changed: 13 additions & 11 deletions
Original file line numberDiff line numberDiff line change
@@ -3,10 +3,10 @@
33
## Overview
44

55
This library provides robotics algorithms — today robot-manipulator kinematics, rigid-body dynamics,
6-
trajectory generation and manipulator control; mobile, aerial, legged and marine robots are on the
7-
[roadmap](ROADMAP.md) — designed for robust and efficient real-time use on resource-constrained
8-
embedded systems (no heap, deterministic, float-only). It builds on the shared
9-
numerical primitives (linear algebra, solvers, controllers) provided by
6+
trajectory generation, manipulator control, motion planning, wheeled mobile robots and occupancy-grid
7+
mapping; aerial, legged and marine robots are on the [roadmap](ROADMAP.md) — designed for robust and
8+
efficient real-time use on resource-constrained embedded systems (no heap, deterministic, float-only).
9+
It builds on the shared numerical primitives (linear algebra, solvers, controllers) provided by
1010
[numerical-toolbox-cpp](https://github.com/embedded-pro/numerical-toolbox-cpp), which it consumes
1111
via CMake `FetchContent`.
1212

@@ -35,13 +35,15 @@ project already defines those targets. Includes are namespaced by domain, e.g.
3535

3636
## Documentation
3737

38-
| Category | Description |
39-
|--------------------------------------------------------------|------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------|
40-
| [Kinematics](doc/kinematics/README.md) | Forward Kinematics, Chain Pose Kinematics, Denavit-Hartenberg Parameters, Geometric Jacobian, Manipulability Index, Product of Exponentials, Redundancy Resolution, Inverse Kinematics (Damped Least Squares), Pose Inverse Kinematics, Analytical Inverse Kinematics (OPW), Continuum Kinematics, Parallel Manipulator Kinematics |
41-
| [Dynamics](doc/dynamics/README.md) | Euler-Lagrange, Newton-Euler, Recursive Newton-Euler (RNEA), Articulated Body Algorithm (ABA), Chain Dynamics Model, Composite Rigid Body Algorithm (CRBA), Coriolis Matrix and Inertial Regressor, Dynamic Parameter Identification, Forward-Dynamics Integration, Generic Joint Link, Generalized-Momentum Observer |
42-
| [Planning](doc/planning/README.md) | Primitive Distance Queries, Artificial Potential Fields, Self-Collision Checking, Convex Collision (GJK and EPA), Grid Search (A* and Dijkstra), RRT-Connect |
43-
| [Trajectory](doc/trajectory/README.md) | Cubic Spline Trajectory, Cartesian Path with SLERP Orientation |
44-
| [Manipulator Control](doc/controllers/manipulator/README.md) | PD Control with Gravity Compensation, Computed-Torque Control, Impedance Control, Operational-Space Control, Hybrid Position/Force Control, Slotine–Li Adaptive Control, Cable Tension Distribution |
38+
| Category | Description |
39+
|--------------------------------------------------------------|----------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------|
40+
| [Kinematics](doc/kinematics/README.md) | Forward Kinematics, Chain Pose Kinematics, Denavit-Hartenberg Parameters, Geometric Jacobian, Manipulability Index, Product of Exponentials, Redundancy Resolution, Inverse Kinematics (DLS), Pose Inverse Kinematics, Analytical IK (OPW), Continuum Kinematics, Parallel Manipulator Kinematics, Mobile-Manipulator Kinematics |
41+
| [Dynamics](doc/dynamics/README.md) | Euler-Lagrange, Newton-Euler, Recursive Newton-Euler (RNEA), Articulated Body Algorithm (ABA), Chain Dynamics Model, Composite Rigid Body Algorithm (CRBA), Coriolis Matrix and Inertial Regressor, Dynamic Parameter Identification, Forward-Dynamics Integration, Generic Joint Link, Generalized-Momentum Observer |
42+
| [Planning](doc/planning/README.md) | Primitive Distance Queries, Artificial Potential Fields, Self-Collision Checking, Convex Collision (GJK and EPA), Grid Search (A* and Dijkstra), RRT-Connect, Dubins Shortest Paths, Dynamic Window Approach, Reeds–Shepp Shortest Paths |
43+
| [Trajectory](doc/trajectory/README.md) | Cubic Spline Trajectory, Cartesian Path with SLERP Orientation |
44+
| [Mobile Robots](doc/mobile/README.md) | Planar Odometry, Differential-Drive Kinematics, Car-Like Kinematics, Omnidirectional Kinematics, Skid-Steer Kinematics, Pure-Pursuit Path Tracking, Kanayama Trajectory Tracking, Stanley Path Tracking |
45+
| [Localization & Mapping](doc/localization/README.md) | Occupancy-Grid Mapping |
46+
| [Manipulator Control](doc/controllers/manipulator/README.md) | PD Control with Gravity Compensation, Computed-Torque Control, Impedance Control, Operational-Space Control, Hybrid Position/Force Control, Slotine–Li Adaptive Control, Cable Tension Distribution |
4547

4648
Each category page lists its algorithms with a brief description and links to the detailed
4749
documentation.

0 commit comments

Comments
 (0)