tool/CommandSiiWrite.cpp
author Florian Pose <fp@igh-essen.com>
Mon, 14 Dec 2009 13:25:50 +0100
changeset 1586 eb9185dfa8ac
parent 1363 11c0b2caa253
child 1804 742607c464c4
permissions -rw-r--r--
Merged changes by Martin Troxler.
1142
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     1
/*****************************************************************************
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     2
 *
1363
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
     3
 *  $Id$
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
     4
 *
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
     5
 *  Copyright (C) 2006-2009  Florian Pose, Ingenieurgemeinschaft IgH
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
     6
 *
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
     7
 *  This file is part of the IgH EtherCAT Master.
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
     8
 *
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
     9
 *  The IgH EtherCAT Master is free software; you can redistribute it and/or
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
    10
 *  modify it under the terms of the GNU General Public License version 2, as
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
    11
 *  published by the Free Software Foundation.
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
    12
 *
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
    13
 *  The IgH EtherCAT Master is distributed in the hope that it will be useful,
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
    14
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
    15
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
    16
 *  Public License for more details.
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
    17
 *
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
    18
 *  You should have received a copy of the GNU General Public License along
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
    19
 *  with the IgH EtherCAT Master; if not, write to the Free Software
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
    20
 *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
    21
 *
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
    22
 *  ---
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
    23
 *
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
    24
 *  The license mentioned above concerns the source code only. Using the
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
    25
 *  EtherCAT technology and brand is only permitted in compliance with the
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1254
diff changeset
    26
 *  industrial property and similar rights of Beckhoff Automation GmbH.
1142
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    27
 *
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    28
 ****************************************************************************/
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    29
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    30
#include <iostream>
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    31
#include <iomanip>
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    32
#include <fstream>
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    33
using namespace std;
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    34
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    35
#include "CommandSiiWrite.h"
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    36
#include "sii_crc.h"
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    37
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    38
/*****************************************************************************/
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    39
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    40
CommandSiiWrite::CommandSiiWrite():
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    41
    Command("sii_write", "Write SII contents to a slave.")
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    42
{
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    43
}
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    44
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    45
/*****************************************************************************/
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    46
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    47
string CommandSiiWrite::helpString() const
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    48
{
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    49
    stringstream str;
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    50
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    51
    str << getName() << " [OPTIONS] <FILENAME>" << endl
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    52
        << endl 
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    53
        << getBriefDescription() << endl
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    54
        << endl
1157
04d1c950cf9d Added --help for alias and position parameters.
Florian Pose <fp@igh-essen.com>
parents: 1155
diff changeset
    55
        << "This command requires a single slave to be selected." << endl
04d1c950cf9d Added --help for alias and position parameters.
Florian Pose <fp@igh-essen.com>
parents: 1155
diff changeset
    56
    	<< endl
1142
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    57
        << "The file contents are checked for validity and integrity." << endl
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    58
        << "These checks can be overridden with the --force option." << endl
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    59
        << endl
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    60
        << "Arguments:" << endl
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    61
        << "  FILENAME must be a path to a file that contains a" << endl
1161
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
    62
        << "           positive number of words. If it is '-'," << endl
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
    63
        << "           data are read from stdin." << endl
1142
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    64
        << endl
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    65
        << "Command-specific options:" << endl
1157
04d1c950cf9d Added --help for alias and position parameters.
Florian Pose <fp@igh-essen.com>
parents: 1155
diff changeset
    66
        << "  --alias    -a <alias>" << endl
04d1c950cf9d Added --help for alias and position parameters.
Florian Pose <fp@igh-essen.com>
parents: 1155
diff changeset
    67
        << "  --position -p <pos>    Slave selection. See the help of" << endl
04d1c950cf9d Added --help for alias and position parameters.
Florian Pose <fp@igh-essen.com>
parents: 1155
diff changeset
    68
        << "                         the 'slaves' command." << endl
04d1c950cf9d Added --help for alias and position parameters.
Florian Pose <fp@igh-essen.com>
parents: 1155
diff changeset
    69
        << "  --force    -f          Override validity checks." << endl
1142
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    70
        << endl
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    71
        << numericInfo();
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    72
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    73
    return str.str();
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    74
}
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    75
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    76
/****************************************************************************/
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    77
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    78
void CommandSiiWrite::execute(MasterDevice &m, const StringVector &args)
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    79
{
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    80
    stringstream err;
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    81
    ec_ioctl_slave_sii_t data;
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    82
    ifstream file;
1161
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
    83
    SlaveList slaves;
1142
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    84
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    85
    if (args.size() != 1) {
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    86
        err << "'" << getName() << "' takes exactly one argument!";
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    87
        throwInvalidUsageException(err);
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    88
    }
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    89
1161
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
    90
    if (args[0] == "-") {
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
    91
        loadSiiData(&data, cin);
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
    92
    } else {
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
    93
        file.open(args[0].c_str(), ifstream::in | ifstream::binary);
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
    94
        if (file.fail()) {
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
    95
            err << "Failed to open '" << args[0] << "'!";
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
    96
            throwCommandException(err);
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
    97
        }
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
    98
        loadSiiData(&data, file);
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
    99
        file.close();
1142
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   100
    }
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   101
1166
006244d53f68 Removed global variables.
Florian Pose <fp@igh-essen.com>
parents: 1161
diff changeset
   102
    if (!getForce()) {
1161
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   103
        try {
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   104
            checkSiiData(&data);
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   105
        } catch (CommandException &e) {
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   106
            delete [] data.words;
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   107
            throw e;
1142
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   108
        }
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   109
    }
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   110
1161
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   111
    try {
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   112
        m.open(MasterDevice::ReadWrite);
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   113
    } catch (MasterDeviceException &e) {
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   114
        delete [] data.words;
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   115
        throw e;
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   116
    }
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   117
1157
04d1c950cf9d Added --help for alias and position parameters.
Florian Pose <fp@igh-essen.com>
parents: 1155
diff changeset
   118
    slaves = selectedSlaves(m);
04d1c950cf9d Added --help for alias and position parameters.
Florian Pose <fp@igh-essen.com>
parents: 1155
diff changeset
   119
    if (slaves.size() != 1) {
1161
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   120
        delete [] data.words;
1157
04d1c950cf9d Added --help for alias and position parameters.
Florian Pose <fp@igh-essen.com>
parents: 1155
diff changeset
   121
        throwSingleSlaveRequired(slaves.size());
04d1c950cf9d Added --help for alias and position parameters.
Florian Pose <fp@igh-essen.com>
parents: 1155
diff changeset
   122
    }
04d1c950cf9d Added --help for alias and position parameters.
Florian Pose <fp@igh-essen.com>
parents: 1155
diff changeset
   123
    data.slave_position = slaves.front().position;
04d1c950cf9d Added --help for alias and position parameters.
Florian Pose <fp@igh-essen.com>
parents: 1155
diff changeset
   124
1142
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   125
    // send data to master
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   126
    data.offset = 0;
1161
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   127
    try {
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   128
        m.writeSii(&data);
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   129
    } catch (MasterDeviceException &e) {
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   130
        delete [] data.words;
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   131
        throw e;
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   132
    }
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   133
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   134
    if (getVerbosity() == Verbose) {
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   135
        cerr << "SII writing finished." << endl;
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   136
    }
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   137
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   138
    delete [] data.words;
1142
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   139
}
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   140
59be91dfcbe1 Redesigned command interface.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   141
/*****************************************************************************/
1161
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   142
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   143
void CommandSiiWrite::loadSiiData(
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   144
        ec_ioctl_slave_sii_t *data,
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   145
        const istream &in
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   146
        )
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   147
{
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   148
    stringstream err;
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   149
    ostringstream tmp;
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   150
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   151
    tmp << in.rdbuf();
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   152
    string const &contents = tmp.str();
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   153
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   154
    if (getVerbosity() == Verbose) {
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   155
        cerr << "Read " << contents.size() << " bytes of SII data." << endl;
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   156
    }
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   157
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   158
    if (!contents.size() || contents.size() % 2) {
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   159
        err << "Invalid data size " << contents.size() << "! "
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   160
            << "Must be non-zero and even.";
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   161
        throwCommandException(err);
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   162
    }
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   163
    data->nwords = contents.size() / 2;
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   164
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   165
    // allocate buffer and read file into buffer
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   166
    data->words = new uint16_t[data->nwords];
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   167
    contents.copy((char *) data->words, contents.size());
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   168
}
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   169
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   170
/*****************************************************************************/
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   171
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   172
void CommandSiiWrite::checkSiiData(
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   173
        const ec_ioctl_slave_sii_t *data
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   174
        )
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   175
{
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   176
    stringstream err;
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   177
    const uint16_t *categoryHeader;
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   178
    uint16_t categoryType, categorySize;
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   179
    uint8_t crc;
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   180
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   181
    if (data->nwords < 0x0041) {
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   182
        err << "SII data too short (" << data->nwords << " words)! Mimimum is"
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   183
            " 40 fixed words + 1 delimiter. Use --force to write anyway.";
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   184
        throwCommandException(err);
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   185
    }
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   186
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   187
    // calculate checksum over words 0 to 6
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   188
    crc = calcSiiCrc((const uint8_t *) data->words, 14);
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   189
    if (crc != ((const uint8_t *) data->words)[14]) {
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   190
        err << "CRC incorrect. Must be 0x"
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   191
            << hex << setfill('0') << setw(2) << (unsigned int) crc
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   192
            << ". Use --force to write anyway.";
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   193
        throwCommandException(err);
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   194
    }
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   195
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   196
    // cycle through categories to detect corruption
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   197
    categoryHeader = data->words + 0x0040U;
1254
c19d273a9e76 Moved byteorder macros to ecrt.h.
Florian Pose <fp@igh-essen.com>
parents: 1166
diff changeset
   198
    categoryType = le16_to_cpup(categoryHeader);
1161
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   199
    while (categoryType != 0xffff) {
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   200
        if (categoryHeader + 1 > data->words + data->nwords) {
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   201
            err << "SII data seem to be corrupted! "
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   202
                << "Use --force to write anyway.";
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   203
            throwCommandException(err);
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   204
        }
1254
c19d273a9e76 Moved byteorder macros to ecrt.h.
Florian Pose <fp@igh-essen.com>
parents: 1166
diff changeset
   205
        categorySize = le16_to_cpup(categoryHeader + 1);
1161
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   206
        if (categoryHeader + 2 + categorySize + 1
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   207
                > data->words + data->nwords) {
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   208
            err << "SII data seem to be corrupted! "
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   209
                "Use --force to write anyway.";
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   210
            throwCommandException(err);
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   211
        }
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   212
        categoryHeader += 2 + categorySize;
1254
c19d273a9e76 Moved byteorder macros to ecrt.h.
Florian Pose <fp@igh-essen.com>
parents: 1166
diff changeset
   213
        categoryType = le16_to_cpup(categoryHeader);
1161
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   214
    }
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   215
}
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   216
d1324ac71232 Accept '-' as filename to read from stdin.
Florian Pose <fp@igh-essen.com>
parents: 1157
diff changeset
   217
/*****************************************************************************/