Added basic physics loop and rigid body initialization