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

uint16_t SoeCommand::parseIdn(const string &str)

    40

{

    41

    uint16_t idn = 0x0000;

    42

    stringstream s, err;

    43

    44

    if (!str.length()) {

    45

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

    46

        throw runtime_error(err.str());

    47

    }

    48

    49

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

    50

        unsigned int num;

    51

        unsigned char c;

    52

    53

        s << str;

    54

    55

        s >> c;

    56

        if (c == 'P') {

    57

            idn |= 0x8000;

    58

        }

    59

    60

        s >> c;

    61

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

    62

             err << "'-' expected!";

    63

             throw runtime_error(err.str());

    64

        }

    65

    66

        s >> num;

    67

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

    68

            err << "Invalid parameter set number!";

    69

            throw runtime_error(err.str());

    70

        }

    71

        idn |= num << 12;

    72

    73

        s >> c;

    74

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

    75

             err << "'-' expected!";

    76

             throw runtime_error(err.str());

    77

        }

    78

    79

        s >> num;

    80

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

    81

            err << "Invalid data block number!";

    82

            throw runtime_error(err.str());

    83

        }

    84

        idn |= num;

    85

    86

        s.peek();

    87

        if (!s.eof()) {

    88

            err << "Additional input!";

    89

            throw runtime_error(err.str());

    90

        }

    91

    } else {

    92

        s << str;

    93

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

    94

        if (s.fail()) {

    95

            err << "Invalid number!";

    96

            throw runtime_error(err.str());

    97

        }

    98

    }

    99

   100

    return idn;

   101

}

   102

   103

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

   104

   105

string SoeCommand::outputIdn(uint16_t idn)

   106

{

   107

    stringstream str;

   108

   109

    str << ((idn & 0x8000) ? 'P' : 'S')

   110

        << "-" << ((idn >> 12) & 0x07)

   111

        << "-" << setfill('0') << setw(4) << (idn & 0x0fff);

   112

   113

    return str.str();

   114

}

   115

   116

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

   117

   118

/** Outputs an SoE error code.

   119

*/

   120

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

   121

{

   122

    const ec_code_msg_t *error_msg;

   123

	stringstream str;

   124

   125

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

   126

   127

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

   128

        if (error_msg->code == code) {

   129

			str << error_msg->message;

   130

			return str.str();

   131

        }

   132

    }

   133

   134

	str << "(Unknown)";

   135

	return str.str();

   136

}

   137

   138

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