UPDATED FOR NEW ROBOT

Works with the four wheeled design now.
Made movement.c into a header file.