added motors
drivers and accel testing

-added 3rd party accelerometer drivers
-added motors from teleop setup
accelerometer changes

-added displacement formula
-added while loop that can be adjusted later on
Merge pull request #1 from Tryptophan/autonomous

Autonomous