Closed bjack205 closed 2 years ago
Adds fix to TVLQR controller so that it stabilizes correctly at the end of the trajectory.
Both Xref and Uref inputs should have the same length (same as Q and R) and the last state/control pair should be set equal to the equilibrium state/control.
Xref
Uref
Q
R
LGTM
Adds fix to TVLQR controller so that it stabilizes correctly at the end of the trajectory.
Both
Xref
andUref
inputs should have the same length (same asQ
andR
) and the last state/control pair should be set equal to the equilibrium state/control.