Added test library to makefile
Made a library to do vector math with arbitrary vectors (as long as they are the same size)
Made a test program to prove the program