[wpilibc] Fix Mecanum & Swerve ControllerCommand lambda capture (#3795)

Fixes #3765
Also fixes SwerveControllerCommand example calling command twice.
This commit is contained in:
sciencewhiz
2021-12-18 11:30:57 -08:00
committed by GitHub
parent c5ae0effac
commit d41d051f1b
3 changed files with 7 additions and 19 deletions

View File

@@ -43,9 +43,6 @@ SwerveControllerCommand<NumModules>::SwerveControllerCommand(
m_controller(xController, yController, thetaController),
m_outputStates(output) {
this->AddRequirements(requirements);
m_desiredRotation = [&] {
return m_trajectory.States().back().pose.Rotation();
};
}
template <size_t NumModules>
@@ -80,13 +77,13 @@ SwerveControllerCommand<NumModules>::SwerveControllerCommand(
m_controller(xController, yController, thetaController),
m_outputStates(output) {
this->AddRequirements(requirements);
m_desiredRotation = [&] {
return m_trajectory.States().back().pose.Rotation();
};
}
template <size_t NumModules>
void SwerveControllerCommand<NumModules>::Initialize() {
m_desiredRotation = [&] {
return m_trajectory.States().back().pose.Rotation();
};
m_timer.Reset();
m_timer.Start();
}