1

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

     2

 *

     3

 * $Id$

     4

 *

     5

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

     6

     7

#include <iostream>

     8

#include <iomanip>

     9

#include <fstream>

    10

using namespace std;

    11

    12

#include "globals.h"

    13

#include "sii_crc.h"

    14

    15

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

    16

    17

// FIXME

    18

const char *help_sii_write =

    19

    "[OPTIONS]\n"

    20

    "\n"

    21

    "\n"

    22

    "Command-specific options:\n";

    23

    24

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

    25

    26

void command_sii_write(void)

    27

{

    28

    stringstream err;

    29

    ec_ioctl_slave_sii_t data;

    30

    ifstream file;

    31

    unsigned int byte_size;

    32

    const uint16_t *categoryHeader;

    33

    uint16_t categoryType, categorySize;

    34

    uint8_t crc;

    35

    36

    if (slavePosition < 0) {

    37

        err << "'sii_write' requires a slave! Please specify --slave.";

    38

        throw MasterDeviceException(err.str());

    39

    }

    40

    data.slave_position = slavePosition;

    41

    42

    if (commandArgs.size() != 1) {

    43

        err << "'ssi_write' takes exactly one argument!";

    44

        throw MasterDeviceException(err.str());

    45

    }

    46

    47

    file.open(commandArgs[0].c_str(), ifstream::in | ifstream::binary);

    48

    if (file.fail()) {

    49

        err << "Failed to open '" << commandArgs[0] << "'!";

    50

        throw MasterDeviceException(err.str());

    51

    }

    52

    53

    // get length of file

    54

    file.seekg(0, ios::end);

    55

    byte_size = file.tellg();

    56

    file.seekg(0, ios::beg);

    57

    58

    if (!byte_size || byte_size % 2) {

    59

        stringstream err;

    60

        err << "Invalid file size! Must be non-zero and even.";

    61

        throw MasterDeviceException(err.str());

    62

    }

    63

    64

    data.nwords = byte_size / 2;

    65

    if (data.nwords < 0x0041 && !force) {

    66

        err << "SII data too short (" << data.nwords << " words)! Mimimum is"

    67

                " 40 fixed words + 1 delimiter. Use --force to write anyway.";

    68

        throw MasterDeviceException(err.str());

    69

    }

    70

    71

    // allocate buffer and read file into buffer

    72

    data.words = new uint16_t[data.nwords];

    73

    file.read((char *) data.words, byte_size);

    74

    file.close();

    75

    76

    if (!force) {

    77

        // calculate checksum over words 0 to 6

    78

        crc = calcSiiCrc((const uint8_t *) data.words, 14);

    79

        if (crc != ((const uint8_t *) data.words)[14]) {

    80

            err << "CRC incorrect. Must be 0x"

    81

                << hex << setfill('0') << setw(2) << (unsigned int) crc

    82

                << ". Use --force to write anyway.";

    83

            throw MasterDeviceException(err.str());

    84

        }

    85

    86

        // cycle through categories to detect corruption

    87

        categoryHeader = data.words + 0x0040U;

    88

        categoryType = le16tocpu(*categoryHeader);

    89

        while (categoryType != 0xffff) {

    90

            if (categoryHeader + 1 > data.words + data.nwords) {

    91

                err << "SII data seem to be corrupted! "

    92

                    << "Use --force to write anyway.";

    93

                throw MasterDeviceException(err.str());

    94

            }

    95

            categorySize = le16tocpu(*(categoryHeader + 1));

    96

            if (categoryHeader + 2 + categorySize + 1

    97

                    > data.words + data.nwords) {

    98

                err << "SII data seem to be corrupted! "

    99

                    "Use --force to write anyway.";

   100

                throw MasterDeviceException(err.str());

   101

            }

   102

            categoryHeader += 2 + categorySize;

   103

            categoryType = le16tocpu(*categoryHeader);

   104

        }

   105

    }

   106

   107

    // send data to master

   108

    masterDev.open(MasterDevice::ReadWrite);

   109

    data.offset = 0;

   110

	masterDev.writeSii(&data);

   111

}

   112

   113

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