fixed the vision and moved the encoder reset