Method sendCommand

external/floppybridge/src/GreaseWeazleInterface.cpp:438–482

send a command out to the GW and receive its response. Returns FALSE on error

// send a command out to the GW and receive its response.  Returns FALSE on error
bool GreaseWeazleInterface::sendCommand(Cmd command, void* params, unsigned int paramsLength, Ack& response, unsigned char extraResponseSize) {
	std::vector<unsigned char> data;
	data.resize(paramsLength + 2);
	data[0] = (unsigned char)command;
	data[1] = 2 + paramsLength + (extraResponseSize>0 ? 1 : 0);
	if ((params) && (paramsLength)) {
#ifdef _WIN32		
		memcpy_s(((unsigned char*)data.data()) + 2, paramsLength, params, paramsLength);
#else
		memcpy(((unsigned char*)data.data()) + 2, params, paramsLength);
#endif		
	}
	if (extraResponseSize>0) data.push_back(extraResponseSize);

	// Write request
	unsigned long written = (unsigned long)m_comPort.write(data.data(), (unsigned int)data.size());
	if (written != data.size()) {
		response = Ack::BadCommand;
		return false;
	}
	
	// Read response
	unsigned char responseMsg[2];
	unsigned long read = m_comPort.read(&responseMsg, 2);
	if (read != 2) {
		if (read == 0) {
			// Try again
			read = m_comPort.read(&responseMsg, 2);
		}
		if (read != 2) {
			response = Ack::BadCommand;
			return false;
		}
	}

	response = (Ack)responseMsg[1];

	// Was it the response to the command we issued?
	if (responseMsg[0] != (unsigned char)command) {
		response = Ack::BadCommand;
		return false;
	}

	return true;
}
bool GreaseWeazleInterface::sendCommand(Cmd command, const std::vector<unsigned char>& params, Ack& response, unsigned char extraResponseSize) {
	return sendCommand(command, (void*)params.data(), (unsigned int)params.size(), response, extraResponseSize);
}