Added some more convenience functions to Vector
Moved test code into separate class.

The code that tests SAT was moved to the SATSample class.