1

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

     2

 *

     3

 *  $Id$

     4

 *

     5

 *  Copyright (C) 2006-2009  Florian Pose, Ingenieurgemeinschaft IgH

     6

 *

     7

 *  This file is part of the IgH EtherCAT Master.

     8

 *

     9

 *  The IgH EtherCAT Master is free software; you can redistribute it and/or

    10

 *  modify it under the terms of the GNU General Public License version 2, as

    11

 *  published by the Free Software Foundation.

    12

 *

    13

 *  The IgH EtherCAT Master is distributed in the hope that it will be useful,

    14

 *  but WITHOUT ANY WARRANTY; without even the implied warranty of

    15

 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General

    16

 *  Public License for more details.

    17

 *

    18

 *  You should have received a copy of the GNU General Public License along

    19

 *  with the IgH EtherCAT Master; if not, write to the Free Software

    20

 *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA

    21

 *

    22

 *  ---

    23

 *

    24

 *  The license mentioned above concerns the source code only. Using the

    25

 *  EtherCAT technology and brand is only permitted in compliance with the

    26

 *  industrial property and similar rights of Beckhoff Automation GmbH.

    27

 *

    28

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

    29

    30

#include <iostream>

    31

#include <iomanip>

    32

using namespace std;

    33

    34

#include "CommandMaster.h"

    35

#include "MasterDevice.h"

    36

    37

#define MAX_TIME_STR_SIZE 50

    38

    39

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

    40

    41

CommandMaster::CommandMaster():

    42

    Command("master", "Show master and Ethernet device information.")

    43

{

    44

}

    45

    46

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

    47

    48

string CommandMaster::helpString() const

    49

{

    50

    stringstream str;

    51

    52

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

    53

        << endl

    54

        << getBriefDescription() << endl

    55

        << endl

    56

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

    57

        << "  --master -m <indices>  Master indices. A comma-separated" << endl

    58

        << "                         list with ranges is supported." << endl

    59

        << "                         Example: 1,4,5,7-9. Default: - (all)."

    60

        << endl << endl

    61

        << numericInfo();

    62

    63

    return str.str();

    64

}

    65

    66

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

    67

    68

void CommandMaster::execute(const StringVector &args)

    69

{

    70

    ec_ioctl_master_t data;

    71

    stringstream err;

    72

    unsigned int i;

    73

    time_t epoch;

    74

    char time_str[MAX_TIME_STR_SIZE + 1];

    75

    size_t time_str_size;

    76

    77

    if (args.size()) {

    78

        err << "'" << getName() << "' takes no arguments!";

    79

        throwInvalidUsageException(err);

    80

    }

    81

    82

    MasterIndexList::const_iterator mi;

    83

    for (mi = getMasterIndices().begin();

    84

            mi != getMasterIndices().end(); mi++) {

    85

        MasterDevice m(*mi);

    86

        m.open(MasterDevice::Read);

    87

        m.getMaster(&data);

    88

    89

        cout

    90

            << "Master" << m.getIndex() << endl

    91

            << "  Phase: ";

    92

    93

        switch (data.phase) {

    94

            case 0:  cout << "Waiting for device..."; break;

    95

            case 1:  cout << "Idle"; break;

    96

            case 2:  cout << "Operation"; break;

    97

            default: cout << "???";

    98

        }

    99

   100

        cout << endl

   101

            << "  Active: " << (data.active ? "yes" : "no") << endl

   102

            << "  Slaves: " << data.slave_count << endl

   103

            << "  Ethernet devices:" << endl;

   104

   105

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

   106

            cout << "    " << (i == 0 ? "Main" : "Backup") << ": ";

   107

            if (data.devices[i].address[0] == 0x00

   108

                    && data.devices[i].address[1] == 0x00

   109

                    && data.devices[i].address[2] == 0x00

   110

                    && data.devices[i].address[3] == 0x00

   111

                    && data.devices[i].address[4] == 0x00

   112

                    && data.devices[i].address[5] == 0x00) {

   113

                cout << "None.";

   114

            } else {

   115

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

   116

                    << setw(2) << (unsigned int) data.devices[i].address[0]

   117

                    << ":"

   118

                    << setw(2) << (unsigned int) data.devices[i].address[1]

   119

                    << ":"

   120

                    << setw(2) << (unsigned int) data.devices[i].address[2]

   121

                    << ":"

   122

                    << setw(2) << (unsigned int) data.devices[i].address[3]

   123

                    << ":"

   124

                    << setw(2) << (unsigned int) data.devices[i].address[4]

   125

                    << ":"

   126

                    << setw(2) << (unsigned int) data.devices[i].address[5]

   127

                    << " ("

   128

                    << (data.devices[i].attached ? "attached" : "waiting...")

   129

                    << ")" << endl << dec

   130

                    << "      Link: "

   131

                    << (data.devices[i].link_state ? "UP" : "DOWN") << endl

   132

                    << "      Tx count: " << data.devices[i].tx_count << endl

   133

                    << "      Rx count: " << data.devices[i].rx_count;

   134

            }

   135

            cout << endl;

   136

        }

   137

   138

        cout << "  Distributed clocks:" << endl

   139

            << "    Reference clock: ";

   140

        if (data.ref_clock != 0xffff) {

   141

            cout << "Slave " << dec << data.ref_clock;

   142

        } else {

   143

            cout << "None";

   144

        }

   145

        cout << endl

   146

            << "    Application time: " << data.app_time << endl

   147

            << "                      ";

   148

   149

        epoch = data.app_time / 1000000000 + 946684800ULL;

   150

        time_str_size = strftime(time_str, MAX_TIME_STR_SIZE,

   151

                "%Y-%m-%d %H:%M:%S", gmtime(&epoch));

   152

        cout << string(time_str, time_str_size) << "."

   153

            << setfill('0') << setw(9) << data.app_time % 1000000000 << endl;

   154

    }

   155

}

   156

   157

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