# HG changeset patch
# User Mychaela Falconia <falcon@freecalypso.org>
# Date 1510859692 0
# Node ID dc9dbb2f74e76fc855fc336ae840bd627c8ca50c
# Parent  095ffce023d4888950d6fc13363bda12a57f567a
etmsync l1tmops module: rfpr implemented

diff -r 095ffce023d4 -r dc9dbb2f74e7 rvinterf/etmsync/l1tmops.c
--- a/rvinterf/etmsync/l1tmops.c	Thu Nov 16 19:00:05 2017 +0000
+++ b/rvinterf/etmsync/l1tmops.c	Thu Nov 16 19:14:52 2017 +0000
@@ -36,6 +36,32 @@
 	return(0);
 }
 
+do_rfpr(index, retp)
+	u_short *retp;
+{
+	u_char cmdpkt[5];
+
+	cmdpkt[1] = RF_PARAM_READ;
+	cmdpkt[2] = index;
+	cmdpkt[3] = index >> 8;
+	etm_pkt_exch(cmdpkt, 3);
+	if (rvi_msg[3]) {
+		fprintf(stderr, "target error %u in response to rfpr\n",
+			rvi_msg[3]);
+		exit(ERROR_TARGET);
+	}
+	if (rvi_msg_len != 8) {
+		fprintf(stderr, "target error: rfpr response wrong length\n");
+		exit(ERROR_TARGET);
+	}
+	if (rvi_msg[4] != index) {
+		fprintf(stderr, "target error: rfpr response wrong index\n");
+		exit(ERROR_TARGET);
+	}
+	*retp = rvi_msg[5] | (rvi_msg[6] << 8);
+	return(0);
+}
+
 do_rfpw(index, value)
 {
 	u_char cmdpkt[7];