increase HZ to 50
change Hz back to 10
changed default values
changed pwm_treshold to 25
NOT ME: Changed default params
Fixed merge conflict
Changed Kd a little (the slowest wheel had a lower parameter)