Sabina Davis | b6b987d | 2017-10-22 20:50:21 -0700 | [diff] [blame] | 1 | package y2017_bot3.control_loops; |
| 2 | |
John Park | 33858a3 | 2018-09-28 23:05:48 -0700 | [diff] [blame^] | 3 | import "aos/controls/control_loops.q"; |
Sabina Davis | b6b987d | 2017-10-22 20:50:21 -0700 | [diff] [blame] | 4 | import "frc971/control_loops/control_loops.q"; |
| 5 | |
| 6 | queue_group SuperstructureQueue { |
| 7 | implements aos.control_loops.ControlLoop; |
| 8 | |
| 9 | message Goal { |
Sabina Davis | 5800439 | 2017-10-22 23:45:46 -0700 | [diff] [blame] | 10 | // Voltage from -12 to 12 to send to the rollers. Positive is front surface |
| 11 | // of the roller is moving down when gear is moving inwards. |
Sabina Davis | b6b987d | 2017-10-22 20:50:21 -0700 | [diff] [blame] | 12 | float voltage_rollers; |
Sabina Davis | 5800439 | 2017-10-22 23:45:46 -0700 | [diff] [blame] | 13 | // State of finger pistons. True is out, false is in. |
Sabina Davis | b6b987d | 2017-10-22 20:50:21 -0700 | [diff] [blame] | 14 | bool fingers_out; |
Sabina Davis | 5800439 | 2017-10-22 23:45:46 -0700 | [diff] [blame] | 15 | // Voltage from -12 to 12 sent to the hanger roller. Positive is front |
| 16 | // surface of the hanger is moving down. |
Sabina Davis | b6b987d | 2017-10-22 20:50:21 -0700 | [diff] [blame] | 17 | float hanger_voltage; |
Sabina Davis | 5800439 | 2017-10-22 23:45:46 -0700 | [diff] [blame] | 18 | }; |
Sabina Davis | b6b987d | 2017-10-22 20:50:21 -0700 | [diff] [blame] | 19 | |
| 20 | message Status { |
| 21 | }; |
| 22 | |
| 23 | message Position { |
| 24 | }; |
| 25 | |
| 26 | message Output { |
Sabina Davis | 5800439 | 2017-10-22 23:45:46 -0700 | [diff] [blame] | 27 | // see above |
Sabina Davis | b6b987d | 2017-10-22 20:50:21 -0700 | [diff] [blame] | 28 | float voltage_rollers; |
| 29 | bool fingers_out; |
| 30 | float hanger_voltage; |
| 31 | }; |
| 32 | |
| 33 | queue Goal goal; |
| 34 | queue Output output; |
| 35 | queue Status status; |
| 36 | queue Position position; |
| 37 | }; |
| 38 | |
| 39 | queue_group SuperstructureQueue superstructure_queue; |