Implement Queue
Tidy up stack
Remove TODO