Started adding infrastructure for collision testing
Started obstacle collision test
Added centroid and more collision stuff