Initial setup for rigid bodies
Initial implementation of Velocity Verlet Integration method