add queue and change heap.c

something wrong with heapsort
add rbtree and smthg unstable