FreeCalypso > hg > freecalypso-tools
view rvinterf/old/before-rvinterf/packettx.c @ 27:24cb10d508d7
fc-fsio help command implemented
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sun, 23 Oct 2016 01:33:21 +0000 |
parents | e7502631a0f9 |
children |
line wrap: on
line source
/* * This module handles the lowest level of serial packet Tx */ #include <sys/types.h> #include <stdio.h> #include <stdlib.h> #include <unistd.h> #include "pktmux.h" #include "txpkt.h" extern int target_fd; send_pkt_to_target(pkt, pktlen) u_char *pkt; { u_char buf[MAX_PKT_TO_TARGET*2+2]; u_char *cp, *dp, *endp; int c; endp = pkt + pktlen; dp = buf; *dp++ = STX; for (cp = pkt; cp < endp; cp++) { c = *cp; if (c == STX || c == DLE) *dp++ = DLE; *dp++ = c; } *dp++ = STX; write(target_fd, buf, dp - buf); }