Fifo now cleans up after itself on dequeue
Cleaned up the Sparkfun code a bit