FreeCalypso > hg > freecalypso-tools
view rvinterf/rvtat/interf.c @ 396:519d914e08a2
CHANGES: fc-lcdemu move-out and rvinterf -X output inversion fix
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Thu, 15 Mar 2018 01:16:17 +0000 |
parents | 99471c57155a |
children |
line wrap: on
line source
/* * In this module we implement our synchronous interface to the target * via rvinterf. */ #include <sys/types.h> #include <stdio.h> #include <stdlib.h> #include <unistd.h> #include "limits.h" #include "localsock.h" #include "pktmux.h" #include "exitcodes.h" extern int sock; int rx_enable_state; u_char rvi_msg[LOCALSOCK_MAX_MSG]; int rvi_msg_len; static void collect_bytes_from_rvi(buf, nbytes) u_char *buf; { int cc; while (nbytes) { cc = read(sock, buf, nbytes); if (cc <= 0) { perror("read from rvinterf socket"); exit(ERROR_RVINTERF); } buf += cc; nbytes -= cc; } } collect_rvi_msg() { u_char lenbuf[2]; collect_bytes_from_rvi(lenbuf, 2); rvi_msg_len = lenbuf[0] << 8 | lenbuf[1]; if (rvi_msg_len < 1 || rvi_msg_len > LOCALSOCK_MAX_MSG) { fprintf(stderr, "Invalid length from rvinterf: %02X%02X\n", lenbuf[0], lenbuf[1]); exit(ERROR_RVINTERF); } collect_bytes_from_rvi(rvi_msg, rvi_msg_len); return(0); } send_rvimisc_command(cmdpkt, cmdlen) u_char *cmdpkt; { u_char lenbuf[2]; lenbuf[0] = 0; lenbuf[1] = cmdlen; write(sock, lenbuf, 2); write(sock, cmdpkt, cmdlen); } rx_control(enable) { u_char cmdpkt[2]; int cmdlen; /* are we already in the desired state? */ if (rx_enable_state == enable) return(0); /* no, do the work */ if (enable) { cmdpkt[0] = CLI2RVI_WANT_MUXPROTO; cmdpkt[1] = RVT_AT_HEADER; cmdlen = 2; } else { cmdpkt[0] = CLI2RVI_RESET_PACKET_RX; cmdlen = 1; } send_rvimisc_command(cmdpkt, cmdlen); collect_rvi_msg(); if (rvi_msg[0] != RVI2CLI_LOCAL_CMD_RESP || rvi_msg_len < 2) { fprintf(stderr, "error: unexpected response to rvinterf local command\n"); exit(ERROR_RVINTERF); } if (rvi_msg[1] != '+') { fprintf(stderr, "Error from rvinterf: %.*s\n", rvi_msg_len - 1, rvi_msg + 1); exit(ERROR_RVINTERF); } rx_enable_state = enable; return(0); } send_pkt_to_target(pkt, pktlen) u_char *pkt; { u_char hdrbuf[3]; int len1; len1 = pktlen + 1; hdrbuf[0] = len1 >> 8; hdrbuf[1] = len1 & 0xFF; hdrbuf[2] = CLI2RVI_PKT_TO_TARGET; write(sock, hdrbuf, 3); write(sock, pkt, pktlen); } collect_pkt_from_target() { collect_rvi_msg(); if (rvi_msg[0] != RVI2CLI_PKT_FROM_TARGET) { fprintf(stderr, "error: unexpected response type from rvinterf\n"); exit(ERROR_RVINTERF); } if (rvi_msg_len < 2) { fprintf(stderr, "error: packet from target is null\n"); exit(ERROR_RVINTERF); } if (rvi_msg[1] != RVT_AT_HEADER) { fprintf(stderr, "error: packet from target is not on ATI channel\n"); exit(ERROR_RVINTERF); } return(0); }