1

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

     2

 *

     3

 * $Id$

     4

 *

     5

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

     6

     7

#include "SdoCommand.h"

     8

     9

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

    10

    11

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

    12

    Command(name, briefDesc)

    13

{

    14

}

    15

    16

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

    17

    18

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

    19

{

    20

    const DataType *d;

    21

    22

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

    23

        if (str == d->name)

    24

            return d;

    25

    26

    return NULL;

    27

}

    28

    29

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

    30

    31

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

    32

{

    33

    const DataType *d;

    34

    35

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

    36

        if (code == d->coeCode)

    37

            return d;

    38

    39

    return NULL;

    40

}

    41

    42

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

    43

    44

const char *SdoCommand::abortText(uint32_t abortCode)

    45

{

    46

    const AbortMessage *abortMsg;

    47

    48

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

    49

        if (abortMsg->code == abortCode) {

    50

            return abortMsg->message;

    51

        }

    52

    }

    53

    54

    return "???";

    55

}

    56

    57

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

    58

    59

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

    60

    {"int8",         0x0002, 1},

    61

    {"int16",        0x0003, 2},

    62

    {"int32",        0x0004, 4},

    63

    {"uint8",        0x0005, 1},

    64

    {"uint16",       0x0006, 2},

    65

    {"uint32",       0x0007, 4},

    66

    {"string",       0x0009, 0},

    67

    {"octet_string", 0x000a, 0},

    68

    {"raw",          0xffff, 0},

    69

    {}

    70

};

    71

    72

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

    73

    74

/** SDO abort messages.

    75

 *

    76

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

    77

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

    78

 * messages.

    79

 */

    80

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

    81

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

    82

    {0x05040000, "SDO protocol timeout"},

    83

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

    84

    {0x05040005, "Out of memory"},

    85

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

    86

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

    87

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

    88

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

    89

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

    90

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

    91

     " exceed the PDO length"},

    92

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

    93

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

    94

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

    95

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

    96

     " not match"},

    97

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

    98

     " high"},

    99

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

   100

     " low"},

   101

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

   102

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

   103

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

   104

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

   105

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

   106

    {0x08000000, "General error"},

   107

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

   108

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

   109

     " because of local control"},

   110

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

   111

     " because of the present device state"},

   112

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

   113

     " dictionary is present"},

   114

    {}

   115

};

   116

   117

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