Insert and dequeue working, added printfunction