Added tests for velocity verlet (moving only) and fixed a couple of bugs on the way