Got some more drivetrain work done... for like the third time... next commit will try to get ready to be tested. also added some work on calculating acceleration to graph

-Kabir