Fix an off-by-one initialization error in queue.
Fix an off-by-one initialization error in queue.

ene-ilies/vi-firmware,openxc/vi-firmware,ene-ilies/vi-firmware,ene-ilies/vi-firmware,mgiannikouris/vi-firmware,openxc/vi-firmware,ene-ilies/vi-firmware,mgiannikouris/vi-firmware,mgiannikouris/vi-firmware,openxc/vi-firmware,openxc/vi-firmware,mgiannikouris/vi-firmware