Method attemptToSync

external/floppybridge/src/ArduinoInterface.cpp:373–446

Attempt to sync and get version

// Attempt to sync and get version
DiagnosticResponse ArduinoInterface::attemptToSync(std::string& versionString, SerialIO& port) {
	char buffer[10];

	// Send 'Version' Request 
	buffer[0] = SPECIAL_ABORT_CHAR;
	buffer[1] = COMMAND_RESET;   // Reset
	buffer[2] = COMMAND_VERSION;

	unsigned long size = port.write(&buffer[0], 3);
	if (size != 3) {
		// Couldn't write to device
		port.closePort();
		return DiagnosticResponse::drPortError;
	}

	memset(buffer, 0, sizeof buffer);
	int counterNoData = 0;
	int counterData = 0;
	int bytesRead = 0;

	// Keep a rolling buffer looking for the 1Vxxx response
	std::chrono::time_point<std::chrono::steady_clock> startTime = std::chrono::steady_clock::now();
	for (;;) {
		const auto timePassed = std::chrono::duration_cast<std::chrono::seconds>(std::chrono::steady_clock::now() - startTime).count();

		// Timeout after 8 seconds
		if (timePassed >= 8)
			return DiagnosticResponse::drPortError;

		size = port.read(&buffer[4], 1);
		bytesRead += size;
		// Was something read?
		if (size) {

			if (buffer[0] == '1' && buffer[1] == 'V' && (buffer[2] >= '1' && buffer[2] <= '9') && (buffer[3] == ',' || buffer[3] == '.') && (buffer[4] >= '0' && buffer[4] <= '9')) {

				// Success
				port.purgeBuffers();
				std::this_thread::sleep_for(std::chrono::milliseconds(1));
				port.purgeBuffers();
				versionString = &buffer[1];
				return DiagnosticResponse::drOK;
			}
			else {
				if (bytesRead) bytesRead--;
			}

			// Move backwards
			for (int a = 0; a < 4; a++) buffer[a] = buffer[a + 1];

			if (counterData++ > 2048) {
				port.closePort();
				return DiagnosticResponse::drErrorMalformedVersion;
			}
		}
		else {
			std::this_thread::sleep_for(std::chrono::milliseconds(1));
			if (counterNoData++ > 120) {