Added testing function files (both .c and .h). Also tied into makefile