First physics commit
Refactored physics branch