src/hexfile.cpp

   1 // Copyright (c) 2016, Tobias Mueller tm(at)tm3d.de
   2 // All rights reserved.
   3 //
   4 // Redistribution and use in source and binary forms, with or without
   5 // modification, are permitted provided that the following conditions are
   6 // met:
   7 //
   8 //  * Redistributions of source code must retain the above copyright
   9 //    notice, this list of conditions and the following disclaimer.
  10 //  * Redistributions in binary form must reproduce the above copyright
  11 //    notice, this list of conditions and the following disclaimer in the
  12 //    documentation and/or other materials provided with the
  13 //    distribution.
  14 //  * All advertising materials mentioning features or use of this
  15 //    software must display the following acknowledgement: This product
  16 //    includes software developed by tm3d.de and its contributors.
  17 //  * Neither the name of tm3d.de nor the names of its contributors may
  18 //    be used to endorse or promote products derived from this software
  19 //    without specific prior written permission.
  20 //
  21 // THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  22 // "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  23 // LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  24 // A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  25 // OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  26 // SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  27 // LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  28 // DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  29 // THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  30 // (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  31 // OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  32
  33
  34 #include "hexfile.h"
  35
  36 #include <iostream>
  37 #include <fstream>
  38 #include <string>
  39 #include <vector>
  40 #include <sstream>
  41
  42 hexFile::hexFile(std::string fname) {
  43         std::ifstream hf(fname);
  44         if (!hf) {
  45                 lastError=3;
  46                 return;
  47         }
  48         std::string line;
  49         std::stringstream ss;
  50         lastError=0;
  51         while (std::getline(hf, line))    {
  52         //QueryArray.push_back(line);
  53         if (line[0]==':') {
  54                         //ss << std::hex << line.substr(1,2);
  55                         //ss >> bc;
  56                         uint8_t bc=std::stoul( line.substr(1,2), nullptr, 16);
  57                         uint32_t fw=std::stoul(line.substr(3,4),nullptr, 16);
  58                         uint8_t ty=std::stoul(line.substr(7,2),nullptr,16);
  59                         uint32_t chsm = bc + (fw >> 8) + (fw & 0xFF) + ty;
  60                         for (int i = 0; i < bc; i++) {
  61                                 int p = 9 + i * 2;
  62                                 uint8_t b = std::stoul(line.substr(p, 2),nullptr, 16);
  63                                 chsm = chsm + b;
  64                                 prog.push_back(b);
  65                         }
  66                         chsm=(chsm+std::stoul(line.substr(9+bc*2,2),nullptr,16))&0xFF;
  67                         if (chsm!=0) {
  68                                 lastError=1;
  69                                 return;
  70                                 //std::cout <<"ERROR"<<std::endl;
  71                         }
  72
  73                         //std::cout<<static_cast<int>(bc)<<" "<< line<<std::endl;
  74                 }
  75     }
  76     if (prog.size() < 1){
  77                 lastError = 2;
  78         }
  79
  80 }
  81
  82 std::vector<uint8_t> hexFile::getBlock(unsigned int pos,unsigned int length){
  83         std::vector<uint8_t> rvec1;
  84         if (pos>prog.size()) return rvec1;
  85         if ((pos+length) > prog.size()) {
  86                 std::vector<uint8_t> rvec(prog.begin()+pos,prog.end());
  87                 return rvec;
  88         }else {
  89                 std::vector<uint8_t> rvec(prog.begin()+pos,prog.begin()+pos+length);
  90                 return rvec;
  91         }
  92 }
  93
  94 unsigned int hexFile::getBlockCount(unsigned int length){
  95         unsigned int count=prog.size()/length;
  96         if ((prog.size()%length)!=0) count++;
  97         return count;
  98 }
  99