Now waiting 4 steps before stopping a turn. Need to check with Alex the homing function, and ask Alberto about the switch between positionControl and positionDirect
Tuned parameters for bigger feet, added some TODO flags to check with Alex