167 void SetVelocity(wpi::units::turns_per_second_t velocity)
override;
176 wpi::units::newton_t feedforwardForce)
override;
183 void SetVelocity(wpi::units::meters_per_second_t velocity)
override;
345 std::optional<wpi::units::volt_t> maxInput)
override;
378 rev::spark::SparkBase* m_spark{
nullptr};
379 rev::spark::SparkClosedLoopController* m_sparkPid{
nullptr};
380 rev::spark::SparkRelativeEncoder* m_relEncoder{
nullptr};
382 rev::spark::SparkAbsoluteEncoder* m_absEncoder{
nullptr};
384 rev::RelativeEncoder* m_quadratureEncoder{
nullptr};
386 rev::detached::DetachedEncoder* m_detachedEncoder{
nullptr};
388 double m_detachedEncoderZeroOffset{0.0};
390 double m_absEncoderZeroOffset{0.0};
392 wpi::units::turn_t m_detachedEncoderSimAngle{0.0};
393 wpi::math::DCMotor m_motor;
397 std::optional<rev::spark::SparkMaxConfig> m_maxConfig;
398 std::optional<rev::spark::SparkFlexConfig> m_flexConfig;
400 std::optional<wpi::sim::DCMotorSim> m_motorSim;
401 std::optional<rev::spark::SparkSim> m_sparkSim;
402 std::optional<rev::spark::SparkRelativeEncoderSim> m_relEncoderSim;
403 std::optional<rev::spark::SparkAbsoluteEncoderSim> m_absEncoderSim;
404 std::optional<rev::spark::SparkMaxAlternateEncoderSim> m_altEncoderSim;
405 std::optional<rev::spark::SparkExternalEncoderSim> m_extEncoderSim;
406 math::DerivativeTimeFilter m_accelFilter{20_ms};
412 double m_mechanismToFeedbackSensorRatio{1.0};
414 bool m_velocityGainsApplied{
false};
416 std::optional<wpi::math::TrapezoidProfile<wpi::units::turns>::State> m_simMaxMotionState;
418 rev::spark::SparkLowLevel::ControlType m_positionControlType{
419 rev::spark::SparkLowLevel::ControlType::kPosition};
420 rev::spark::SparkLowLevel::ControlType m_velocityControlType{
421 rev::spark::SparkLowLevel::ControlType::kVelocity};
423 rev::spark::ClosedLoopSlot m_closedLoopSlot{rev::spark::ClosedLoopSlot::kSlot0};
425 std::optional<wpi::util::Alert> m_rioControllerAlert;
427 std::optional<wpi::util::Alert> m_feedbackNotAppliedAlert;
430 std::optional<wpi::units::second_t> m_velocityMeasurementDelay;
432 wpi::units::second_t m_velocitySignalPeriod{0.02};
434 std::optional<wpi::util::Alert> m_feedforwardNotAppliedAlert;
436 void Init(rev::spark::SparkBase* spark, wpi::math::DCMotor motor,
437 SmartMotorControllerConfig* config);
439 rev::spark::SparkBaseConfig& SparkConfig();
441 bool ConfigureSpark(
const std::function<rev::REVLibError()>& call,
442 wpi::units::second_t retryFor = wpi::units::second_t{0.015});
452 bool ConfigureSpark(rev::spark::SparkBaseConfig& config);
461 bool ConfigureSpark(rev::spark::ClosedLoopConfig& closedLoop);
470 bool ConfigureSpark(rev::spark::FeedForwardConfig& feedForward);
472 rev::PersistMode PersistModeForState()
const;
474 void ConfigureAsync();
476 std::string AlertId(
const std::string& alertType)
const;
478 void ApplyFeedback(
double kP,
double kI,
double kD);
480 double MechanismToExternalEncoderRatio()
const;
482 void UpdateFeedbackSensorRatio(
const SmartMotorControllerConfig& config);
484 void WriteSparkPID(
double kP,
double kI,
double kD, rev::spark::ClosedLoopSlot slot);
486 void WriteSparkFeedforward(
double kS,
double kV,
double kA, rev::spark::ClosedLoopSlot slot);
490 void WriteMotionProfile(
const SmartMotorControllerConfig& config);
492 void WriteClosedLoopTolerance(
const SmartMotorControllerConfig& config);
494 void WriteSoftLimits(
const SmartMotorControllerConfig& config);
496 void RewriteScaledParameters();
498 void UseVelocityGains(
bool velocity);
500 void ApplyExternalEncoder(
const SmartMotorControllerConfig& config,
bool useExternalEncoder);
502 std::optional<wpi::units::turn_t> GetExternalEncoderSensorPosition();
504 std::optional<wpi::units::turns_per_second_t> GetExternalEncoderSensorVelocity();
506 void IterateSimulatedMaxMotionPosition();
511 void IterateSimulatedArmGravity();
513 bool SimulatingMaxMotion()
const;
515 bool HasExponentialProfile()
const;