Fixed setMovement function

Took away divide by three

Added stop and wait in setMovementTest

Made new encoder file