Control.kt Ramsete controller is missing a term in the AngVel section. Specifically, it is missing the "error.position.y" term.
Correct expression is
`return PoseVelocity2dDual.constant(
PoseVelocity2d(
Vector2d(
vRef error.heading.real + k error.position.x,
0.0
),
omegaRef + k error.heading.log() + b vRef sinc(error.heading.log())error.position.y,
),
2
)'
RR FTC Version
0.1.11
Observed Behavior
Control.kt Ramsete controller is missing a term in the AngVel section. Specifically, it is missing the "error.position.y" term. Correct expression is `return PoseVelocity2dDual.constant( PoseVelocity2d( Vector2d( vRef error.heading.real + k error.position.x, 0.0 ), omegaRef + k error.heading.log() + b vRef sinc(error.heading.log())error.position.y, ), 2 )'
Tuning Files
No response
Robot Logs
No response