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 <iomanip>

    31

using namespace std;

    32

    33

#include "SoeCommand.h"

    34

    35

extern const ec_code_msg_t soe_error_codes[];

    36

    37

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

    38

    39

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

    40

    Command(name, briefDesc)

    41

{

    42

}

    43

    44

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

    45

    46

uint16_t SoeCommand::parseIdn(const string &str)

    47

{

    48

    uint16_t idn = 0x0000;

    49

    stringstream s, err;

    50

    51

    if (!str.length()) {

    52

        err << "Zero-size string not allowed!";

    53

        throw runtime_error(err.str());

    54

    }

    55

    56

    if (str[0] == 'S' || str[0] == 'P') {

    57

        unsigned int num;

    58

        unsigned char c;

    59

    60

        s << str;

    61

    62

        s >> c;

    63

        if (c == 'P') {

    64

            idn |= 0x8000;

    65

        }

    66

    67

        s >> c;

    68

        if (s.fail() || c != '-') {

    69

             err << "'-' expected!";

    70

             throw runtime_error(err.str());

    71

        }

    72

    73

        s >> num;

    74

        if (s.fail() || num > 7) {

    75

            err << "Invalid parameter set number!";

    76

            throw runtime_error(err.str());

    77

        }

    78

        idn |= num << 12;

    79

    80

        s >> c;

    81

        if (s.fail() || c != '-') {

    82

             err << "'-' expected!";

    83

             throw runtime_error(err.str());

    84

        }

    85

    86

        s >> num;

    87

        if (s.fail() || num > 4095) {

    88

            err << "Invalid data block number!";

    89

            throw runtime_error(err.str());

    90

        }

    91

        idn |= num;

    92

    93

        s.peek();

    94

        if (!s.eof()) {

    95

            err << "Additional input!";

    96

            throw runtime_error(err.str());

    97

        }

    98

    } else {

    99

        s << str;

   100

        s >> resetiosflags(ios::basefield) >> idn;

   101

        if (s.fail()) {

   102

            err << "Invalid number!";

   103

            throw runtime_error(err.str());

   104

        }

   105

    }

   106

   107

    return idn;

   108

}

   109

   110

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

   111

   112

/** Outputs an SoE error code.

   113

*/

   114

std::string SoeCommand::errorMsg(uint16_t code)

   115

{

   116

    const ec_code_msg_t *error_msg;

   117

	stringstream str;

   118

   119

	str << "0x" << hex << setfill('0') << setw(4) << code << ": ";

   120

   121

    for (error_msg = soe_error_codes; error_msg->code; error_msg++) {

   122

        if (error_msg->code == code) {

   123

			str << error_msg->message;

   124

			return str.str();

   125

        }

   126

    }

   127

   128

	str << "(Unknown)";

   129

	return str.str();

   130

}

   131

   132

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