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 /*****************************************************************************/

    36 

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

    38     Command(name, briefDesc)

    39 {

    40 }

    41 

    42 /*****************************************************************************/

    43 

    44 uint16_t SoeCommand::parseIdn(const string &str)

    45 {

    46     uint16_t idn = 0x0000;

    47     stringstream s, err;

    48 

    49     if (!str.length()) {

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

    51         throw runtime_error(err.str());

    52     }

    53 

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

    55         unsigned int num;

    56         unsigned char c;

    57 

    58         s << str;

    59 

    60         s >> c;

    61         if (c == 'P') {

    62             idn |= 0x8000;

    63         }

    64 

    65         s >> c;

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

    67              err << "'-' expected!";

    68              throw runtime_error(err.str());

    69         }

    70 

    71         s >> num;

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

    73             err << "Invalid parameter set number!";

    74             throw runtime_error(err.str());

    75         }

    76         idn |= num << 12;

    77 

    78         s >> c;

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

    80              err << "'-' expected!";

    81              throw runtime_error(err.str());

    82         }

    83 

    84         s >> num;

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

    86             err << "Invalid data block number!";

    87             throw runtime_error(err.str());

    88         }

    89         idn |= num;

    90 

    91         s.peek();

    92         if (!s.eof()) {

    93             err << "Additional input!";

    94             throw runtime_error(err.str());

    95         }

    96     } else {

    97         s << str;

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

    99         if (s.fail()) {

   100             err << "Invalid number!";

   101             throw runtime_error(err.str());

   102         }

   103     }

   104 

   105     return idn;

   106 }

   107 

   108 /****************************************************************************/