Updated Buffer, and created tests
The buffer class now uses a class instead of a std::queue
. It implements a next function which runs the std::queue.front()
and std::queue.pop()
before returning the value of front element.
Also added a fix to wait after the GPIO reset, In non verbose mode it didn't give enough time for the board to reset, and therefore never work in non verbose mode