[Swerve Setpoint Generator] Raise kEpsilon from 1e-8 to 1e-6 (#957)

[Swerve Setpoint Generator] Raise kEpsilon from 1e-8 to 1e-6 (#957) #1252