Slight changes to setAngle() in SwerveModule, made diagnostic code use an array for all of the keys