18c07a7b2SBrian Somers /*- 28c07a7b2SBrian Somers * Copyright (c) 1998 Brian Somers <brian@Awfulhak.org> 38c07a7b2SBrian Somers * All rights reserved. 48c07a7b2SBrian Somers * 58c07a7b2SBrian Somers * Redistribution and use in source and binary forms, with or without 68c07a7b2SBrian Somers * modification, are permitted provided that the following conditions 78c07a7b2SBrian Somers * are met: 88c07a7b2SBrian Somers * 1. Redistributions of source code must retain the above copyright 98c07a7b2SBrian Somers * notice, this list of conditions and the following disclaimer. 108c07a7b2SBrian Somers * 2. Redistributions in binary form must reproduce the above copyright 118c07a7b2SBrian Somers * notice, this list of conditions and the following disclaimer in the 128c07a7b2SBrian Somers * documentation and/or other materials provided with the distribution. 138c07a7b2SBrian Somers * 148c07a7b2SBrian Somers * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 158c07a7b2SBrian Somers * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 168c07a7b2SBrian Somers * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 178c07a7b2SBrian Somers * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 188c07a7b2SBrian Somers * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 198c07a7b2SBrian Somers * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 208c07a7b2SBrian Somers * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 218c07a7b2SBrian Somers * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 228c07a7b2SBrian Somers * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 238c07a7b2SBrian Somers * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 248c07a7b2SBrian Somers * SUCH DAMAGE. 258c07a7b2SBrian Somers * 26eb2d27cfSBrian Somers * $Id: link.c,v 1.7 1999/02/06 02:54:46 brian Exp $ 278c07a7b2SBrian Somers * 288c07a7b2SBrian Somers */ 298c07a7b2SBrian Somers 302764b86aSBrian Somers #include <sys/types.h> 318c07a7b2SBrian Somers 328c07a7b2SBrian Somers #include <stdio.h> 33eb2d27cfSBrian Somers #include <string.h> 3485b542cfSBrian Somers #include <termios.h> 358c07a7b2SBrian Somers 3692b09558SBrian Somers #include "defs.h" 378c07a7b2SBrian Somers #include "mbuf.h" 388c07a7b2SBrian Somers #include "log.h" 398c07a7b2SBrian Somers #include "timer.h" 40879ed6faSBrian Somers #include "lqr.h" 4163258dccSBrian Somers #include "hdlc.h" 428c07a7b2SBrian Somers #include "throughput.h" 438c07a7b2SBrian Somers #include "lcpproto.h" 446d666775SBrian Somers #include "fsm.h" 4585b542cfSBrian Somers #include "descriptor.h" 463b0f8d2eSBrian Somers #include "lcp.h" 473b0f8d2eSBrian Somers #include "ccp.h" 483b0f8d2eSBrian Somers #include "link.h" 4985b542cfSBrian Somers #include "prompt.h" 508c07a7b2SBrian Somers 518c07a7b2SBrian Somers void 528c07a7b2SBrian Somers link_AddInOctets(struct link *l, int n) 538c07a7b2SBrian Somers { 548c07a7b2SBrian Somers throughput_addin(&l->throughput, n); 558c07a7b2SBrian Somers } 568c07a7b2SBrian Somers 578c07a7b2SBrian Somers void 588c07a7b2SBrian Somers link_AddOutOctets(struct link *l, int n) 598c07a7b2SBrian Somers { 608c07a7b2SBrian Somers throughput_addout(&l->throughput, n); 618c07a7b2SBrian Somers } 628c07a7b2SBrian Somers 638c07a7b2SBrian Somers void 648c07a7b2SBrian Somers link_SequenceQueue(struct link *l) 658c07a7b2SBrian Somers { 66dd7e2610SBrian Somers log_Printf(LogDEBUG, "link_SequenceQueue\n"); 678c07a7b2SBrian Somers while (l->Queue[PRI_NORMAL].qlen) 68dd7e2610SBrian Somers mbuf_Enqueue(l->Queue + PRI_LINK, mbuf_Dequeue(l->Queue + PRI_NORMAL)); 698c07a7b2SBrian Somers } 708c07a7b2SBrian Somers 716f8e9f0aSBrian Somers void 726f8e9f0aSBrian Somers link_DeleteQueue(struct link *l) 736f8e9f0aSBrian Somers { 746f8e9f0aSBrian Somers struct mqueue *queue; 756f8e9f0aSBrian Somers 766f8e9f0aSBrian Somers for (queue = l->Queue; queue < l->Queue + LINK_QUEUES; queue++) 776f8e9f0aSBrian Somers while (queue->top) 786f8e9f0aSBrian Somers mbuf_Free(mbuf_Dequeue(queue)); 796f8e9f0aSBrian Somers } 806f8e9f0aSBrian Somers 818c07a7b2SBrian Somers int 828c07a7b2SBrian Somers link_QueueLen(struct link *l) 838c07a7b2SBrian Somers { 848c07a7b2SBrian Somers int i, len; 858c07a7b2SBrian Somers 868c07a7b2SBrian Somers for (i = 0, len = 0; i < LINK_QUEUES; i++) 878c07a7b2SBrian Somers len += l->Queue[i].qlen; 888c07a7b2SBrian Somers 898c07a7b2SBrian Somers return len; 908c07a7b2SBrian Somers } 918c07a7b2SBrian Somers 923b0f8d2eSBrian Somers int 933b0f8d2eSBrian Somers link_QueueBytes(struct link *l) 943b0f8d2eSBrian Somers { 953b0f8d2eSBrian Somers int i, len, bytes; 963b0f8d2eSBrian Somers struct mbuf *m; 973b0f8d2eSBrian Somers 983b0f8d2eSBrian Somers bytes = 0; 993b0f8d2eSBrian Somers for (i = 0, len = 0; i < LINK_QUEUES; i++) { 1003b0f8d2eSBrian Somers len = l->Queue[i].qlen; 1013b0f8d2eSBrian Somers m = l->Queue[i].top; 1023b0f8d2eSBrian Somers while (len--) { 103dd7e2610SBrian Somers bytes += mbuf_Length(m); 1043b0f8d2eSBrian Somers m = m->pnext; 1053b0f8d2eSBrian Somers } 1063b0f8d2eSBrian Somers } 1073b0f8d2eSBrian Somers 1083b0f8d2eSBrian Somers return bytes; 1093b0f8d2eSBrian Somers } 1103b0f8d2eSBrian Somers 1118c07a7b2SBrian Somers struct mbuf * 1128c07a7b2SBrian Somers link_Dequeue(struct link *l) 1138c07a7b2SBrian Somers { 1148c07a7b2SBrian Somers int pri; 1158c07a7b2SBrian Somers struct mbuf *bp; 1168c07a7b2SBrian Somers 1178c07a7b2SBrian Somers for (bp = (struct mbuf *)0, pri = LINK_QUEUES - 1; pri >= 0; pri--) 1188c07a7b2SBrian Somers if (l->Queue[pri].qlen) { 119dd7e2610SBrian Somers bp = mbuf_Dequeue(l->Queue + pri); 120dd7e2610SBrian Somers log_Printf(LogDEBUG, "link_Dequeue: Dequeued from queue %d," 1212289f246SBrian Somers " containing %d more packets\n", pri, l->Queue[pri].qlen); 1228c07a7b2SBrian Somers break; 1238c07a7b2SBrian Somers } 1248c07a7b2SBrian Somers 1258c07a7b2SBrian Somers return bp; 1268c07a7b2SBrian Somers } 1278c07a7b2SBrian Somers 1288c07a7b2SBrian Somers /* 1298c07a7b2SBrian Somers * Write to the link. Actualy, requested packets are queued, and go out 1308c07a7b2SBrian Somers * at some later time depending on the physical link implementation. 1318c07a7b2SBrian Somers */ 1328c07a7b2SBrian Somers void 1338c07a7b2SBrian Somers link_Write(struct link *l, int pri, const char *ptr, int count) 1348c07a7b2SBrian Somers { 1358c07a7b2SBrian Somers struct mbuf *bp; 1368c07a7b2SBrian Somers 1378c07a7b2SBrian Somers if(pri < 0 || pri >= LINK_QUEUES) 1388c07a7b2SBrian Somers pri = 0; 1398c07a7b2SBrian Somers 140dd7e2610SBrian Somers bp = mbuf_Alloc(count, MB_LINK); 1418c07a7b2SBrian Somers memcpy(MBUF_CTOP(bp), ptr, count); 1428c07a7b2SBrian Somers 143dd7e2610SBrian Somers mbuf_Enqueue(l->Queue + pri, bp); 1448c07a7b2SBrian Somers } 1458c07a7b2SBrian Somers 1468c07a7b2SBrian Somers void 1478c07a7b2SBrian Somers link_Output(struct link *l, int pri, struct mbuf *bp) 1488c07a7b2SBrian Somers { 1498c07a7b2SBrian Somers struct mbuf *wp; 1508c07a7b2SBrian Somers int len; 1518c07a7b2SBrian Somers 1528c07a7b2SBrian Somers if(pri < 0 || pri >= LINK_QUEUES) 1538c07a7b2SBrian Somers pri = 0; 1548c07a7b2SBrian Somers 155dd7e2610SBrian Somers len = mbuf_Length(bp); 156dd7e2610SBrian Somers wp = mbuf_Alloc(len, MB_LINK); 157dd7e2610SBrian Somers mbuf_Read(bp, MBUF_CTOP(wp), len); 158dd7e2610SBrian Somers mbuf_Enqueue(l->Queue + pri, wp); 1598c07a7b2SBrian Somers } 1608c07a7b2SBrian Somers 1618c07a7b2SBrian Somers static struct protostatheader { 1628c07a7b2SBrian Somers u_short number; 1638c07a7b2SBrian Somers const char *name; 1648c07a7b2SBrian Somers } ProtocolStat[NPROTOSTAT] = { 1658c07a7b2SBrian Somers { PROTO_IP, "IP" }, 1668c07a7b2SBrian Somers { PROTO_VJUNCOMP, "VJ_UNCOMP" }, 1678c07a7b2SBrian Somers { PROTO_VJCOMP, "VJ_COMP" }, 1688c07a7b2SBrian Somers { PROTO_COMPD, "COMPD" }, 169ed32233cSBrian Somers { PROTO_ICOMPD, "ICOMPD" }, 1708c07a7b2SBrian Somers { PROTO_LCP, "LCP" }, 1718c07a7b2SBrian Somers { PROTO_IPCP, "IPCP" }, 1728c07a7b2SBrian Somers { PROTO_CCP, "CCP" }, 1738c07a7b2SBrian Somers { PROTO_PAP, "PAP" }, 1748c07a7b2SBrian Somers { PROTO_LQR, "LQR" }, 1758c07a7b2SBrian Somers { PROTO_CHAP, "CHAP" }, 1763b0f8d2eSBrian Somers { PROTO_MP, "MULTILINK" }, 1778c07a7b2SBrian Somers { 0, "Others" } 1788c07a7b2SBrian Somers }; 1798c07a7b2SBrian Somers 1808c07a7b2SBrian Somers void 1818c07a7b2SBrian Somers link_ProtocolRecord(struct link *l, u_short proto, int type) 1828c07a7b2SBrian Somers { 1838c07a7b2SBrian Somers int i; 1848c07a7b2SBrian Somers 1858c07a7b2SBrian Somers for (i = 0; i < NPROTOSTAT; i++) 1868c07a7b2SBrian Somers if (ProtocolStat[i].number == proto) 1878c07a7b2SBrian Somers break; 1888c07a7b2SBrian Somers 1898c07a7b2SBrian Somers if (type == PROTO_IN) 1908c07a7b2SBrian Somers l->proto_in[i]++; 1918c07a7b2SBrian Somers else 1928c07a7b2SBrian Somers l->proto_out[i]++; 1938c07a7b2SBrian Somers } 1948c07a7b2SBrian Somers 1958c07a7b2SBrian Somers void 196b6217683SBrian Somers link_ReportProtocolStatus(struct link *l, struct prompt *prompt) 1978c07a7b2SBrian Somers { 1988c07a7b2SBrian Somers int i; 1998c07a7b2SBrian Somers 200b6217683SBrian Somers prompt_Printf(prompt, " Protocol in out " 20185b542cfSBrian Somers "Protocol in out\n"); 2028c07a7b2SBrian Somers for (i = 0; i < NPROTOSTAT; i++) { 203b6217683SBrian Somers prompt_Printf(prompt, " %-9s: %8lu, %8lu", 2048c07a7b2SBrian Somers ProtocolStat[i].name, l->proto_in[i], l->proto_out[i]); 2058c07a7b2SBrian Somers if ((i % 2) == 0) 206b6217683SBrian Somers prompt_Printf(prompt, "\n"); 2078c07a7b2SBrian Somers } 2083b0f8d2eSBrian Somers if (!(i % 2)) 209b6217683SBrian Somers prompt_Printf(prompt, "\n"); 2108c07a7b2SBrian Somers } 211