Pass KSP_DIR from makefile to test harness
Clean up mathtools functions, add missing functionality to vector class