finished writing test

* Finished writing the test function

*Added .h file to to MainProgram.c