Code cleanup and refactoring

Minor changes, moved invert turn encoder readout in Swerve Module class
to constructor