enabled current
added current formula
current working now a 100hz.  need to make curent not update as fast