C++ Simple Thread Pool implementation