sniffer: also send incomplete (e.g. timeout) data (PPS/ATR/TPDU)
Change-Id: Ib070aca181042b477f1ffec48d63dc56c1e4609a
diff --git a/firmware/libcommon/source/sniffer.c b/firmware/libcommon/source/sniffer.c
index c2b8725..2ad435c 100644
--- a/firmware/libcommon/source/sniffer.c
+++ b/firmware/libcommon/source/sniffer.c
@@ -91,6 +91,7 @@
PPS_S_WAIT_PPS2, /*!< second parameter byte */
PPS_S_WAIT_PPS3, /*!< third parameter 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
@@ -265,9 +266,10 @@
}
/*! 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 */
if (ISO7816_S_IN_ATR!=iso_state) {
@@ -283,7 +285,7 @@
led_blink(LED_GREEN, BLINK_2O_F);
/* Print ATR */
- printf("ATR: ");
+ printf("ATR%s: ", complete ? "" : " (incomplete)");
uint8_t i;
for (i = 0; i < atr_i; i++) {
printf("%02x ", atr[i]);
@@ -296,7 +298,7 @@
return;
}
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;
uint8_t *data = msgb_put(usb_msg, usb_sniff_data_atr->length);
memcpy(data, atr, atr_i);
@@ -384,7 +386,7 @@
}
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 */
- 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 */
break;
default:
@@ -393,9 +395,10 @@
}
/*! 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) */
@@ -412,26 +415,32 @@
/* Get only relevant data */
uint8_t pps[6];
uint8_t pps_i = 0;
- pps[pps_i++] = pps_cur[0];
- pps[pps_i++] = pps_cur[1];
- if (pps_cur[1]&0x10) {
+ if (pps_state>PPS_S_WAIT_PPSS) {
+ pps[pps_i++] = pps_cur[0];
+ }
+ 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];
}
- if (pps_cur[1]&0x20) {
+ if (pps_state>PPS_S_WAIT_PPS2 && pps_cur[1]&0x20) {
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[5];
+ if (pps_state>PPS_S_WAIT_PCK) {
+ pps[pps_i++] = pps_cur[5];
+ }
/* Show activity on LED */
led_blink(LED_GREEN, BLINK_2O_F);
/* Print PPS */
- printf("PPS: ");
+ printf("PPS%s: ", complete ? "" : " (incomplete)");
uint8_t i;
- for (i = 0; i < pps_i; i++) {
+ for (i = 0; i < pps_i; i++) {
printf("%02x ", pps[i]);
}
printf("\n\r");
@@ -442,7 +451,7 @@
return;
}
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;
uint8_t *data = msgb_put(usb_msg, usb_sniff_data_pps->length);
memcpy(data, pps, pps_i);
@@ -527,7 +536,8 @@
check ^= pps_cur[4];
}
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 (0==check) { /* checksum is valid */
change_state(ISO7816_S_WAIT_PPS_RSP); /* go to next state */
@@ -553,15 +563,20 @@
change_state(ISO7816_S_WAIT_TPDU); /* go to next state */
}
break;
+ case PPS_S_WAIT_END:
+ TRACE_WARNING("Unexpected PPS received %u\n\r", pps_state);
+ break;
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
- * @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 */
if (ISO7816_S_IN_TPDU!=iso_state) {
@@ -573,7 +588,7 @@
led_blink(LED_GREEN, BLINK_2O_F);
/* Print TPDU */
- printf("TPDU: ");
+ printf("TPDU%s: ", complete ? "" : " (incomplete)");
uint16_t i;
for (i = 0; i < tpdu_packet_i && i < ARRAY_SIZE(tpdu_packet); i++) {
printf("%02x ", tpdu_packet[i]);
@@ -586,7 +601,7 @@
return;
}
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;
uint8_t *data = msgb_put(usb_msg, usb_sniff_data_tpdu->length);
memcpy(data, tpdu_packet, tpdu_packet_i);
@@ -656,7 +671,7 @@
break;
case TPDU_S_SW2:
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 */
break;
case TPDU_S_DATA_SINGLE:
@@ -902,16 +917,16 @@
/* Use timeout to detect interrupted data transmission */
switch (iso_state) {
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);
break;
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);
break;
case ISO7816_S_IN_PPS_REQ:
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);
break;
default: