Cleanup hardware queue

Some code cleanup. 
This won't work with automatic makefile generation in Atmel Studio unless include paths are changed...
I think it should be left as it was...