1

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

     2

 *

     3

 * $Id$

     4

 *

     5

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

     6

     7

#include <iostream>

     8

#include <iomanip>

     9

using namespace std;

    10

    11

#include "globals.h"

    12

#include "coe_datatypes.h"

    13

    14

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

    15

    16

// FIXME

    17

const char *help_sdos =

    18

    "[OPTIONS]\n"

    19

    "\n"

    20

    "\n"

    21

    "Command-specific options:\n";

    22

    23

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

    24

    25

void listSlaveSdos(uint16_t, bool);

    26

    27

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

    28

    29

void command_sdos(void)

    30

{

    31

    masterDev.open(MasterDevice::Read);

    32

    33

    if (slavePosition == -1) {

    34

        unsigned int numSlaves = masterDev.slaveCount(), i;

    35

    36

        for (i = 0; i < numSlaves; i++) {

    37

            listSlaveSdos(i, true);

    38

        }

    39

    } else {

    40

        listSlaveSdos(slavePosition, false);

    41

    }

    42

}

    43

    44

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

    45

    46

void listSlaveSdos(

    47

		uint16_t slavePosition,

    48

		bool withHeader

    49

		)

    50

{

    51

    ec_ioctl_slave_t slave;

    52

    ec_ioctl_slave_sdo_t sdo;

    53

    ec_ioctl_slave_sdo_entry_t entry;

    54

    unsigned int i, j;

    55

    const CoEDataType *d;

    56

    57

    masterDev.getSlave(&slave, slavePosition);

    58

    59

    if (withHeader)

    60

        cout << "=== Slave " << slavePosition << " ===" << endl;

    61

    62

    for (i = 0; i < slave.sdo_count; i++) {

    63

        masterDev.getSdo(&sdo, slavePosition, i);

    64

    65

        cout << "Sdo 0x"

    66

            << hex << setfill('0')

    67

            << setw(4) << sdo.sdo_index

    68

            << ", \"" << sdo.name << "\"" << endl;

    69

    70

        if (verbosity == Quiet)

    71

            continue;

    72

    73

        for (j = 0; j <= sdo.max_subindex; j++) {

    74

            masterDev.getSdoEntry(&entry, slavePosition, -i, j);

    75

    76

            cout << "  0x" << hex << setfill('0')

    77

                << setw(4) << sdo.sdo_index << ":"

    78

                << setw(2) << (unsigned int) entry.sdo_entry_subindex

    79

                << ", ";

    80

    81

            if ((d = findDataType(entry.data_type))) {

    82

                cout << d->name;

    83

            } else {

    84

                cout << "type " << setw(4) << entry.data_type;

    85

            }

    86

    87

            cout << ", " << dec << entry.bit_length << " bit, \""

    88

                << entry.description << "\"" << endl;

    89

        }

    90

    }

    91

}

    92

    93

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