Add some functions to vec.h/.c and test some collision magic.