encoders working, everything drives and sensors work