1

/*****************************************************************************

     2

 *

    27

 *

    28

 ****************************************************************************/

    29

    30

#include "SdoCommand.h"

    31

    32

/*****************************************************************************/

    33

    34

SdoCommand::SdoCommand(const string &name, const string &briefDesc):

    35

    Command(name, briefDesc)

    36

{

    37

}

    38

    39

/****************************************************************************/

    40

    41

const SdoCommand::DataType *SdoCommand::findDataType(const string &str)

    42

{

    43

    const DataType *d;

    44

    45

    for (d = dataTypes; d->name; d++)

    46

        if (str == d->name)

    47

            return d;

    48

    49

    return NULL;

    50

}

    51

    52

/****************************************************************************/

    53

    54

const SdoCommand::DataType *SdoCommand::findDataType(uint16_t code)

    55

{

    56

    const DataType *d;

    57

    58

    for (d = dataTypes; d->name; d++)

    59

        if (code == d->coeCode)

    60

            return d;

    61

    62

    return NULL;

    63

}

    64

    65

/****************************************************************************/

    66

    67

const char *SdoCommand::abortText(uint32_t abortCode)

    68

{

    69

    const AbortMessage *abortMsg;

    70

    71

    for (abortMsg = abortMessages; abortMsg->code; abortMsg++) {

    72

        if (abortMsg->code == abortCode) {

    73

            return abortMsg->message;

    74

        }

    75

    }

    76

    77

    return "???";

    78

}

    79

    80

/****************************************************************************/

    81

    82

const SdoCommand::DataType SdoCommand::dataTypes[] = {

    83

    {"int8",         0x0002, 1},

    84

    {"int16",        0x0003, 2},

    85

    {"int32",        0x0004, 4},

    86

    {"uint8",        0x0005, 1},

    87

    {"uint16",       0x0006, 2},

    88

    {"uint32",       0x0007, 4},

    89

    {"string",       0x0009, 0},

    90

    {"octet_string", 0x000a, 0},

    91

    {"raw",          0xffff, 0},

    92

    {}

    93

};

    94

    95

/*****************************************************************************/

    96

    97

/** SDO abort messages.

    98

 *

    99

 * The "Abort SDO transfer request" supplies an abort code, which can be

   100

 * translated to clear text. This table does the mapping of the codes and

   101

 * messages.

   102

 */

   103

const SdoCommand::AbortMessage SdoCommand::abortMessages[] = {

   104

    {0x05030000, "Toggle bit not changed"},

   105

    {0x05040000, "SDO protocol timeout"},

   106

    {0x05040001, "Client/Server command specifier not valid or unknown"},

   107

    {0x05040005, "Out of memory"},

   108

    {0x06010000, "Unsupported access to an object"},

   109

    {0x06010001, "Attempt to read a write-only object"},

   110

    {0x06010002, "Attempt to write a read-only object"},

   111

    {0x06020000, "This object does not exist in the object directory"},

   112

    {0x06040041, "The object cannot be mapped into the PDO"},

   113

    {0x06040042, "The number and length of the objects to be mapped would"

   114

     " exceed the PDO length"},

   115

    {0x06040043, "General parameter incompatibility reason"},

   116

    {0x06040047, "Gerneral internal incompatibility in device"},

   117

    {0x06060000, "Access failure due to a hardware error"},

   118

    {0x06070010, "Data type does not match, length of service parameter does"

   119

     " not match"},

   120

    {0x06070012, "Data type does not match, length of service parameter too"

   121

     " high"},

   122

    {0x06070013, "Data type does not match, length of service parameter too"

   123

     " low"},

   124

    {0x06090011, "Subindex does not exist"},

   125

    {0x06090030, "Value range of parameter exceeded"},

   126

    {0x06090031, "Value of parameter written too high"},

   127

    {0x06090032, "Value of parameter written too low"},

   128

    {0x06090036, "Maximum value is less than minimum value"},

   129

    {0x08000000, "General error"},

   130

    {0x08000020, "Data cannot be transferred or stored to the application"},

   131

    {0x08000021, "Data cannot be transferred or stored to the application"

   132

     " because of local control"},

   133

    {0x08000022, "Data cannot be transferred or stored to the application"

   134

     " because of the present device state"},

   135

    {0x08000023, "Object dictionary dynamic generation fails or no object"

   136

     " dictionary is present"},

   137

    {}

   138

};

   139

   140

/****************************************************************************/