Adding Matrix4, need to test

There really is just no way to write an elegant 4x4 matrix inverse. It's
so hideous
Testing bbox and fixing one typo