catarrh/simtrace2
1
0
Fork 0
mirror of https://gitea.osmocom.org/sim-card/simtrace2.git synced 2026-03-25 17:58:32 +03:00
Code Issues Packages Projects Releases Wiki Activity

sniffer: also send incomplete (e.g. timeout) data (PPS/ATR/TPDU)

Browse Source 
Change-Id: Ib070aca181042b477f1ffec48d63dc56c1e4609a
This commit is contained in:
Kévin Redon
2018-07-03 16:15:58 +02:00
committed by King Kévin
parent 709a431ab9
commit 35e8bdf879
1 changed files with 41 additions and 26 deletions
Download Patch File Download Diff File Expand all files Collapse all files

67
firmware/libcommon/source/sniffer.c
View File

@@ -91,6 +91,7 @@ enum pps_sniff_state {
PPS_S_WAIT_PPS2, /*!< second parameter byte */ PPS_S_WAIT_PPS2, /*!< second parameter byte */
PPS_S_WAIT_PPS3, /*!< third parameter byte */ PPS_S_WAIT_PPS3, /*!< third parameter byte */
PPS_S_WAIT_PCK, /*!< check byte */ PPS_S_WAIT_PCK, /*!< check byte */
PPS_S_WAIT_END, /*!< all done */
}; };
/*! Transport Protocol Data Unit (TPDU) sub-states of ISO7816_S_IN_TPDU /*! Transport Protocol Data Unit (TPDU) sub-states of ISO7816_S_IN_TPDU
@@ -265,9 +266,10 @@ static void change_state(enum iso7816_3_sniff_state iso_state_new)
} }
/*! Send current ATR over USB /*! Send current ATR over USB
* @note Also print the ATR over serial * @param[in] complete if the ATR is complete
* @note Also print the ATR to debug console
*/ */
static void usb_send_atr(void) static void usb_send_atr(bool complete)
{ {
/* Check state */ /* Check state */
if (ISO7816_S_IN_ATR!=iso_state) { if (ISO7816_S_IN_ATR!=iso_state) {
@@ -283,7 +285,7 @@ static void usb_send_atr(void)
led_blink(LED_GREEN, BLINK_2O_F); led_blink(LED_GREEN, BLINK_2O_F);
/* Print ATR */ /* Print ATR */
printf("ATR: "); printf("ATR%s: ", complete ? "" : " (incomplete)");
uint8_t i; uint8_t i;
for (i = 0; i < atr_i; i++) { for (i = 0; i < atr_i; i++) {
printf("%02x ", atr[i]); printf("%02x ", atr[i]);
@@ -296,7 +298,7 @@ static void usb_send_atr(void)
return; return;
} }
struct sniff_data *usb_sniff_data_atr = (struct sniff_data *) msgb_put(usb_msg, sizeof(*usb_sniff_data_atr)); struct sniff_data *usb_sniff_data_atr = (struct sniff_data *) msgb_put(usb_msg, sizeof(*usb_sniff_data_atr));
usb_sniff_data_atr->complete = true; usb_sniff_data_atr->complete = complete;
usb_sniff_data_atr->length = atr_i; usb_sniff_data_atr->length = atr_i;
uint8_t *data = msgb_put(usb_msg, usb_sniff_data_atr->length); uint8_t *data = msgb_put(usb_msg, usb_sniff_data_atr->length);
memcpy(data, atr, atr_i); memcpy(data, atr, atr_i);
@@ -384,7 +386,7 @@ static void process_byte_atr(uint8_t byte)
} }
case ATR_S_WAIT_TCK: /* see ISO/IEC 7816-3:2006 section 8.2.5 */ case ATR_S_WAIT_TCK: /* see ISO/IEC 7816-3:2006 section 8.2.5 */
/* we could verify the checksum, but we are just here to sniff */ /* we could verify the checksum, but we are just here to sniff */
usb_send_atr(); /* send ATR to host software using USB */ usb_send_atr(true); /* send ATR to host software using USB */
change_state(ISO7816_S_WAIT_TPDU); /* go to next state */ change_state(ISO7816_S_WAIT_TPDU); /* go to next state */
break; break;
default: default:
@@ -393,9 +395,10 @@ static void process_byte_atr(uint8_t byte)
} }
/*! Send current PPS over USB /*! Send current PPS over USB
* @note Also print the PPS over serial * @param[in] complete if the PPS is complete
* @note Also print the PPS over the debug console
*/ */
static void usb_send_pps(void) static void usb_send_pps(bool complete)
{ {
uint8_t *pps_cur; /* current PPS (request or response) */ uint8_t *pps_cur; /* current PPS (request or response) */
@@ -412,26 +415,32 @@ static void usb_send_pps(void)
/* Get only relevant data */ /* Get only relevant data */
uint8_t pps[6]; uint8_t pps[6];
uint8_t pps_i = 0; uint8_t pps_i = 0;
pps[pps_i++] = pps_cur[0]; if (pps_state>PPS_S_WAIT_PPSS) {
pps[pps_i++] = pps_cur[1]; pps[pps_i++] = pps_cur[0];
if (pps_cur[1]&0x10) { }
if (pps_state>PPS_S_WAIT_PPS0) {
pps[pps_i++] = pps_cur[1];
}
if (pps_state>PPS_S_WAIT_PPS1 && pps_cur[1]&0x10) {
pps[pps_i++] = pps_cur[2]; pps[pps_i++] = pps_cur[2];
} }
if (pps_cur[1]&0x20) { if (pps_state>PPS_S_WAIT_PPS2 && pps_cur[1]&0x20) {
pps[pps_i++] = pps_cur[3]; pps[pps_i++] = pps_cur[3];
} }
if (pps_cur[1]&0x40) { if (pps_state>PPS_S_WAIT_PPS3 && pps_cur[1]&0x40) {
pps[pps_i++] = pps_cur[4]; pps[pps_i++] = pps_cur[4];
} }
pps[pps_i++] = pps_cur[5]; if (pps_state>PPS_S_WAIT_PCK) {
pps[pps_i++] = pps_cur[5];
}
/* Show activity on LED */ /* Show activity on LED */
led_blink(LED_GREEN, BLINK_2O_F); led_blink(LED_GREEN, BLINK_2O_F);
/* Print PPS */ /* Print PPS */
printf("PPS: "); printf("PPS%s: ", complete ? "" : " (incomplete)");
uint8_t i; uint8_t i;
for (i = 0; i < pps_i; i++) { for (i = 0; i < pps_i; i++) {
printf("%02x ", pps[i]); printf("%02x ", pps[i]);
} }
printf("\n\r"); printf("\n\r");
@@ -442,7 +451,7 @@ static void usb_send_pps(void)
return; return;
} }
struct sniff_data *usb_sniff_data_pps = (struct sniff_data *) msgb_put(usb_msg, sizeof(*usb_sniff_data_pps)); struct sniff_data *usb_sniff_data_pps = (struct sniff_data *) msgb_put(usb_msg, sizeof(*usb_sniff_data_pps));
usb_sniff_data_pps->complete = true; usb_sniff_data_pps->complete = complete;
usb_sniff_data_pps->length = pps_i; usb_sniff_data_pps->length = pps_i;
uint8_t *data = msgb_put(usb_msg, usb_sniff_data_pps->length); uint8_t *data = msgb_put(usb_msg, usb_sniff_data_pps->length);
memcpy(data, pps, pps_i); memcpy(data, pps, pps_i);
@@ -527,7 +536,8 @@ static void process_byte_pps(uint8_t byte)
check ^= pps_cur[4]; check ^= pps_cur[4];
} }
check ^= pps_cur[5]; check ^= pps_cur[5];
usb_send_pps(); /* send PPS to host software using USB */ pps_state = PPS_S_WAIT_END;
usb_send_pps(true); /* send PPS to host software using USB */
if (ISO7816_S_IN_PPS_REQ==iso_state) { if (ISO7816_S_IN_PPS_REQ==iso_state) {
if (0==check) { /* checksum is valid */ if (0==check) { /* checksum is valid */
change_state(ISO7816_S_WAIT_PPS_RSP); /* go to next state */ change_state(ISO7816_S_WAIT_PPS_RSP); /* go to next state */
@@ -553,15 +563,20 @@ static void process_byte_pps(uint8_t byte)
change_state(ISO7816_S_WAIT_TPDU); /* go to next state */ change_state(ISO7816_S_WAIT_TPDU); /* go to next state */
} }
break; break;
case PPS_S_WAIT_END:
TRACE_WARNING("Unexpected PPS received %u\n\r", pps_state);
break;
default: default:
TRACE_INFO("Unknown PPS state %u\n\r", pps_state); TRACE_WARNING("Unknown PPS state %u\n\r", pps_state);
break;
} }
} }
/*! Send current TPDU over USB /*! Send current TPDU over USB
* @note Also print the TPDU over serial * @param[in] complete if the TPDU is complete
* @note Also print the TPDU over the debug console
*/ */
static void usb_send_tpdu(void) static void usb_send_tpdu(bool complete)
{ {
/* Check state */ /* Check state */
if (ISO7816_S_IN_TPDU!=iso_state) { if (ISO7816_S_IN_TPDU!=iso_state) {
@@ -573,7 +588,7 @@ static void usb_send_tpdu(void)
led_blink(LED_GREEN, BLINK_2O_F); led_blink(LED_GREEN, BLINK_2O_F);
/* Print TPDU */ /* Print TPDU */
printf("TPDU: "); printf("TPDU%s: ", complete ? "" : " (incomplete)");
uint16_t i; uint16_t i;
for (i = 0; i < tpdu_packet_i && i < ARRAY_SIZE(tpdu_packet); i++) { for (i = 0; i < tpdu_packet_i && i < ARRAY_SIZE(tpdu_packet); i++) {
printf("%02x ", tpdu_packet[i]); printf("%02x ", tpdu_packet[i]);
@@ -586,7 +601,7 @@ static void usb_send_tpdu(void)
return; return;
} }
struct sniff_data *usb_sniff_data_tpdu = (struct sniff_data *) msgb_put(usb_msg, sizeof(*usb_sniff_data_tpdu)); struct sniff_data *usb_sniff_data_tpdu = (struct sniff_data *) msgb_put(usb_msg, sizeof(*usb_sniff_data_tpdu));
usb_sniff_data_tpdu->complete = true; usb_sniff_data_tpdu->complete = complete;
usb_sniff_data_tpdu->length = tpdu_packet_i; usb_sniff_data_tpdu->length = tpdu_packet_i;
uint8_t *data = msgb_put(usb_msg, usb_sniff_data_tpdu->length); uint8_t *data = msgb_put(usb_msg, usb_sniff_data_tpdu->length);
memcpy(data, tpdu_packet, tpdu_packet_i); memcpy(data, tpdu_packet, tpdu_packet_i);
@@ -656,7 +671,7 @@ static void process_byte_tpdu(uint8_t byte)
break; break;
case TPDU_S_SW2: case TPDU_S_SW2:
tpdu_packet[tpdu_packet_i++] = byte; tpdu_packet[tpdu_packet_i++] = byte;
usb_send_tpdu(); /* send TPDU to host software using USB */ usb_send_tpdu(true); /* send TPDU to host software using USB */
change_state(ISO7816_S_WAIT_TPDU); /* this is the end of the TPDU */ change_state(ISO7816_S_WAIT_TPDU); /* this is the end of the TPDU */
break; break;
case TPDU_S_DATA_SINGLE: case TPDU_S_DATA_SINGLE:
@@ -902,16 +917,16 @@ void Sniffer_run(void)
/* Use timeout to detect interrupted data transmission */ /* Use timeout to detect interrupted data transmission */
switch (iso_state) { switch (iso_state) {
case ISO7816_S_IN_ATR: case ISO7816_S_IN_ATR:
//usb_send_atr(false); /* send incomplete ATR to host software using USB */ usb_send_atr(false); /* send incomplete ATR to host software using USB */
change_state(ISO7816_S_WAIT_ATR); change_state(ISO7816_S_WAIT_ATR);
break; break;
case ISO7816_S_IN_TPDU: case ISO7816_S_IN_TPDU:
//usb_send_tpdu(false); /* send incomplete PPS to host software using USB */ usb_send_tpdu(false); /* send incomplete PPS to host software using USB */
change_state(ISO7816_S_WAIT_TPDU); change_state(ISO7816_S_WAIT_TPDU);
break; break;
case ISO7816_S_IN_PPS_REQ: case ISO7816_S_IN_PPS_REQ:
case ISO7816_S_IN_PPS_RSP: case ISO7816_S_IN_PPS_RSP:
//usb_send_pps(false); /* send incomplete TPDU to host software using USB */ usb_send_pps(false); /* send incomplete TPDU to host software using USB */
change_state(ISO7816_S_WAIT_TPDU); change_state(ISO7816_S_WAIT_TPDU);
break; break;
default: default: