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;
}
