Now control correctly all 4 axis, extruder included
+ added parameter to invert axis
+ corrected set_position function