diff -r 7ffbca63fc72 -r 59be91dfcbe1 tool/cmd_upload.cpp --- a/tool/cmd_upload.cpp Thu Jul 24 08:15:44 2008 +0000 +++ /dev/null Thu Jan 01 00:00:00 1970 +0000 @@ -1,172 +0,0 @@ -/***************************************************************************** - * - * $Id$ - * - ****************************************************************************/ - -#include -#include -using namespace std; - -#include "globals.h" -#include "coe_datatypes.h" - -/****************************************************************************/ - -const char *help_upload = - "[OPTIONS] \n" - "\n" - "Upload an Sdo entry from a slave.\n" - "\n" - "The data type of the Sdo entry is taken from the Sdo dictionary by\n" - "default. It can be overridden with the --type option. If the slave\n" - "does not support the Sdo information service or the Sdo is not in the\n" - "dictionary, the --type option is mandatory.\n" - "\n" - "These are the valid Sdo entry data types:\n" - " int8, int16, int32, uint8, uint16, uint32, string.\n" - "\n" - "Arguments:\n" - " INDEX is the Sdo index and must be an unsigned 16 bit number.\n" - " SUBINDEX is the Sdo entry subindex and must be an unsigned 8 bit\n" - " number.\n" - "\n" - "Command-specific options:\n" - " --slave -s Positive numerical ring position (mandatory).\n" - " --type -t Forced Sdo entry data type (see above).\n" - "\n" - "Numerical values can be specified either with decimal (no prefix),\n" - "octal (prefix '0') or hexadecimal (prefix '0x') base.\n"; - -/****************************************************************************/ - -void command_upload(void) -{ - stringstream err, strIndex, strSubIndex; - int sval; - ec_ioctl_slave_sdo_upload_t data; - unsigned int uval; - const CoEDataType *dataType = NULL; - - if (slavePosition < 0) { - err << "'" << commandName << "' requires a slave! " - << "Please specify --slave."; - throw InvalidUsageException(err); - } - data.slave_position = slavePosition; - - if (commandArgs.size() != 2) { - err << "'" << commandName << "' takes two arguments!"; - throw InvalidUsageException(err); - } - - strIndex << commandArgs[0]; - strIndex - >> resetiosflags(ios::basefield) // guess base from prefix - >> data.sdo_index; - if (strIndex.fail()) { - err << "Invalid Sdo index '" << commandArgs[0] << "'!"; - throw InvalidUsageException(err); - } - - strSubIndex << commandArgs[1]; - strSubIndex - >> resetiosflags(ios::basefield) // guess base from prefix - >> uval; - if (strSubIndex.fail() || uval > 0xff) { - err << "Invalid Sdo subindex '" << commandArgs[1] << "'!"; - throw InvalidUsageException(err); - } - data.sdo_entry_subindex = uval; - - if (dataTypeStr != "") { // data type specified - if (!(dataType = findDataType(dataTypeStr))) { - err << "Invalid data type '" << dataTypeStr << "'!"; - throw InvalidUsageException(err); - } - } else { // no data type specified: fetch from dictionary - ec_ioctl_slave_sdo_entry_t entry; - - masterDev.open(MasterDevice::Read); - - try { - masterDev.getSdoEntry(&entry, slavePosition, - data.sdo_index, data.sdo_entry_subindex); - } catch (MasterDeviceException &e) { - err << "Failed to determine Sdo entry data type. " - << "Please specify --type."; - throw CommandException(err); - } - if (!(dataType = findDataType(entry.data_type))) { - err << "Pdo entry has unknown data type 0x" - << hex << setfill('0') << setw(4) << entry.data_type << "!" - << " Please specify --type."; - throw CommandException(err); - } - } - - if (dataType->byteSize) { - data.target_size = dataType->byteSize; - } else { - data.target_size = DefaultBufferSize; - } - - data.target = new uint8_t[data.target_size + 1]; - - masterDev.open(MasterDevice::Read); - - try { - masterDev.sdoUpload(&data); - } catch (MasterDeviceException &e) { - delete [] data.target; - throw e; - } - - masterDev.close(); - - if (dataType->byteSize && data.data_size != dataType->byteSize) { - err << "Data type mismatch. Expected " << dataType->name - << " with " << dataType->byteSize << " byte, but got " - << data.data_size << " byte."; - throw CommandException(err); - } - - cout << setfill('0'); - switch (dataType->coeCode) { - case 0x0002: // int8 - sval = *(int8_t *) data.target; - cout << sval << " 0x" << hex << setw(2) << sval << endl; - break; - case 0x0003: // int16 - sval = le16tocpu(*(int16_t *) data.target); - cout << sval << " 0x" << hex << setw(4) << sval << endl; - break; - case 0x0004: // int32 - sval = le32tocpu(*(int32_t *) data.target); - cout << sval << " 0x" << hex << setw(8) << sval << endl; - break; - case 0x0005: // uint8 - uval = (unsigned int) *(uint8_t *) data.target; - cout << uval << " 0x" << hex << setw(2) << uval << endl; - break; - case 0x0006: // uint16 - uval = le16tocpu(*(uint16_t *) data.target); - cout << uval << " 0x" << hex << setw(4) << uval << endl; - break; - case 0x0007: // uint32 - uval = le32tocpu(*(uint32_t *) data.target); - cout << uval << " 0x" << hex << setw(8) << uval << endl; - break; - case 0x0009: // string - cout << string((const char *) data.target, data.data_size) - << endl; - break; - default: - printRawData(data.target, data.data_size); - break; - } - - delete [] data.target; -} - -/*****************************************************************************/