85 lines
2.4 KiB
C++
85 lines
2.4 KiB
C++
// attempt to get version info from .hex file
|
|
// modified hex file parser from OTGWSerial.cpp
|
|
//
|
|
// -tjfs
|
|
|
|
#define byteswap(val) ((val << 8) | (val >> 8))
|
|
|
|
static const char banner[] = "OpenTherm Gateway ";
|
|
|
|
char *GetVersion(String hexfile){
|
|
char hexbuf[48];
|
|
int len, addr, tag, data, offs, linecnt = 0, weight;
|
|
uint32_t codemap[4] = {};
|
|
byte datamap = 0;
|
|
char datamem[256], version[8] = "";
|
|
unsigned short ptr;
|
|
char *s="";
|
|
File f;
|
|
//DebugTf("GetVersion opening %s\n",hexfile.c_str());
|
|
f = LittleFS.open(hexfile, "r");
|
|
if (f) // only proceed if file exists
|
|
{
|
|
while (f.readBytesUntil('\n', hexbuf, sizeof(hexbuf)) != 0) {
|
|
linecnt++;
|
|
//DebugTf("reading line %d %s\n",linecnt,hexbuf);
|
|
if (sscanf(hexbuf, ":%2x%4x%2x", &len, &addr, &tag) != 3)
|
|
{
|
|
DebugTf("Parse error on line %d\n",linecnt);// Parse error
|
|
break;
|
|
}
|
|
//DebugTf("Read in %2x %4x %2x\n",len,addr,tag);
|
|
if (len & 1)
|
|
{
|
|
DebugTf("Invalid data size on line %d\n",linecnt);// Invalid data size
|
|
break;
|
|
}
|
|
offs = 9;
|
|
len >>= 1;
|
|
if (tag == 0)
|
|
{
|
|
//DebugTf("Checking address %4x on line %d\n",addr,linecnt);// Invalid data size
|
|
if (addr >= 0x4200 && addr <= 0x4400)
|
|
{
|
|
// Data memory
|
|
addr = (addr - 0x4200) >> 1;
|
|
while (len > 0)
|
|
{
|
|
if (sscanf(hexbuf + offs, "%04x", &data) != 1)
|
|
break;
|
|
// if (!bitRead(datamap, addr / 64)) weight += WEIGHT_DATAPROG;
|
|
// bitSet(datamap, addr / 64);
|
|
//DebugTf("storing %x in %x\n",data,addr);
|
|
datamem[addr++] = byteswap(data);
|
|
offs += 4;
|
|
len--;
|
|
}
|
|
}
|
|
//if (len) {
|
|
//DebugTf("len>0\n");
|
|
//break;
|
|
//}
|
|
} else if (tag == 1) {
|
|
//DebugTf("tag==1\n");
|
|
break;
|
|
}
|
|
}
|
|
f.close();
|
|
//DebugTf("closing file and hunting for banner\n");
|
|
ptr = 0;
|
|
while (ptr < 256)
|
|
{
|
|
//DebugTf("checking for %s at char pos %d\n",banner,ptr);
|
|
s = strstr((char *)datamem + ptr, banner);
|
|
if (!s)
|
|
{
|
|
//DebugTf("did not find the banner\n");
|
|
ptr += strnlen((char *)datamem + ptr, 256 - ptr) + 1;
|
|
} else {
|
|
//DebugTf("hit the banner! returning version string %s\n",s);
|
|
s += sizeof(banner) - 1; return (s);
|
|
}
|
|
}
|
|
}
|
|
}
|