Split out superstructure into arm and intake state feedback loops.
This is more code for the structure of the superstructure control loop.
Change-Id: I4abc83b04c57174ce087be0932e777cafdce8373
diff --git a/y2016/control_loops/superstructure/BUILD b/y2016/control_loops/superstructure/BUILD
index 183c3c0..b9628f6 100644
--- a/y2016/control_loops/superstructure/BUILD
+++ b/y2016/control_loops/superstructure/BUILD
@@ -29,32 +29,17 @@
)
genrule(
- name = 'genrule_shoulder',
+ name = 'genrule_arm',
visibility = ['//visibility:private'],
- cmd = '$(location //y2016/control_loops/python:shoulder) $(OUTS)',
+ cmd = '$(location //y2016/control_loops/python:arm) $(OUTS)',
tools = [
- '//y2016/control_loops/python:shoulder',
+ '//y2016/control_loops/python:arm',
],
outs = [
- 'shoulder_plant.h',
- 'shoulder_plant.cc',
- 'integral_shoulder_plant.h',
- 'integral_shoulder_plant.cc',
- ],
-)
-
-genrule(
- name = 'genrule_wrist',
- visibility = ['//visibility:private'],
- cmd = '$(location //y2016/control_loops/python:wrist) $(OUTS)',
- tools = [
- '//y2016/control_loops/python:wrist',
- ],
- outs = [
- 'wrist_plant.h',
- 'wrist_plant.cc',
- 'integral_wrist_plant.h',
- 'integral_wrist_plant.cc',
+ 'arm_plant.h',
+ 'arm_plant.cc',
+ 'integral_arm_plant.h',
+ 'integral_arm_plant.cc',
],
)
@@ -62,19 +47,15 @@
name = 'superstructure_plants',
srcs = [
'intake_plant.cc',
- 'shoulder_plant.cc',
- 'wrist_plant.cc',
+ 'arm_plant.cc',
'integral_intake_plant.cc',
- 'integral_shoulder_plant.cc',
- 'integral_wrist_plant.cc',
+ 'integral_arm_plant.cc',
],
hdrs = [
'intake_plant.h',
- 'shoulder_plant.h',
- 'wrist_plant.h',
+ 'arm_plant.h',
'integral_intake_plant.h',
- 'integral_shoulder_plant.h',
- 'integral_wrist_plant.h',
+ 'integral_arm_plant.h',
],
deps = [
'//frc971/control_loops:state_feedback_loop',
@@ -91,8 +72,12 @@
],
deps = [
':superstructure_queue',
+ ':superstructure_plants',
'//aos/common/controls:control_loop',
+ '//aos/common/util:trapezoid_profile',
'//frc971/control_loops:state_feedback_loop',
+ '//frc971/zeroing',
+ '//y2016:constants',
],
)
@@ -107,6 +92,10 @@
'//aos/testing:googletest',
'//aos/common:queues',
'//aos/common/controls:control_loop_test',
+ '//aos/common:math',
+ '//aos/common:time',
+ '//frc971/control_loops:position_sensor_sim',
+ '//frc971/control_loops:team_number_test_environment',
],
)