Cleanup hardware queue

Some code cleanup. 
No do jest bardzo dobre pytanie. Skoro mamy uint16 to pewnie będą dwa bajty wpisane.