reset all encoders, now possible, cleaned up motor functions a bit