Transmits now block when the buffer fills

include/icsneo/communication/icommunication.h

@@ -5,12 +5,16 @@
 #include <chrono>
 #include <atomic>
 #include <thread>
+#include <mutex>
+#include <condition_variable>
+#include "icsneo/api/errormanager.h"
 #include "icsneo/third-party/concurrentqueue/blockingconcurrentqueue.h"
 
 namespace icsneo {
 
 class ICommunication {
 public:
+	ICommunication(const device_errorhandler_t& handler) : err(handler) {}
 	virtual ~ICommunication() {}
 	virtual bool open() = 0;
 	virtual bool isOpen() = 0;
@@ -18,12 +22,21 @@ public:
 	virtual bool read(std::vector<uint8_t>& bytes, size_t limit = 0);
 	virtual bool readWait(std::vector<uint8_t>& bytes, std::chrono::milliseconds timeout = std::chrono::milliseconds(100), size_t limit = 0);
 	virtual bool write(const std::vector<uint8_t>& bytes);
+	inline void onWrite() {
+		if(writeQueue.size_approx() < (writeQueueSize * 3/4))
+			writeCV.notify_one();
+	}
+
+	device_errorhandler_t err;
+
+	size_t writeQueueSize = 50;
+	bool writeBlocks = true; // Otherwise it just fails when the queue is full
 
 protected:
 	class WriteOperation {
 	public:
 		WriteOperation() {}
-		WriteOperation(std::vector<uint8_t> b) { bytes = b; }
+		WriteOperation(const std::vector<uint8_t>& b) : bytes(b) {}
 		std::vector<uint8_t> bytes;
 	};
 	enum IOTaskState {
@@ -34,6 +47,8 @@ protected:
 	virtual void writeTask() = 0;
 	moodycamel::BlockingConcurrentQueue<uint8_t> readQueue;
 	moodycamel::BlockingConcurrentQueue<WriteOperation> writeQueue;
+	std::mutex writeMutex;
+	std::condition_variable writeCV;
 	std::thread readThread, writeThread;
 	std::atomic<bool> closing{false};
 };