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