FIX: 'lf presco' demod fixes.

ADD: 'lf search' now also looks for Presco.

I know that the helptext is wrong (d should be p)
This commit is contained in:
iceman1001 2016-12-15 00:01:31 +01:00
commit d48175d4f4
4 changed files with 38 additions and 22 deletions

View file

@ -1104,6 +1104,11 @@ int CmdLFfind(const char *Cmd) {
PrintAndLog("\nValid Visa2000 ID Found!"); PrintAndLog("\nValid Visa2000 ID Found!");
return 1; return 1;
} }
ans=CmdPrescoDemod("");
if (ans>0) {
PrintAndLog("\nValid Presco ID Found!");
return 1;
}
// TIdemod? // TIdemod?

View file

@ -54,7 +54,7 @@ int GetWiegandFromPresco(const char *Cmd, uint32_t *sitecode, uint32_t *usercode
case 'H': case 'H':
hex = true; hex = true;
//get hex //get hex
*fullcode = param_get32ex(Cmd, cmdp+1, 0, 10); *fullcode = param_get32ex(Cmd, cmdp+1, 0, 16);
cmdp+=2; cmdp+=2;
break; break;
case 'P': case 'P':
@ -115,34 +115,44 @@ int GetPrescoBits(uint32_t fullcode, uint8_t *prescoBits) {
//see ASKDemod for what args are accepted //see ASKDemod for what args are accepted
int CmdPrescoDemod(const char *Cmd) { int CmdPrescoDemod(const char *Cmd) {
if (!ASKDemod(Cmd, false, false, 1)) { bool st = true;
if (g_debugMode) PrintAndLog("ASKDemod failed"); //if (!ASKDemod(Cmd, false, false, 1)) {
if (!ASKDemod_ext("32 0 0", FALSE, FALSE, 1, &st)) {
if (g_debugMode) PrintAndLog("DEBUG: Error Presco ASKDemod failed");
return 0; return 0;
} }
size_t size = DemodBufferLen; size_t size = DemodBufferLen;
//call lfdemod.c demod for Viking //call lfdemod.c demod for Viking
int ans = PrescoDemod(DemodBuffer, &size); int ans = PrescoDemod(DemodBuffer, &size);
if (ans < 0) { if (ans < 0) {
if (g_debugMode) PrintAndLog("Error Presco_Demod %d", ans); if (g_debugMode){
if (ans == -1)
PrintAndLog("DEBUG: Error - Presco: too few bits found");
else if (ans == -2)
PrintAndLog("DEBUG: Error - Presco: preamble not found");
else if (ans == -3)
PrintAndLog("DEBUG: Error - Presco: Size not correct: %d", size);
else
PrintAndLog("DEBUG: Error - Presco: ans: %d", ans);
}
return 0; return 0;
} }
setDemodBuf(DemodBuffer, 128, ans);
//got a good demod //got a good demod
uint32_t raw1 = bytebits_to_byte(DemodBuffer+ans, 32); uint32_t raw1 = bytebits_to_byte(DemodBuffer, 32);
uint32_t raw2 = bytebits_to_byte(DemodBuffer+ans+32, 32); uint32_t raw2 = bytebits_to_byte(DemodBuffer+32, 32);
uint32_t raw3 = bytebits_to_byte(DemodBuffer+ans+64, 32); uint32_t raw3 = bytebits_to_byte(DemodBuffer+64, 32);
uint32_t raw4 = bytebits_to_byte(DemodBuffer+ans+96, 32); uint32_t raw4 = bytebits_to_byte(DemodBuffer+96, 32);
uint32_t cardid = raw4; uint32_t cardid = raw4;
PrintAndLog("Presco Tag Found: Card ID %08X", cardid); PrintAndLog("Presco Tag Found: Card ID %08X, Raw: %08X%08X%08X%08X", cardid, raw1, raw2, raw3, raw4);
PrintAndLog("Raw: %08X%08X%08X%08X", raw1,raw2,raw3,raw4);
setDemodBuf(DemodBuffer+ans, 128, 0);
uint32_t sitecode = 0, usercode = 0, fullcode = 0; uint32_t sitecode = 0, usercode = 0, fullcode = 0;
bool Q5=false; bool Q5 = false;
char cmd[12] = {0}; char cmd[12] = {0};
sprintf(cmd, "H %08X", cardid); sprintf(cmd, "H %08X", cardid);
GetWiegandFromPresco(cmd, &sitecode, &usercode, &fullcode, &Q5); GetWiegandFromPresco(cmd, &sitecode, &usercode, &fullcode, &Q5);
PrintAndLog("SiteCode %u, UserCode %u, FullCode, %08X", sitecode, usercode, fullcode); PrintAndLog("SiteCode %u, UserCode %u, FullCode, %08X", sitecode, usercode, fullcode);
return 1; return 1;
} }
@ -239,8 +249,8 @@ int CmdPrescoSim(const char *Cmd) {
static command_t CommandTable[] = { static command_t CommandTable[] = {
{"help", CmdHelp, 1, "This help"}, {"help", CmdHelp, 1, "This help"},
{"read", CmdPrescoRead, 0, "Attempt to read and Extract tag data"}, {"read", CmdPrescoRead, 0, "Attempt to read and Extract tag data"},
{"clone", CmdPrescoClone, 0, "d <9 digit ID> or h <hex> [Q5] clone presco tag"}, {"clone", CmdPrescoClone, 0, "d <9 digit ID> or h <hex> [Q5] clone presco tag"},
{"sim", CmdPrescoSim, 0, "d <9 digit ID> or h <hex> simulate presco tag"}, {"sim", CmdPrescoSim, 0, "d <9 digit ID> or h <hex> simulate presco tag"},
{NULL, NULL, 0, NULL} {NULL, NULL, 0, NULL}
}; };

View file

@ -21,6 +21,8 @@
int CmdLFPresco(const char *Cmd); int CmdLFPresco(const char *Cmd);
int CmdPrescoClone(const char *Cmd); int CmdPrescoClone(const char *Cmd);
int CmdPrescoSim(const char *Cmd); int CmdPrescoSim(const char *Cmd);
int CmdPrescoRead(const char *Cmd);
int CmdPrescoDemod(const char *Cmd);
int GetWiegandFromPresco(const char *id, uint32_t *sitecode, uint32_t *usercode, uint32_t *fullcode, bool *Q5); int GetWiegandFromPresco(const char *id, uint32_t *sitecode, uint32_t *usercode, uint32_t *fullcode, bool *Q5);

View file

@ -711,13 +711,12 @@ int Visa2kDemod_AM(uint8_t *dest, size_t *size) {
// find presco preamble 0x10D in already demoded data // find presco preamble 0x10D in already demoded data
int PrescoDemod(uint8_t *dest, size_t *size) { int PrescoDemod(uint8_t *dest, size_t *size) {
//make sure buffer has data if (*size < 128*2) return -1; //make sure buffer has data
if (*size < 64*2) return -2;
size_t startIdx = 0; size_t startIdx = 0;
uint8_t preamble[] = {1,0,0,0,0,1,1,0,1,0,0,0,0,0,0,0,0,0,0,0}; uint8_t preamble[] = {0,0,0,1,0,0,0,0,1,1,0,1,0,0,0,0,0,0,0,0,0,0,0};
uint8_t errChk = preambleSearch(dest, preamble, sizeof(preamble), size, &startIdx); uint8_t errChk = preambleSearch(dest, preamble, sizeof(preamble), size, &startIdx);
if (errChk == 0) return -4; //preamble not found if (errChk == 0) return -2; //preamble not found
if (*size != 128) return -3; //wrong demoded size
//return start position //return start position
return (int) startIdx; return (int) startIdx;
} }