Added lots of basic collision classes and matrix utilities