calculateAveragedVelocityAndAcceleration

This calculates an averaged approximate velocity and acceleration. This is used for a real-time correction of centripetal force, which is used in teleop.