Add space query methods
[physics] Fix coordinate conversion methods
[physics] Add constraints and joints