Move some DrivetrainConfig types to flatbuffers
This makes it so that we can start to implement the DrivetrainConfig as
a flatbuffer.
Change-Id: I69b92fcc436e82662d01a329d048a80c67267267
Signed-off-by: James Kuszmaul <jabukuszmaul+collab@gmail.com>
diff --git a/frc971/control_loops/drivetrain/polydrivetrain.h b/frc971/control_loops/drivetrain/polydrivetrain.h
index ecdf340..a9dea7e 100644
--- a/frc971/control_loops/drivetrain/polydrivetrain.h
+++ b/frc971/control_loops/drivetrain/polydrivetrain.h
@@ -150,10 +150,10 @@
velocity /
static_cast<Scalar>(dt_config_.low_gear_ratio / dt_config_.wheel_radius);
- if (shifter_position < static_cast<Scalar>(hall_effect.clear_low)) {
+ if (shifter_position < static_cast<Scalar>(hall_effect.clear_low())) {
// We're in low gear, so return speed for that gear.
return low_gear_speed;
- } else if (shifter_position > static_cast<Scalar>(hall_effect.clear_high)) {
+ } else if (shifter_position > static_cast<Scalar>(hall_effect.clear_high())) {
// We're in high gear, so return speed for that gear.
return high_gear_speed;
}
@@ -175,11 +175,11 @@
Gear PolyDrivetrain<Scalar>::UpdateSingleGear(Gear requested_gear,
Gear current_gear) {
const Gear shift_up =
- (dt_config_.shifter_type == ShifterType::HALL_EFFECT_SHIFTER)
+ (dt_config_.shifter_type == ShifterType::kHallEffectShifter)
? Gear::SHIFTING_UP
: Gear::HIGH;
const Gear shift_down =
- (dt_config_.shifter_type == ShifterType::HALL_EFFECT_SHIFTER)
+ (dt_config_.shifter_type == ShifterType::kHallEffectShifter)
? Gear::SHIFTING_DOWN
: Gear::LOW;
if (current_gear != requested_gear) {
@@ -294,7 +294,7 @@
template <typename Scalar>
void PolyDrivetrain<Scalar>::Update(Scalar voltage_battery) {
- if (dt_config_.loop_type == LoopType::CLOSED_LOOP) {
+ if (dt_config_.loop_type == LoopType::kClosedLoop) {
loop_->mutable_X_hat()(0, 0) = kf_->X_hat()(kLeftVelocity);
loop_->mutable_X_hat()(1, 0) = kf_->X_hat()(kRightVelocity);
}
@@ -362,7 +362,7 @@
loop_->mutable_U()[i] = ::aos::Clip(U_ideal[i], -12, 12);
}
- if (dt_config_.loop_type == LoopType::OPEN_LOOP) {
+ if (dt_config_.loop_type == LoopType::kOpenLoop) {
ff_volts_.setZero();
loop_->mutable_X_hat() =
loop_->plant().A() * loop_->X_hat() + loop_->plant().B() * loop_->U();