Added function for adding collision objects. Updated the test file so that it includes it. There seems to be some funny business where its saying there is a collision with the world but it doesnt seem that way.