Here's our code for Jacknife, our 2016 robot. Some of the programmers out there may want to have a look at how we managed the Class C defenses in both auto and teleop. The code works well but it's not beautifully structured. I've also attached a document that attempts to show the key elements that needed to work together for our drawbridge crossing to be successful.
https://github.com/Woodland4678/Cybe...eases/tag/V1.0
Thanks, from
Team 4678, The Woodland CyberCavs.