Added code to zero encoders