You signed in with another tab or window. Reload to refresh your session.You signed out in another tab or window. Reload to refresh your session.You switched accounts on another tab or window. Reload to refresh your session.Dismiss alert
{{ message }}
Repository navigation
Commit d89092b
Browse filesBrowse the repository at this point in the historyBrowse files
authored
fix: dp45, matrix init, feedlin, dare and statistics (#272)
* fix dp45, matrix init, feedlin, dare and statistics
* Update numerical/controllers/implementations/Lqr.hpp
Co-authored-by: github-actions[bot] <41898282+github-actions[bot]@users.noreply.github.com>
* fix(deadbeat): replace SVD with normal-equations pseudo-inverse to unblock underdetermined case
SVD<T, Rows, Cols> requires Rows >= Cols, which contradicted the class's
own static_assert (StateSize <= Steps * InputSize). Any instantiation
with StateSize < ReachSize (e.g. <float,1,1,2>) would fail at the SVD's
internal constraint, not at the user-facing one.
Replace with Γ† = Γᵀ(ΓΓᵀ)⁻¹ via SolveSystem — valid for both the square
(existing) and underdetermined (new) cases. Add <float,1,1,2> and
<float,2,1,3> coverage instantiations. Fix 1e-1f tolerance to
math::Tolerance<float>(). Add three tests pinning noise-gain ordering,
closed-loop stability, and asymptotic convergence for the new cases.
Co-Authored-By: Claude Sonnet 4.6 <noreply@anthropic.com>
* fix build
* fix build 2
* fix issues 3
---------
Co-authored-by: github-actions[bot] <41898282+github-actions[bot]@users.noreply.github.com>
Co-authored-by: Claude Sonnet 4.6 <noreply@anthropic.com>
Copy file name to clipboardExpand all lines: doc/nonlinear_control/FeedbackLinearization.md
+7-7Lines changed: 7 additions & 7 deletions
Display the source diff
Display the rich diff
Original file line number
Diff line number
Diff line change
@@ -12,17 +12,17 @@ The technique applies to plants whose output $y \in \mathbb{R}^m$ satisfies, aft
12
12
13
13
$$y^{(r)} = a(x) + B(x)\, u$$
14
14
15
-
where $x \in \mathbb{R}^n$ is the state, $u \in \mathbb{R}^m$ is the input, $a(x) \in \mathbb{R}^m$ is the **drift term** (known nonlinear dynamics), and $B(x) \in \mathbb{R}^{m \times m}$ is the **decoupling matrix** (state-dependent input gain). The integer $r$ is the relative degree. For mechanical systems ($r = 2$), $B(x) = M(q)$ is the inertia matrix and $a(x) = C(q,\dot{q})\dot{q} + g(q)$ is the Coriolis-plus-gravity term.
15
+
where $x \in \mathbb{R}^n$ is the state, $u \in \mathbb{R}^m$ is the input, $a(x) \in \mathbb{R}^m$ is the **drift term** (known nonlinear dynamics), and $B(x) \in \mathbb{R}^{m \times m}$ is the **decoupling matrix** (state-dependent input gain). The integer $r$ is the relative degree. For mechanical systems ($r = 2$), written as $M(q)\ddot{q} + C(q,\dot{q})\dot{q} + g(q) = u$, the control-affine form has $B(x) = M^{-1}(q)$ and $a(x) = -M^{-1}(q)\bigl(C(q,\dot{q})\dot{q} + g(q)\bigr)$.
16
16
17
17
### Inner Control Law (Cancellation)
18
18
19
19
The inner law selects $u$ so that the term $a(x)$ is cancelled and the decoupling matrix is factored out:
0 commit comments