Test

Add test.c and test.h file