add init world and step func
commit
Merge pull request #5 from VasyaSV/master

add ground