FreeCalypso > hg > freecalypso-sw
view rvinterf/old/packettx.c @ 582:81753f5e902e
tpudrv12.c: l1dmacro_RF_sleep() and l1dmacro_RF_wakeup() done
author | Michael Spacefalcon <msokolov@ivan.Harhan.ORG> |
---|---|
date | Fri, 15 Aug 2014 19:25:58 +0000 |
parents | f42854da4563 |
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); }