Drivetrain speed function does not account for acceleration

Some users expect that when they make a robot drive for a speed over a period of time, the robot will drive an exact distance. Currently it will always undershoot that distance. 

It could be worth testing if there is a more intuitive algorithm.