Convert drive commands and drivetrain constants to Java

[zanealoia]

The Drive commands file and Drivetrain constants file should be converted to Java. It will then be debugged and combined with the swerve systems and tested to ensure it works.