Our code has been public for a while now but I figured I would post it here since there is some pretty neat stuff if you use python.
We won a Innovation in control award at the Waterloo regional particularly due to the automated stacking.
(
Warning! Code might contain some bad language)
https://github.com/Team865/tachyon
Highlights:
-ADXRS453 gyro implementation in python
-Intakes have current monitoring to prevent jamming and increase intake speed.
-Fully automated stacking
-Motion profiling implementation in python
-Gui to keep track of stacking sequence written in python.
-Cheesy Drive implementation in python