Queue improvements

* Change Insert() to Enqueue()
* Add some debug statements
* Change insertion to correctly round robin