Complete code and test code for 3 and 4 nodes
Added code and test code for red black tree removal (Incomplete)
Code not fully optimized yet