From d79dc4f6f2448a47e6590cd8842e6954f98f367a Mon Sep 17 00:00:00 2001
From: Harald Welte <laforge@gnumonks.org>
Date: Sat, 14 Nov 2015 13:32:21 +0100
Subject: [PATCH] card_emu: Implement get_byte_pts()

---
 firmware/src_simtrace/card_emu.c | 31 ++++++++++++++++---------------
 1 file changed, 16 insertions(+), 15 deletions(-)

diff --git a/firmware/src_simtrace/card_emu.c b/firmware/src_simtrace/card_emu.c
index e129869c..55933147 100644
--- a/firmware/src_simtrace/card_emu.c
+++ b/firmware/src_simtrace/card_emu.c
@@ -299,41 +299,42 @@ process_byte_pts(struct card_handle *ch, uint8_t byte)
 }
 
 /* return a single byte to be transmitted to the reader */
-static int get_byte_pps(struct card_handle *ch, uint8_t *byte)
+static int get_byte_pts(struct card_handle *ch, uint8_t *byte)
 {
-	/* FIXME */
-#if 0
 	switch (ch->pts.state) {
 	case PTS_S_WAIT_RESP_PTSS:
-		ch->pts.resp[_PTSS] = byte;
+		*byte = ch->pts.resp[_PTSS];
 		break;
 	case PTS_S_WAIT_RESP_PTS0:
-		ch->pts.resp[_PTS0] = byte;
+		*byte = ch->pts.resp[_PTS0];
 		break;
 	case PTS_S_WAIT_RESP_PTS1:
+		*byte = ch->pts.resp[_PTS1];
 		/* This must be TA1 */
-		ch->fi = byte >> 4;
-		ch->di = byte & 0xf;
+		ch->fi = *byte >> 4;
+		ch->di = *byte & 0xf;
 		TRACE_DEBUG("found Fi=%u Di=%u\n", ch->fi, ch->di);
-		ch->sh.flags |= SIMTRACE_FLAG_PPS_FIDI;
-		ch->pts.resp[_PTS1] = byte;
+		//ch->sh.flags |= SIMTRACE_FLAG_PPS_FIDI;
 		break;
 	case PTS_S_WAIT_RESP_PTS2:
-		ch->pts.resp[_PTS2] = byte;
+		*byte = ch->pts.resp[_PTS2];
 		break;
 	case PTS_S_WAIT_RESP_PTS3:
-		ch->pts.resp[_PTS3] = byte;
+		*byte = ch->pts.resp[_PTS3];
 		break;
 	case PTS_S_WAIT_RESP_PCK:
-		ch->pts.resp[_PCK] = byte;
-		/* FIXME: check PCK */
+		*byte = ch->pts.resp[_PCK];
 		set_pts_state(ch, PTS_S_WAIT_REQ_PTSS);
 		/* update baud rate generator with Fi/Di */
 		update_fidi(ch);
 		/* Wait for the next TPDU */
 		card_set_state(ch, ISO_S_WAIT_TPDU);
+	default:
+		TRACE_DEBUG("get_byte_pts() in invalid state %u\n",
+			ch->pts.state);
+		break;
 	}
-#endif
+
 	/* calculate the next state and set it */
 	set_pts_state(ch, next_pts_state(ch));
 
@@ -591,7 +592,7 @@ int card_emu_get_tx_byte(struct card_handle *ch, uint8_t *byte)
 		}
 		break;
 	case ISO_S_IN_PTS:
-		rc = get_byte_pps(ch, byte);
+		rc = get_byte_pts(ch, byte);
 		break;
 	case ISO_S_IN_TPDU:
 		rc = get_byte_tpdu(ch, byte);