Correct offset values and current coefficient
Input new vlaues for current and velocity controlle, plus clean main file