68 void Reset(wpi::units::radian_t angle, wpi::units::radians_per_second_t velocity);
76 void Reset(wpi::units::meter_t distance, wpi::units::meters_per_second_t velocity);
86 wpi::units::volt_t
Calculate(wpi::units::radian_t measured, wpi::units::radian_t position,
87 wpi::units::radians_per_second_t velocity);
97 wpi::units::volt_t
Calculate(wpi::units::meter_t measured, wpi::units::meter_t position,
98 wpi::units::meters_per_second_t velocity);
107 wpi::units::volt_t
Calculate(wpi::units::radians_per_second_t measured,
108 wpi::units::radians_per_second_t velocity);
117 wpi::units::volt_t
Calculate(wpi::units::meters_per_second_t measured,
118 wpi::units::meters_per_second_t velocity);
139 static std::unique_ptr<FlywheelBundle> BuildFlywheel(
const LQRConfig& cfg);
140 static std::unique_ptr<ArmElevatorBundle> BuildArmElevator(
const LQRConfig& cfg);
142 std::optional<LQRConfig> m_config;
144 std::variant<std::unique_ptr<FlywheelBundle>, std::unique_ptr<ArmElevatorBundle>> m_bundle;
145 wpi::units::second_t m_period;
148 std::unique_ptr<std::mutex> m_mutex{std::make_unique<std::mutex>()};