Arm works
Added gravity and calibrated it. Terifying...
Change-Id: I70babb1cd3b83ddd7a81f06fb2a75cefd55bcdb8
diff --git a/y2018/control_loops/superstructure/arm/BUILD b/y2018/control_loops/superstructure/arm/BUILD
index 57b60e6..997d940 100644
--- a/y2018/control_loops/superstructure/arm/BUILD
+++ b/y2018/control_loops/superstructure/arm/BUILD
@@ -9,6 +9,7 @@
visibility = ["//visibility:public"],
deps = [
":dynamics",
+ "//aos/common/logging",
"//frc971/control_loops:dlqr",
"//frc971/control_loops:jacobian",
"//third_party/eigen",
@@ -42,6 +43,7 @@
deps = [
"//frc971/control_loops:runge_kutta",
"//third_party/eigen",
+ "//third_party/gflags",
],
)
@@ -76,6 +78,7 @@
":ekf",
":trajectory",
"//third_party/eigen",
+ "//third_party/gflags",
"//third_party/matplotlib-cpp",
],
)
@@ -110,3 +113,24 @@
"//aos/testing:googletest",
],
)
+
+cc_library(
+ name = "arm",
+ srcs = [
+ "arm.cc",
+ ],
+ hdrs = [
+ "arm.h",
+ ],
+ visibility = ["//visibility:public"],
+ deps = [
+ ":demo_path",
+ ":ekf",
+ ":graph",
+ ":trajectory",
+ "//aos/common/logging:queue_logging",
+ "//frc971/zeroing",
+ "//y2018:constants",
+ "//y2018/control_loops/superstructure:superstructure_queue",
+ ],
+)