Add y2019 superstructure, queues, constants.
Change-Id: I82b4bdfe77eff02e0dd7557491eb2e323bcf9de9
diff --git a/y2019/control_loops/superstructure/superstructure.cc b/y2019/control_loops/superstructure/superstructure.cc
new file mode 100644
index 0000000..2f0832c
--- /dev/null
+++ b/y2019/control_loops/superstructure/superstructure.cc
@@ -0,0 +1,32 @@
+#include "y2019/control_loops/superstructure/superstructure.h"
+
+#include "aos/controls/control_loops.q.h"
+#include "frc971/control_loops/control_loops.q.h"
+
+namespace y2019 {
+namespace control_loops {
+namespace superstructure {
+
+Superstructure::Superstructure(
+ SuperstructureQueue *superstructure_queue)
+ : aos::controls::ControlLoop<SuperstructureQueue>(
+ superstructure_queue) {}
+
+void Superstructure::RunIteration(
+ const SuperstructureQueue::Goal *unsafe_goal,
+ const SuperstructureQueue::Position *position,
+ SuperstructureQueue::Output *output,
+ SuperstructureQueue::Status *status) {
+ (void)unsafe_goal;
+ (void)position;
+ (void)output;
+ (void)status;
+
+ if (WasReset()) {
+ LOG(ERROR, "WPILib reset, restarting\n");
+ }
+}
+
+} // namespace superstructure
+} // namespace control_loops
+} // namespace y2019
\ No newline at end of file