First commit for physics engine