Create testmain.c

test program for original RBT implementation