Added velocity recursion and placed InitParticle test code to proper place