Finalize queue test
Add makefile for queue test
Queue passes unit test