This code works on the steamtrunk bot, as of January 2020. While this code works, it does not follow the subsystem-command structure we normally use with WPILib. We have plans to later implement the subsystem-command structure in this code.
Code written in January 2020 by Lenny Abbas.