Work on Queue implementation

Need to fix buggs with queue to work with tree_nodes