Add calcuation of velocity and acceleration.

NOTE: Magnitude of force (i.e. acceleration from calc_accel) is inverted
in sign, should be positive.
TODO: Translate video coordinates to cartesian. Should fix above.
TODO: Refactor to remove class