fix chaining in Rx case

git-svn-id: https://svn.gnumonks.org/trunk/librfid@1526 e0336214-984f-0b4b-a45f-81c69e1f0ede

1 files changed, 14 insertions, 5 deletions

diff --git a/rfid_proto_tcl.c b/rfid_proto_tcl.c
index 82a6acf..da3ecf1 100644
--- a/rfid_proto_tcl.c
+++ b/rfid_proto_tcl.c
@@ -215,6 +215,7 @@ static unsigned char d_to_di(struct rfid_protocol_handle *h, unsigned char D)
 static int 
 tcl_do_pps(struct rfid_protocol_handle *h)
 {
+#if 0
 	int ret;
 	unsigned char ppss[3];
 	unsigned char pps_response[1];
@@ -256,7 +257,7 @@ tcl_do_pps(struct rfid_protocol_handle *h)
 	}
 	
 	h->priv.tcl.state = TCL_STATE_ESTABLISHED;
-
+#endif
 	return 0;
 }
 
@@ -462,6 +463,8 @@ tcl_transcieve(struct rfid_protocol_handle *h,
 	unsigned char *_tx;
 	unsigned int _tx_len, _timeout;
 	unsigned char wtx_resp[3];
+	unsigned char ack[10];
+	unsigned int ack_len;
 
 	if (tx_len > max_net_tx_framesize(th)) {
 		/* slow path: we need to use chaining */
@@ -493,6 +496,7 @@ tcl_transcieve(struct rfid_protocol_handle *h,
 do_tx:
 	ret = h->l2h->l2->fn.transcieve(h->l2h, _tx, _tx_len,
 					rx_buf, rx_len, _timeout, 0);
+	DEBUGP("l2 transcieve finished\n");
 	if (ret < 0)
 		goto out_rxb;
 
@@ -501,11 +505,9 @@ do_tx:
 		goto out_rxb;
 	}
 
-	//if (*rx_len )
-	//
-
 	if (is_r_block(*rx_buf)) {
 		unsigned int txed = _tx - tx_buf;
+		DEBUGP("R-Block\n");
 		/* Handle ACK frame in case of chaining */
 		if (*rx_buf & TCL_PCB_CID_FOLLOWING) {
 			if (*(rx_buf+1) != h->priv.tcl.cid) {
@@ -536,6 +538,7 @@ do_tx:
 		unsigned char inf;
 		unsigned int prlg_len;
 
+		DEBUGP("S-Block\n");
 		/* Handle Wait Time Extension */
 		if (*rx_buf & TCL_PCB_CID_FOLLOWING) {
 			if (*rx_len < 3) {
@@ -580,6 +583,7 @@ do_tx:
 		unsigned char *inf = rx_buf+1;
 		/* we're actually receiving payload data */
 
+		DEBUGP("I-Block\n");
 		if (*rx_buf & TCL_PCB_CID_FOLLOWING) {
 			if (*(rx_buf+1) != h->priv.tcl.cid) {
 				DEBUGP("CID %u is not valid\n", *(rx_buf)+1);
@@ -593,7 +597,12 @@ do_tx:
 		memcpy(rx_data, inf, *rx_len - (inf - rx_buf));
 
 		if (*rx_buf & 0x10) {
-			/* we're not the last frame in the chain, continue */
+			/* we're not the last frame in the chain, continue rx */
+			DEBUGP("we're not the last frame in the chain, continue\n");
+			ack_len = sizeof(ack);
+			tcl_build_prologue_r(&h->priv.tcl, ack, &ack_len, 0);
+			_tx = ack;
+			_tx_len = ack_len;
 			goto do_tx;
 		}
 	}