Fixed Axis Rotation Formula
Fixed Drive/Shooter/Control code to work with the Cypress Module
Renamed a few variables and added a few comments