Add rbtree.h
Implement first test case