FreeCalypso > hg > freecalypso-sw
view rvinterf/old/packettx.c @ 441:b23743555ca8
OSL: os_sem_fl.c started
author | Michael Spacefalcon <msokolov@ivan.Harhan.ORG> |
---|---|
date | Mon, 23 Jun 2014 00:23:49 +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); }