fixed some bugs in Physics
Merge pull request #16 from GSP420/Fixed-Physics

fixed some bugs in Physics