comparison rvinterf/etmsync/l1tmops.c @ 844:4694c7686ccd

fc-tmsync: add mpr command
author Mychaela Falconia <falcon@freecalypso.org>
date Sat, 31 Jul 2021 21:57:48 +0000
parents 4469d73bbc60
children
comparison
equal deleted inserted replaced
843:6a0fcbca8ac7 844:4694c7686ccd
135 return(ERROR_TARGET); 135 return(ERROR_TARGET);
136 } 136 }
137 bcopy(rvi_msg + 5, buf, 32); 137 bcopy(rvi_msg + 5, buf, 32);
138 return(0); 138 return(0);
139 } 139 }
140
141 do_mpr(index, retp)
142 u_short *retp;
143 {
144 u_char cmdpkt[5];
145
146 cmdpkt[1] = MISC_PARAM_READ;
147 cmdpkt[2] = index;
148 cmdpkt[3] = index >> 8;
149 etm_pkt_exch(cmdpkt, 3);
150 if (rvi_msg[3]) {
151 fprintf(stderr, "target error %u in response to mpr\n",
152 rvi_msg[3]);
153 return(ERROR_TARGET);
154 }
155 if (rvi_msg_len < 8) {
156 fprintf(stderr, "target error: mpr response too short\n");
157 return(ERROR_TARGET);
158 }
159 if (rvi_msg[4] != index) {
160 fprintf(stderr, "target error: mpr response wrong index\n");
161 return(ERROR_TARGET);
162 }
163 *retp = rvi_msg[5] | (rvi_msg[6] << 8);
164 return(0);
165 }