diff -r 7ffbca63fc72 -r 59be91dfcbe1 tool/cmd_download.cpp --- a/tool/cmd_download.cpp Thu Jul 24 08:15:44 2008 +0000 +++ /dev/null Thu Jan 01 00:00:00 1970 +0000 @@ -1,203 +0,0 @@ -/***************************************************************************** - * - * $Id$ - * - ****************************************************************************/ - -#include -#include -using namespace std; - -#include "globals.h" -#include "coe_datatypes.h" - -/****************************************************************************/ - -const char *help_download = - "[OPTIONS] \n" - "\n" - "Download an Sdo entry to 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" - " VALUE is the value to download and must correspond to the Sdo\n" - " entry datatype (see above).\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_download(void) -{ - stringstream strIndex, strSubIndex, strValue, err; - ec_ioctl_slave_sdo_download_t data; - unsigned int number; - 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() != 3) { - err << "'" << commandName << "' takes 3 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 - >> number; - if (strSubIndex.fail() || number > 0xff) { - err << "Invalid Sdo subindex '" << commandArgs[1] << "'!"; - throw InvalidUsageException(err); - } - data.sdo_entry_subindex = number; - - 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::ReadWrite); - - 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.data_size = dataType->byteSize; - } else { - data.data_size = DefaultBufferSize; - } - - data.data = new uint8_t[data.data_size + 1]; - - strValue << commandArgs[2]; - strValue >> resetiosflags(ios::basefield); // guess base from prefix - strValue.exceptions(ios::failbit); - - try { - switch (dataType->coeCode) { - case 0x0002: // int8 - { - int16_t val; // uint8_t is interpreted as char - strValue >> val; - if (val > 127 || val < -128) - throw ios::failure("Value out of range"); - *data.data = val; - break; - } - case 0x0003: // int16 - { - int16_t val; - strValue >> val; - *(int16_t *) data.data = cputole16(val); - break; - } - case 0x0004: // int32 - { - int32_t val; - strValue >> val; - *(int32_t *) data.data = cputole32(val); - break; - } - case 0x0005: // uint8 - { - uint16_t val; // uint8_t is interpreted as char - strValue >> val; - if (val > 0xff) - throw ios::failure("Value out of range"); - *data.data = val; - break; - } - case 0x0006: // uint16 - { - uint16_t val; - strValue >> val; - *(uint16_t *) data.data = cputole16(val); - break; - } - case 0x0007: // uint32 - { - uint32_t val; - strValue >> val; - *(uint32_t *) data.data = cputole32(val); - break; - } - case 0x0009: // string - if (strValue.str().size() >= data.data_size) { - err << "String too large"; - throw CommandException(err); - } - data.data_size = strValue.str().size(); - strValue >> (char *) data.data; - break; - - default: - delete [] data.data; - err << "Unknown data type 0x" << hex << dataType->coeCode; - throw CommandException(err); - } - } catch (ios::failure &e) { - delete [] data.data; - err << "Invalid value argument '" << commandArgs[2] - << "' for type '" << dataType->name << "'!"; - throw InvalidUsageException(err); - } - - masterDev.open(MasterDevice::ReadWrite); - - try { - masterDev.sdoDownload(&data); - } catch(MasterDeviceException &e) { - delete [] data.data; - throw e; - } - - delete [] data.data; -} - -/*****************************************************************************/