Add beginning of red black tree implementation