Added plumbing for piston values through elevator/intake code.
Change-Id: I786fbc1411bc26063a7b03ea5428297317d21daa
diff --git a/bot3/control_loops/intake/intake.cc b/bot3/control_loops/intake/intake.cc
index 935730b..4788a7a 100644
--- a/bot3/control_loops/intake/intake.cc
+++ b/bot3/control_loops/intake/intake.cc
@@ -19,16 +19,18 @@
const int16_t intake_movement = goal->movement;
- if (intake_movement > 0) {
+ if (intake_movement > 0.0) {
// Suck.
output->intake = kIntakeVoltageFullPower;
- } else if (intake_movement < 0) {
+ } else if (intake_movement < 0.0) {
// Spit.
output->intake = -kIntakeVoltageFullPower;
} else {
// Stationary.
output->intake = 0.0;
}
+
+ output->claw_closed = goal->claw_closed;
}
}
diff --git a/bot3/control_loops/intake/intake.q b/bot3/control_loops/intake/intake.q
index 3047f6b..c09bf87 100644
--- a/bot3/control_loops/intake/intake.q
+++ b/bot3/control_loops/intake/intake.q
@@ -7,13 +7,18 @@
message Goal {
// Positive = suck, negative = spit, zero = stationary.
- int16_t movement;
+ double movement;
+
+ bool claw_closed;
};
message Position {};
message Output {
+ // Positive or negative, depending on whether we're sucking or spitting.
double intake;
+
+ bool claw_closed;
};
message Status {};