mirror of
https://github.com/wpilibsuite/allwpilib
synced 2026-06-19 00:41:43 +00:00
@@ -54,10 +54,10 @@ TEST(FeedbackAnalysisTest, VelocityCTRE) {
|
||||
|
||||
sysid::LQRParameters params{1, 1.5, 7};
|
||||
|
||||
auto [Kp, Kd] = sysid::CalculateVelocityFeedbackGains(
|
||||
sysid::presets::kCTREv5CANCoder, params, Kv, Ka);
|
||||
auto [Kp, Kd] = sysid::CalculateVelocityFeedbackGains(sysid::presets::kCTREv5,
|
||||
params, Kv, Ka);
|
||||
|
||||
EXPECT_NEAR(Kp, 0.000417, 0.00005);
|
||||
EXPECT_NEAR(Kp, 259.21276731541178, 0.00005);
|
||||
EXPECT_NEAR(Kd, 0.00, 0.05);
|
||||
}
|
||||
|
||||
@@ -67,12 +67,12 @@ TEST(FeedbackAnalysisTest, VelocityCTREConversion) {
|
||||
|
||||
sysid::LQRParameters params{1, 1.5, 7};
|
||||
|
||||
auto [Kp, Kd] = sysid::CalculateVelocityFeedbackGains(
|
||||
sysid::presets::kCTREv5CANCoder, params, Kv, Ka, 3.0);
|
||||
auto [Kp, Kd] = sysid::CalculateVelocityFeedbackGains(sysid::presets::kCTREv5,
|
||||
params, Kv, Ka, 3.0);
|
||||
|
||||
// This should have the same Kp as the test above, but scaled by a factor
|
||||
// of 3.
|
||||
EXPECT_NEAR(Kp, 0.000417 / 3, 0.00005);
|
||||
EXPECT_NEAR(Kp, 259.21276731541178 / 3, 0.00005);
|
||||
EXPECT_NEAR(Kd, 0.00, 0.05);
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user