[Swerve Setpoint Generator] Raise kEpsilon from 1e-8 to 1e-6

[Swerve Setpoint Generator] Raise kEpsilon from 1e-8 to 1e-6 #1208