reset implemented, doesn't look good, should make mech move one whole step at a time instead