Added column and tests
The column works! We can also shut the intake down for hanging.
Change-Id: I4369d489d1a07a688f204fd9bb00ef7ad787f5a3
diff --git a/y2017/wpilib_interface.cc b/y2017/wpilib_interface.cc
index 09d36a6..2873d2c 100644
--- a/y2017/wpilib_interface.cc
+++ b/y2017/wpilib_interface.cc
@@ -334,7 +334,7 @@
CopyPosition(indexer_counter_, &superstructure_message->column.indexer,
Values::kIndexerEncoderCountsPerRevolution,
- Values::kIndexerEncoderRatio, true);
+ Values::kIndexerEncoderRatio, false);
superstructure_message->theta_shooter =
encoder_translate(shooter_encoder_->GetRaw(),
@@ -347,7 +347,7 @@
CopyPosition(turret_counter_, &superstructure_message->column.turret,
Values::kTurretEncoderCountsPerRevolution,
- Values::kTurretEncoderRatio, true);
+ Values::kTurretEncoderRatio, false);
superstructure_message.Send();
}
@@ -530,9 +530,8 @@
-kMaxBringupPower, kMaxBringupPower) /
12.0);
intake_rollers_victor_->SetSpeed(queue->voltage_intake_rollers / 12.0);
- indexer_victor_->SetSpeed(queue->voltage_indexer / 12.0);
- indexer_roller_victor_->SetSpeed(queue->voltage_indexer_rollers /
- 12.0);
+ indexer_victor_->SetSpeed(-queue->voltage_indexer / 12.0);
+ indexer_roller_victor_->SetSpeed(queue->voltage_indexer_rollers / 12.0);
turret_victor_->SetSpeed(::aos::Clip(-queue->voltage_turret,
-kMaxBringupPower, kMaxBringupPower) /
12.0);