mirror of
https://github.com/RfidResearchGroup/proxmark3.git
synced 2025-08-21 05:43:48 -07:00
chg: 'lf indala' demod fixes, https://github.com/Proxmark/proxmark3/pull/385 (@marshmellow42)
This commit is contained in:
parent
163510ca55
commit
9e3cfdc4f5
2 changed files with 59 additions and 16 deletions
|
@ -55,20 +55,53 @@ int usage_lf_indala_clone(void) {
|
||||||
}
|
}
|
||||||
|
|
||||||
// redesigned by marshmellow adjusted from existing decode functions
|
// redesigned by marshmellow adjusted from existing decode functions
|
||||||
// indala id decoding - only tested on 26 bit tags, but attempted to make it work for more
|
// indala id decoding
|
||||||
int detectIndala26(uint8_t *dest, size_t *size, uint8_t *invert) {
|
int indala64decode(uint8_t *dest, size_t *size, uint8_t *invert) {
|
||||||
//26 bit 40134 format (don't know other formats)
|
//standard 64 bit indala formats including 26 bit 40134 format
|
||||||
uint8_t preamble[] = {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,1};
|
uint8_t preamble64[] = {1,0,1,0, 0,0,0,0, 0,0,0,0, 0,0,0,0, 0,0,0,0, 0,0,0,0, 0,0,0,0, 0,0,0,0, 1};
|
||||||
uint8_t preamble_i[] = {1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,0};
|
uint8_t preamble64_i[] = {0,1,0,1, 1,1,1,1, 1,1,1,1, 1,1,1,1, 1,1,1,1, 1,1,1,1, 1,1,1,1, 1,1,1,1, 0};
|
||||||
size_t startidx = 0;
|
size_t idx = 0;
|
||||||
if (!preambleSearch(dest, preamble, sizeof(preamble), size, &startidx)){
|
size_t found_size = *size;
|
||||||
|
if (!preambleSearch(dest, preamble64, sizeof(preamble64), &found_size, &idx) ) {
|
||||||
// if didn't find preamble try again inverting
|
// if didn't find preamble try again inverting
|
||||||
if (!preambleSearch(dest, preamble_i, sizeof(preamble_i), size, &startidx)) return -1;
|
if (!preambleSearch(dest, preamble64_i, sizeof(preamble64_i), &found_size, &idx)) return -1;
|
||||||
*invert ^= 1;
|
*invert ^= 1;
|
||||||
}
|
}
|
||||||
if (*size != 64 && *size != 224) return -2;
|
if (found_size != 64) return -2;
|
||||||
|
|
||||||
return (int) startidx;
|
if (*invert==1)
|
||||||
|
for (size_t i = idx; i < found_size + idx; i++)
|
||||||
|
dest[i] ^= 1;
|
||||||
|
|
||||||
|
// note: don't change *size until we are sure we got it...
|
||||||
|
*size = found_size;
|
||||||
|
return (int) idx;
|
||||||
|
}
|
||||||
|
|
||||||
|
int indala224decode(uint8_t *dest, size_t *size, uint8_t *invert) {
|
||||||
|
//large 224 bit indala formats (different preamble too...)
|
||||||
|
uint8_t preamble224[] = {1,0,0,0, 0,0,0,0, 0,0,0,0, 0,0,0,0, 0,0,0,0, 0,0,0,0, 0,0,0,0, 0,0,0,1};
|
||||||
|
uint8_t preamble224_i[] = {0,1,1,1, 1,1,1,1, 1,1,1,1, 1,1,1,1, 1,1,1,1, 1,1,1,1, 1,1,1,1, 1,1,1,0};
|
||||||
|
size_t idx = 0;
|
||||||
|
size_t found_size = *size;
|
||||||
|
if (!preambleSearch(dest, preamble224, sizeof(preamble224), &found_size, &idx) ) {
|
||||||
|
// if didn't find preamble try again inverting
|
||||||
|
if (!preambleSearch(dest, preamble224_i, sizeof(preamble224_i), &found_size, &idx)) return -1;
|
||||||
|
*invert ^= 1;
|
||||||
|
}
|
||||||
|
if (found_size != 224) return -2;
|
||||||
|
if (*invert==1 && idx > 0)
|
||||||
|
for (size_t i = idx-1; i < found_size + idx + 2; i++)
|
||||||
|
dest[i] ^= 1;
|
||||||
|
|
||||||
|
// 224 formats are typically PSK2 (afaik 2017 Marshmellow)
|
||||||
|
// note loses 1 bit at beginning of transformation...
|
||||||
|
// don't need to verify array is big enough as to get here there has to be a full preamble after all of our data
|
||||||
|
psk1TOpsk2(dest + (idx-1), found_size+2);
|
||||||
|
idx++;
|
||||||
|
|
||||||
|
*size = found_size;
|
||||||
|
return (int) idx;
|
||||||
}
|
}
|
||||||
|
|
||||||
// this read is the "normal" read, which download lf signal and tries to demod here.
|
// this read is the "normal" read, which download lf signal and tries to demod here.
|
||||||
|
@ -94,11 +127,19 @@ int CmdIndalaDemod(const char *Cmd) {
|
||||||
|
|
||||||
uint8_t invert = 0;
|
uint8_t invert = 0;
|
||||||
size_t size = DemodBufferLen;
|
size_t size = DemodBufferLen;
|
||||||
int idx = detectIndala26(DemodBuffer, &size, &invert);
|
int idx = indala64decode(DemodBuffer, &size, &invert);
|
||||||
if (idx < 0 || size > 224) {
|
if (idx < 0 || size != 64) {
|
||||||
if (g_debugMode) PrintAndLog("DEBUG: Error - Indala wrong size, expected [64|224] got: %d", size);
|
// try 224 indala
|
||||||
return -1;
|
invert = 0;
|
||||||
|
size = DemodBufferLen;
|
||||||
|
idx = indala224decode(DemodBuffer, &size, &invert);
|
||||||
|
if (idx < 0 || size != 224) {
|
||||||
|
if (g_debugMode)
|
||||||
|
PrintAndLog("DEBUG: Error - Indala wrong size, expected [64|224] got: %d (startindex %i)", size, idx);
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
setDemodBuf(DemodBuffer, size, (size_t)idx);
|
setDemodBuf(DemodBuffer, size, (size_t)idx);
|
||||||
setClockGrid(g_DemodClock, g_DemodStartIdx + (idx * g_DemodClock));
|
setClockGrid(g_DemodClock, g_DemodStartIdx + (idx * g_DemodClock));
|
||||||
if (invert) {
|
if (invert) {
|
||||||
|
|
|
@ -34,6 +34,8 @@ extern int CmdIndalaClone(const char *Cmd);
|
||||||
extern int CmdIndalaSim(const char *Cmd);
|
extern int CmdIndalaSim(const char *Cmd);
|
||||||
|
|
||||||
extern int detectIndala26(uint8_t *bitStream, size_t *size, uint8_t *invert);
|
extern int detectIndala26(uint8_t *bitStream, size_t *size, uint8_t *invert);
|
||||||
|
extern int indala64decode(uint8_t *bitStream, size_t *size, uint8_t *invert);
|
||||||
|
extern int indala224decode(uint8_t *bitStream, size_t *size, uint8_t *invert);
|
||||||
|
|
||||||
extern int usage_lf_indala_demod(void);
|
extern int usage_lf_indala_demod(void);
|
||||||
extern int usage_lf_indala_clone(void);
|
extern int usage_lf_indala_clone(void);
|
||||||
|
|
Loading…
Add table
Add a link
Reference in a new issue