1

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

     2

 *

     3

 * $Id$

     4

 *

     5

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

     6

     7

#include <iostream>

     8

#include <iomanip>

     9

using namespace std;

    10

    11

#include "CommandXml.h"

    12

    13

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

    14

    15

CommandXml::CommandXml():

    16

    Command("xml", "Generate slave information XML.")

    17

{

    18

}

    19

    20

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

    21

    22

string CommandXml::helpString() const

    23

{

    24

    stringstream str;

    25

    26

    str << getName() << " [OPTIONS]" << endl

    27

        << endl

    28

        << getBriefDescription() << endl

    29

        << endl

    30

        << "Note that the Pdo information can either originate" << endl

    31

        << "from the SII or from the CoE communication area. For" << endl

    32

        << "slaves, that support configuring Pdo assignment and" << endl

    33

        << "mapping, the output depends on the last configuration." << endl

    34

        << endl

    35

        << "Command-specific options:" << endl

    36

        << "  --slave -s <index>  Positive numerical ring position," << endl

    37

        << "                      or 'all' for all slaves (default)." << endl

    38

        << endl

    39

        << numericInfo();

    40

    41

    return str.str();

    42

}

    43

    44

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

    45

    46

void CommandXml::execute(MasterDevice &m, const StringVector &args)

    47

{

    48

    SlaveList slaves;

    49

    SlaveList::const_iterator si;

    50

    51

    m.open(MasterDevice::Read);

    52

    slaves = selectedSlaves(m);

    53

    54

    for (si = slaves.begin(); si != slaves.end(); si++) {

    55

        generateSlaveXml(m, *si);

    56

    }

    57

}

    58

    59

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

    60

    61

void CommandXml::generateSlaveXml(

    62

        MasterDevice &m,

    63

        const ec_ioctl_slave_t &slave

    64

        )

    65

{

    66

    ec_ioctl_slave_sync_t sync;

    67

    ec_ioctl_slave_sync_pdo_t pdo;

    68

    string pdoType;

    69

    ec_ioctl_slave_sync_pdo_entry_t entry;

    70

    unsigned int i, j, k;

    71

    72

    cout

    73

        << "<?xml version=\"1.0\" ?>" << endl

    74

        << "  <EtherCATInfo>" << endl

    75

        << "    <!-- Slave " << slave.position << " -->" << endl

    76

        << "    <Vendor>" << endl

    77

        << "      <Id>" << slave.vendor_id << "</Id>" << endl

    78

        << "    </Vendor>" << endl

    79

        << "    <Descriptions>" << endl

    80

        << "      <Devices>" << endl

    81

        << "        <Device>" << endl

    82

        << "          <Type ProductCode=\"#x"

    83

        << hex << setfill('0') << setw(8) << slave.product_code

    84

        << "\" RevisionNo=\"#x"

    85

        << hex << setfill('0') << setw(8) << slave.revision_number

    86

        << "\">" << slave.order << "</Type>" << endl;

    87

    88

    if (strlen(slave.name)) {

    89

        cout

    90

            << "          <Name><![CDATA["

    91

            << slave.name

    92

            << "]]></Name>" << endl;

    93

    }

    94

    95

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

    96

        m.getSync(&sync, slave.position, i);

    97

    98

        cout

    99

            << "          <Sm Enable=\"" << dec << (unsigned int) sync.enable

   100

            << "\" StartAddress=\"" << sync.physical_start_address

   101

            << "\" ControlByte=\"" << (unsigned int) sync.control_register

   102

            << "\" DefaultSize=\"" << sync.default_size

   103

            << "\" />" << endl;

   104

    }

   105

   106

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

   107

        m.getSync(&sync, slave.position, i);

   108

   109

        for (j = 0; j < sync.pdo_count; j++) {

   110

            m.getPdo(&pdo, slave.position, i, j);

   111

            pdoType = (sync.control_register & 0x04 ? "R" : "T");

   112

            pdoType += "xPdo";

   113

   114

            cout

   115

                << "          <" << pdoType

   116

                << " Sm=\"" << i << "\" Fixed=\"1\" Mandatory=\"1\">" << endl

   117

                << "            <Index>#x"

   118

                << hex << setfill('0') << setw(4) << pdo.index

   119

                << "</Index>" << endl

   120

                << "            <Name>" << pdo.name << "</Name>" << endl;

   121

   122

            for (k = 0; k < pdo.entry_count; k++) {

   123

                m.getPdoEntry(&entry, slave.position, i, j, k);

   124

   125

                cout

   126

                    << "            <Entry>" << endl

   127

                    << "              <Index>#x"

   128

                    << hex << setfill('0') << setw(4) << entry.index

   129

                    << "</Index>" << endl;

   130

                if (entry.index)

   131

                    cout

   132

                        << "              <SubIndex>"

   133

                        << dec << (unsigned int) entry.subindex

   134

                        << "</SubIndex>" << endl;

   135

   136

                cout

   137

                    << "              <BitLen>"

   138

                    << dec << (unsigned int) entry.bit_length

   139

                    << "</BitLen>" << endl;

   140

   141

                if (entry.index) {

   142

                    cout

   143

                        << "              <Name>" << entry.name

   144

                        << "</Name>" << endl

   145

                        << "              <DataType>";

   146

   147

                    if (entry.bit_length == 1) {

   148

                        cout << "BOOL";

   149

                    } else if (!(entry.bit_length % 8)) {

   150

                        if (entry.bit_length <= 64)

   151

                            cout << "UINT" << (unsigned int) entry.bit_length;

   152

                        else

   153

                            cout << "STRING("

   154

                                << (unsigned int) (entry.bit_length / 8)

   155

                                << ")";

   156

                    } else {

   157

                        cerr << "Invalid bit length "

   158

                            << (unsigned int) entry.bit_length << endl;

   159

                    }

   160

   161

                        cout << "</DataType>" << endl;

   162

                }

   163

   164

                cout << "            </Entry>" << endl;

   165

            }

   166

   167

            cout

   168

                << "          </" << pdoType << ">" << endl;

   169

        }

   170

    }

   171

   172

    cout

   173

        << "        </Device>" << endl

   174

        << "     </Devices>" << endl

   175

        << "  </Descriptions>" << endl

   176

        << "</EtherCATInfo>" << endl;

   177

}

   178

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