mirror of
https://github.com/RfidResearchGroup/proxmark3.git
synced 2025-08-19 21:03:48 -07:00
FIX: "hf list 7816", the s-blocks is now also printed.
FIX: iso14443b.c got some minor adjustments in the demod and codeas14443btag. Seems it works better for me. I still have the problem with powerup of a 14b tag. I need to run the "14b raw -c -p 05 00 08" a couple of times before I get an answer.
This commit is contained in:
parent
db25599d7f
commit
5b59bf20c7
3 changed files with 62 additions and 47 deletions
|
@ -15,7 +15,7 @@
|
||||||
#include "string.h"
|
#include "string.h"
|
||||||
#include "iso14443crc.h"
|
#include "iso14443crc.h"
|
||||||
#include "common.h"
|
#include "common.h"
|
||||||
#define RECEIVE_SAMPLES_TIMEOUT 800000
|
#define RECEIVE_SAMPLES_TIMEOUT 600000
|
||||||
#define ISO14443B_DMA_BUFFER_SIZE 256
|
#define ISO14443B_DMA_BUFFER_SIZE 256
|
||||||
|
|
||||||
|
|
||||||
|
@ -106,7 +106,7 @@ static void CodeIso14443bAsTag(const uint8_t *cmd, int len)
|
||||||
ToSendStuffBit(0);
|
ToSendStuffBit(0);
|
||||||
ToSendStuffBit(0);
|
ToSendStuffBit(0);
|
||||||
}
|
}
|
||||||
for(i = 0; i < 10; i++) {
|
for(i = 0; i < 2; i++) {
|
||||||
ToSendStuffBit(1);
|
ToSendStuffBit(1);
|
||||||
ToSendStuffBit(1);
|
ToSendStuffBit(1);
|
||||||
ToSendStuffBit(1);
|
ToSendStuffBit(1);
|
||||||
|
@ -527,13 +527,20 @@ static struct {
|
||||||
*/
|
*/
|
||||||
static RAMFUNC int Handle14443bSamplesDemod(int ci, int cq)
|
static RAMFUNC int Handle14443bSamplesDemod(int ci, int cq)
|
||||||
{
|
{
|
||||||
int v;
|
int v = 0;
|
||||||
int ai, aq;
|
int ai = abs(ci);
|
||||||
|
int aq = abs(cq);
|
||||||
|
int halfci = (ai >> 1);
|
||||||
|
int halfcq = (aq >> 1);
|
||||||
|
|
||||||
// The soft decision on the bit uses an estimate of just the
|
// The soft decision on the bit uses an estimate of just the
|
||||||
// quadrant of the reference angle, not the exact angle.
|
// quadrant of the reference angle, not the exact angle.
|
||||||
#define MAKE_SOFT_DECISION() { \
|
#define MAKE_SOFT_DECISION() { \
|
||||||
v = (Demod.sumI > 0) ? ci : -ci;\
|
if(Demod.sumI > 0) { \
|
||||||
|
v = ci; \
|
||||||
|
} else { \
|
||||||
|
v = -ci; \
|
||||||
|
} \
|
||||||
if(Demod.sumQ > 0) { \
|
if(Demod.sumQ > 0) { \
|
||||||
v += cq; \
|
v += cq; \
|
||||||
} else { \
|
} else { \
|
||||||
|
@ -543,23 +550,9 @@ static RAMFUNC int Handle14443bSamplesDemod(int ci, int cq)
|
||||||
|
|
||||||
#define SUBCARRIER_DETECT_THRESHOLD 8
|
#define SUBCARRIER_DETECT_THRESHOLD 8
|
||||||
|
|
||||||
// Subcarrier amplitude v = sqrt(ci^2 + cq^2), approximated here by abs(ci) + abs(cq)
|
|
||||||
/* #define CHECK_FOR_SUBCARRIER() { \
|
|
||||||
v = ci; \
|
|
||||||
if(v < 0) v = -v; \
|
|
||||||
if(cq > 0) { \
|
|
||||||
v += cq; \
|
|
||||||
} else { \
|
|
||||||
v -= cq; \
|
|
||||||
} \
|
|
||||||
}
|
|
||||||
*/
|
|
||||||
|
|
||||||
// Subcarrier amplitude v = sqrt(ci^2 + cq^2), approximated here by max(abs(ci),abs(cq)) + 1/2*min(abs(ci),abs(cq)))
|
// Subcarrier amplitude v = sqrt(ci^2 + cq^2), approximated here by max(abs(ci),abs(cq)) + 1/2*min(abs(ci),abs(cq)))
|
||||||
#define CHECK_FOR_SUBCARRIER() { \
|
#define CHECK_FOR_SUBCARRIER() { \
|
||||||
ai = (abs(ci) >> 1); \
|
v = MAX(ai, aq) + MIN(halfci, halfcq); \
|
||||||
aq = (abs(cq) >> 1); \
|
|
||||||
v = MAX(abs(ci), abs(cq)) + MIN(ai, aq); \
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
@ -575,7 +568,8 @@ static RAMFUNC int Handle14443bSamplesDemod(int ci, int cq)
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case DEMOD_PHASE_REF_TRAINING:
|
case DEMOD_PHASE_REF_TRAINING:
|
||||||
if(Demod.posCount < 10*2) {
|
if(Demod.posCount < 8) {
|
||||||
|
//if(Demod.posCount < 10*2) {
|
||||||
CHECK_FOR_SUBCARRIER();
|
CHECK_FOR_SUBCARRIER();
|
||||||
if (v > SUBCARRIER_DETECT_THRESHOLD) {
|
if (v > SUBCARRIER_DETECT_THRESHOLD) {
|
||||||
// set the reference phase (will code a logic '1') by averaging over 32 1/fs.
|
// set the reference phase (will code a logic '1') by averaging over 32 1/fs.
|
||||||
|
@ -594,7 +588,7 @@ static RAMFUNC int Handle14443bSamplesDemod(int ci, int cq)
|
||||||
case DEMOD_AWAITING_FALLING_EDGE_OF_SOF:
|
case DEMOD_AWAITING_FALLING_EDGE_OF_SOF:
|
||||||
MAKE_SOFT_DECISION();
|
MAKE_SOFT_DECISION();
|
||||||
//Dbprintf("ICE: %d %d %d %d %d", v, Demod.sumI, Demod.sumQ, ci, cq );
|
//Dbprintf("ICE: %d %d %d %d %d", v, Demod.sumI, Demod.sumQ, ci, cq );
|
||||||
if(v < 0) { // logic '0' detected
|
if(v <= 0) { // logic '0' detected
|
||||||
Demod.state = DEMOD_GOT_FALLING_EDGE_OF_SOF;
|
Demod.state = DEMOD_GOT_FALLING_EDGE_OF_SOF;
|
||||||
Demod.posCount = 0; // start of SOF sequence
|
Demod.posCount = 0; // start of SOF sequence
|
||||||
} else {
|
} else {
|
||||||
|
@ -767,7 +761,7 @@ static void GetSamplesFor14443bDemod(int n, bool quiet)
|
||||||
}
|
}
|
||||||
lastRxCounter -= 2;
|
lastRxCounter -= 2;
|
||||||
if(lastRxCounter <= 0) {
|
if(lastRxCounter <= 0) {
|
||||||
lastRxCounter += ISO14443B_DMA_BUFFER_SIZE;
|
lastRxCounter = ISO14443B_DMA_BUFFER_SIZE;
|
||||||
}
|
}
|
||||||
|
|
||||||
samples += 2;
|
samples += 2;
|
||||||
|
@ -1012,6 +1006,8 @@ void iso14443b_setup() {
|
||||||
// Signal field is on with the appropriate LED
|
// Signal field is on with the appropriate LED
|
||||||
LED_D_ON();
|
LED_D_ON();
|
||||||
FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_TX | FPGA_HF_READER_TX_SHALLOW_MOD);
|
FpgaWriteConfWord(FPGA_MAJOR_MODE_HF_READER_TX | FPGA_HF_READER_TX_SHALLOW_MOD);
|
||||||
|
|
||||||
|
SpinDelay(100);
|
||||||
|
|
||||||
// Start the timer
|
// Start the timer
|
||||||
//StartCountSspClk();
|
//StartCountSspClk();
|
||||||
|
|
|
@ -447,9 +447,7 @@ int DesfireAPDU(uint8_t *cmd, size_t cmd_len, uint8_t *dataout){
|
||||||
len = ReaderReceive(resp, par);
|
len = ReaderReceive(resp, par);
|
||||||
|
|
||||||
if( len == 0x00 ){
|
if( len == 0x00 ){
|
||||||
if (MF_DBGLEVEL >= 4) {
|
if (MF_DBGLEVEL >= 4) Dbprintf("fukked");
|
||||||
Dbprintf("fukked");
|
|
||||||
}
|
|
||||||
return FALSE; //DATA LINK ERROR
|
return FALSE; //DATA LINK ERROR
|
||||||
}
|
}
|
||||||
// if we received an I- or R(ACK)-Block with a block number equal to the
|
// if we received an I- or R(ACK)-Block with a block number equal to the
|
||||||
|
|
|
@ -207,29 +207,50 @@ void annotateTopaz(char *exp, size_t size, uint8_t* cmd, uint8_t cmdsize)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// iso 7816-3
|
||||||
void annotateIso7816(char *exp, size_t size, uint8_t* cmd, uint8_t cmdsize){
|
void annotateIso7816(char *exp, size_t size, uint8_t* cmd, uint8_t cmdsize){
|
||||||
|
// S-block
|
||||||
|
if ( (cmd[0] & 0xC0) && (cmdsize == 3) ) {
|
||||||
|
switch ( (cmd[0] & 0x3f) ) {
|
||||||
|
case 0x00 : snprintf(exp, size, "S-block RESYNCH req"); break;
|
||||||
|
case 0x20 : snprintf(exp, size, "S-block RESYNCH resp"); break;
|
||||||
|
case 0x01 : snprintf(exp, size, "S-block IFS req"); break;
|
||||||
|
case 0x21 : snprintf(exp, size, "S-block IFS resp"); break;
|
||||||
|
case 0x02 : snprintf(exp, size, "S-block ABORT req"); break;
|
||||||
|
case 0x22 : snprintf(exp, size, "S-block ABORT resp"); break;
|
||||||
|
case 0x03 : snprintf(exp, size, "S-block WTX reqt"); break;
|
||||||
|
case 0x23 : snprintf(exp, size, "S-block WTX resp"); break;
|
||||||
|
default : snprintf(exp, size, "S-block"); break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
// R-block (ack)
|
||||||
|
else if ( ((cmd[0] & 0xD0) == 0x80) && ( cmdsize > 2) ) {
|
||||||
|
snprintf(exp, size, "R-block");
|
||||||
|
}
|
||||||
|
// I-block
|
||||||
|
else {
|
||||||
|
|
||||||
int pos = (cmd[0] == 2 || cmd[0] == 3) ? 2 : 3;
|
int pos = (cmd[0] == 2 || cmd[0] == 3) ? 2 : 3;
|
||||||
|
switch ( cmd[pos] ){
|
||||||
switch ( cmd[pos] ){
|
case ISO7816_READ_BINARY :snprintf(exp, size, "READ BIN");break;
|
||||||
case ISO7816_READ_BINARY :snprintf(exp, size, "READ BIN");break;
|
case ISO7816_WRITE_BINARY :snprintf(exp, size, "WRITE BIN");break;
|
||||||
case ISO7816_WRITE_BINARY :snprintf(exp, size, "WRITE BIN");break;
|
case ISO7816_UPDATE_BINARY :snprintf(exp, size, "UPDATE BIN");break;
|
||||||
case ISO7816_UPDATE_BINARY :snprintf(exp, size, "UPDATE BIN");break;
|
case ISO7816_ERASE_BINARY :snprintf(exp, size, "ERASE BIN");break;
|
||||||
case ISO7816_ERASE_BINARY :snprintf(exp, size, "ERASE BIN");break;
|
case ISO7816_READ_RECORDS :snprintf(exp, size, "READ RECORDS");break;
|
||||||
case ISO7816_READ_RECORDS :snprintf(exp, size, "READ RECORDS");break;
|
case ISO7816_WRITE_RECORDS :snprintf(exp, size, "WRITE RECORDS");break;
|
||||||
case ISO7816_WRITE_RECORDS :snprintf(exp, size, "WRITE RECORDS");break;
|
case ISO7816_APPEND_RECORD :snprintf(exp, size, "APPEND RECORD");break;
|
||||||
case ISO7816_APPEND_RECORD :snprintf(exp, size, "APPEND RECORD");break;
|
case ISO7816_UPDATE_RECORD :snprintf(exp, size, "UPDATE RECORD");break;
|
||||||
case ISO7816_UPDATE_RECORD :snprintf(exp, size, "UPDATE RECORD");break;
|
case ISO7816_GET_DATA :snprintf(exp, size, "GET DATA");break;
|
||||||
case ISO7816_GET_DATA :snprintf(exp, size, "GET DATA");break;
|
case ISO7816_PUT_DATA :snprintf(exp, size, "PUT DATA");break;
|
||||||
case ISO7816_PUT_DATA :snprintf(exp, size, "PUT DATA");break;
|
case ISO7816_SELECT_FILE :snprintf(exp, size, "SELECT FILE");break;
|
||||||
case ISO7816_SELECT_FILE :snprintf(exp, size, "SELECT FILE");break;
|
case ISO7816_VERIFY :snprintf(exp, size, "VERIFY");break;
|
||||||
case ISO7816_VERIFY :snprintf(exp, size, "VERIFY");break;
|
case ISO7816_INTERNAL_AUTHENTICATION :snprintf(exp, size, "INTERNAL AUTH");break;
|
||||||
case ISO7816_INTERNAL_AUTHENTICATION :snprintf(exp, size, "INTERNAL AUTH");break;
|
case ISO7816_EXTERNAL_AUTHENTICATION :snprintf(exp, size, "EXTERNAL AUTH");break;
|
||||||
case ISO7816_EXTERNAL_AUTHENTICATION :snprintf(exp, size, "EXTERNAL AUTH");break;
|
case ISO7816_GET_CHALLENGE :snprintf(exp, size, "GET CHALLENGE");break;
|
||||||
case ISO7816_GET_CHALLENGE :snprintf(exp, size, "GET CHALLENGE");break;
|
case ISO7816_MANAGE_CHANNEL :snprintf(exp, size, "MANAGE CHANNEL");break;
|
||||||
case ISO7816_MANAGE_CHANNEL :snprintf(exp, size, "MANAGE CHANNEL");break;
|
default :snprintf(exp,size,"?"); break;
|
||||||
default :snprintf(exp,size,"?"); break;
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
|
Loading…
Add table
Add a link
Reference in a new issue