void CommandFoeRead::execute(const StringVector &args) { SlaveList slaves; ec_ioctl_slave_t *slave; ec_ioctl_slave_foe_t data; unsigned int i; stringstream err; if (args.size() != 1) { err << "'" << getName() << "' takes exactly one argument!"; throwInvalidUsageException(err); } MasterDevice m(getSingleMasterIndex()); m.open(MasterDevice::Read); slaves = selectedSlaves(m); if (slaves.size() != 1) { throwSingleSlaveRequired(slaves.size()); } slave = &slaves.front(); data.slave_position = slave->position; /* FIXME: No good idea to have a fixed buffer size. * Read in chunks and fill a buffer instead. */ data.offset = 0; data.buffer_size = 0x8800; data.buffer = new uint8_t[data.buffer_size]; strncpy(data.file_name, args[0].c_str(), sizeof(data.file_name)); try { m.readFoe(&data); } catch (MasterDeviceException &e) { delete [] data.buffer; if (data.result) { if (data.result == FOE_OPCODE_ERROR) { err << "FoE read aborted with error code 0x" << setw(8) << setfill('0') << hex << data.error_code << ": " << errorText(data.error_code); } else { err << "Failed to write via FoE: " << resultText(data.result); } throwCommandException(err); } else { throw e; } } // TODO --output-file for (i = 0; i < data.data_size; i++) { uint8_t *w = data.buffer + i; cout << *(uint8_t *) w ; } delete [] data.buffer; }
void CommandFoeWrite::execute(const StringVector &args) { stringstream err; ec_ioctl_slave_foe_t data; ifstream file; SlaveList slaves; string storeFileName; if (args.size() != 1) { err << "'" << getName() << "' takes exactly one argument!"; throwInvalidUsageException(err); } if (args[0] == "-") { loadFoeData(&data, cin); if (getOutputFile().empty()) { err << "Please specify a filename for the slave side" << " with --output-file!"; throwCommandException(err); } else { storeFileName = getOutputFile(); } } else { file.open(args[0].c_str(), ifstream::in | ifstream::binary); if (file.fail()) { err << "Failed to open '" << args[0] << "'!"; throwCommandException(err); } loadFoeData(&data, file); file.close(); if (getOutputFile().empty()) { char *cpy = strdup(args[0].c_str()); // basename can modify // the string contents storeFileName = basename(cpy); free(cpy); } else { storeFileName = getOutputFile(); } } MasterDevice m(getSingleMasterIndex()); try { m.open(MasterDevice::ReadWrite); } catch (MasterDeviceException &e) { if (data.buffer_size) delete [] data.buffer; throw e; } slaves = selectedSlaves(m); if (slaves.size() != 1) { if (data.buffer_size) delete [] data.buffer; throwSingleSlaveRequired(slaves.size()); } data.slave_position = slaves.front().position; // write data via foe to the slave data.offset = 0; strncpy(data.file_name, storeFileName.c_str(), sizeof(data.file_name)); try { m.writeFoe(&data); } catch (MasterDeviceException &e) { if (data.buffer_size) delete [] data.buffer; if (data.result) { if (data.result == FOE_OPCODE_ERROR) { err << "FoE write aborted with error code 0x" << setw(8) << setfill('0') << hex << data.error_code << ": " << errorText(data.error_code); } else { err << "Failed to write via FoE: " << resultText(data.result); } throwCommandException(err); } else { throw e; } } if (getVerbosity() == Verbose) { cerr << "FoE writing finished." << endl; } if (data.buffer_size) delete [] data.buffer; }