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 * 266d666775SBrian Somers * $Id: link.c,v 1.1.2.8 1998/02/23 00:38:33 brian Exp $ 278c07a7b2SBrian Somers * 288c07a7b2SBrian Somers */ 298c07a7b2SBrian Somers 308c07a7b2SBrian Somers #include <sys/param.h> 318c07a7b2SBrian Somers #include <netinet/in.h> 328c07a7b2SBrian Somers 338c07a7b2SBrian Somers #include <stdio.h> 3485b542cfSBrian Somers #include <termios.h> 358c07a7b2SBrian Somers 368c07a7b2SBrian Somers #include "command.h" 378c07a7b2SBrian Somers #include "mbuf.h" 388c07a7b2SBrian Somers #include "log.h" 398c07a7b2SBrian Somers #include "defs.h" 408c07a7b2SBrian Somers #include "timer.h" 4163258dccSBrian Somers #include "hdlc.h" 428c07a7b2SBrian Somers #include "throughput.h" 438c07a7b2SBrian Somers #include "lcpproto.h" 448c07a7b2SBrian Somers #include "loadalias.h" 458c07a7b2SBrian Somers #include "vars.h" 468c07a7b2SBrian Somers #include "link.h" 476d666775SBrian Somers #include "fsm.h" 48455aabc3SBrian Somers #include "bundle.h" 4985b542cfSBrian Somers #include "descriptor.h" 5085b542cfSBrian Somers #include "prompt.h" 518c07a7b2SBrian Somers 528c07a7b2SBrian Somers void 538c07a7b2SBrian Somers link_AddInOctets(struct link *l, int n) 548c07a7b2SBrian Somers { 558c07a7b2SBrian Somers throughput_addin(&l->throughput, n); 568c07a7b2SBrian Somers } 578c07a7b2SBrian Somers 588c07a7b2SBrian Somers void 598c07a7b2SBrian Somers link_AddOutOctets(struct link *l, int n) 608c07a7b2SBrian Somers { 618c07a7b2SBrian Somers throughput_addout(&l->throughput, n); 628c07a7b2SBrian Somers } 638c07a7b2SBrian Somers 648c07a7b2SBrian Somers void 658c07a7b2SBrian Somers link_SequenceQueue(struct link *l) 668c07a7b2SBrian Somers { 678c07a7b2SBrian Somers LogPrintf(LogDEBUG, "link_SequenceQueue\n"); 688c07a7b2SBrian Somers while (l->Queue[PRI_NORMAL].qlen) 698c07a7b2SBrian Somers Enqueue(l->Queue + PRI_LINK, Dequeue(l->Queue + PRI_NORMAL)); 708c07a7b2SBrian Somers } 718c07a7b2SBrian Somers 728c07a7b2SBrian Somers int 738c07a7b2SBrian Somers link_QueueLen(struct link *l) 748c07a7b2SBrian Somers { 758c07a7b2SBrian Somers int i, len; 768c07a7b2SBrian Somers 778c07a7b2SBrian Somers for (i = 0, len = 0; i < LINK_QUEUES; i++) 788c07a7b2SBrian Somers len += l->Queue[i].qlen; 798c07a7b2SBrian Somers 808c07a7b2SBrian Somers return len; 818c07a7b2SBrian Somers } 828c07a7b2SBrian Somers 838c07a7b2SBrian Somers struct mbuf * 848c07a7b2SBrian Somers link_Dequeue(struct link *l) 858c07a7b2SBrian Somers { 868c07a7b2SBrian Somers int pri; 878c07a7b2SBrian Somers struct mbuf *bp; 888c07a7b2SBrian Somers 898c07a7b2SBrian Somers for (bp = (struct mbuf *)0, pri = LINK_QUEUES - 1; pri >= 0; pri--) 908c07a7b2SBrian Somers if (l->Queue[pri].qlen) { 918c07a7b2SBrian Somers bp = Dequeue(l->Queue + pri); 922289f246SBrian Somers LogPrintf(LogDEBUG, "link_Dequeue: Dequeued from queue %d," 932289f246SBrian Somers " containing %d more packets\n", pri, l->Queue[pri].qlen); 948c07a7b2SBrian Somers break; 958c07a7b2SBrian Somers } 968c07a7b2SBrian Somers 978c07a7b2SBrian Somers return bp; 988c07a7b2SBrian Somers } 998c07a7b2SBrian Somers 1008c07a7b2SBrian Somers /* 1018c07a7b2SBrian Somers * Write to the link. Actualy, requested packets are queued, and go out 1028c07a7b2SBrian Somers * at some later time depending on the physical link implementation. 1038c07a7b2SBrian Somers */ 1048c07a7b2SBrian Somers void 1058c07a7b2SBrian Somers link_Write(struct link *l, int pri, const char *ptr, int count) 1068c07a7b2SBrian Somers { 1078c07a7b2SBrian Somers struct mbuf *bp; 1088c07a7b2SBrian Somers 1098c07a7b2SBrian Somers if(pri < 0 || pri >= LINK_QUEUES) 1108c07a7b2SBrian Somers pri = 0; 1118c07a7b2SBrian Somers 1128c07a7b2SBrian Somers bp = mballoc(count, MB_LINK); 1138c07a7b2SBrian Somers memcpy(MBUF_CTOP(bp), ptr, count); 1148c07a7b2SBrian Somers 1158c07a7b2SBrian Somers Enqueue(l->Queue + pri, bp); 1168c07a7b2SBrian Somers } 1178c07a7b2SBrian Somers 1188c07a7b2SBrian Somers void 119f4768038SBrian Somers link_StartOutput(struct link *l, struct bundle *bundle) 1208c07a7b2SBrian Somers { 121f4768038SBrian Somers (*l->StartOutput)(l, bundle); 1228c07a7b2SBrian Somers } 1238c07a7b2SBrian Somers 1248c07a7b2SBrian Somers void 1258c07a7b2SBrian Somers link_Output(struct link *l, int pri, struct mbuf *bp) 1268c07a7b2SBrian Somers { 1278c07a7b2SBrian Somers struct mbuf *wp; 1288c07a7b2SBrian Somers int len; 1298c07a7b2SBrian Somers 1308c07a7b2SBrian Somers if(pri < 0 || pri >= LINK_QUEUES) 1318c07a7b2SBrian Somers pri = 0; 1328c07a7b2SBrian Somers 1338c07a7b2SBrian Somers len = plength(bp); 1348c07a7b2SBrian Somers wp = mballoc(len, MB_LINK); 1358c07a7b2SBrian Somers mbread(bp, MBUF_CTOP(wp), len); 1368c07a7b2SBrian Somers Enqueue(l->Queue + pri, wp); 1378c07a7b2SBrian Somers } 1388c07a7b2SBrian Somers 1398c07a7b2SBrian Somers int 1408c07a7b2SBrian Somers link_IsActive(struct link *l) 1418c07a7b2SBrian Somers { 1428c07a7b2SBrian Somers return (*l->IsActive)(l); 1438c07a7b2SBrian Somers } 1448c07a7b2SBrian Somers 1458c07a7b2SBrian Somers void 1463006ec67SBrian Somers link_Close(struct link *l, struct bundle *bundle, int dedicated_force, int stay) 1478c07a7b2SBrian Somers { 1488c07a7b2SBrian Somers (*l->Close)(l, dedicated_force); 1493006ec67SBrian Somers bundle_LinkLost(bundle, l, stay); 1508c07a7b2SBrian Somers } 1518c07a7b2SBrian Somers 1526f1bc4e5SBrian Somers void 1536f1bc4e5SBrian Somers link_Destroy(struct link *l) 1546f1bc4e5SBrian Somers { 1556f1bc4e5SBrian Somers (*l->Destroy)(l); 1566f1bc4e5SBrian Somers } 1576f1bc4e5SBrian Somers 1588c07a7b2SBrian Somers static struct protostatheader { 1598c07a7b2SBrian Somers u_short number; 1608c07a7b2SBrian Somers const char *name; 1618c07a7b2SBrian Somers } ProtocolStat[NPROTOSTAT] = { 1628c07a7b2SBrian Somers { PROTO_IP, "IP" }, 1638c07a7b2SBrian Somers { PROTO_VJUNCOMP, "VJ_UNCOMP" }, 1648c07a7b2SBrian Somers { PROTO_VJCOMP, "VJ_COMP" }, 1658c07a7b2SBrian Somers { PROTO_COMPD, "COMPD" }, 1668c07a7b2SBrian Somers { PROTO_LCP, "LCP" }, 1678c07a7b2SBrian Somers { PROTO_IPCP, "IPCP" }, 1688c07a7b2SBrian Somers { PROTO_CCP, "CCP" }, 1698c07a7b2SBrian Somers { PROTO_PAP, "PAP" }, 1708c07a7b2SBrian Somers { PROTO_LQR, "LQR" }, 1718c07a7b2SBrian Somers { PROTO_CHAP, "CHAP" }, 1728c07a7b2SBrian Somers { 0, "Others" } 1738c07a7b2SBrian Somers }; 1748c07a7b2SBrian Somers 1758c07a7b2SBrian Somers void 1768c07a7b2SBrian Somers link_ProtocolRecord(struct link *l, u_short proto, int type) 1778c07a7b2SBrian Somers { 1788c07a7b2SBrian Somers int i; 1798c07a7b2SBrian Somers 1808c07a7b2SBrian Somers for (i = 0; i < NPROTOSTAT; i++) 1818c07a7b2SBrian Somers if (ProtocolStat[i].number == proto) 1828c07a7b2SBrian Somers break; 1838c07a7b2SBrian Somers 1848c07a7b2SBrian Somers if (type == PROTO_IN) 1858c07a7b2SBrian Somers l->proto_in[i]++; 1868c07a7b2SBrian Somers else 1878c07a7b2SBrian Somers l->proto_out[i]++; 1888c07a7b2SBrian Somers } 1898c07a7b2SBrian Somers 1908c07a7b2SBrian Somers void 1918c07a7b2SBrian Somers link_ReportProtocolStatus(struct link *l) 1928c07a7b2SBrian Somers { 1938c07a7b2SBrian Somers int i; 1948c07a7b2SBrian Somers 19585b542cfSBrian Somers prompt_Printf(&prompt, " Protocol in out " 19685b542cfSBrian Somers "Protocol in out\n"); 1978c07a7b2SBrian Somers for (i = 0; i < NPROTOSTAT; i++) { 19885b542cfSBrian Somers prompt_Printf(&prompt, " %-9s: %8lu, %8lu", 1998c07a7b2SBrian Somers ProtocolStat[i].name, l->proto_in[i], l->proto_out[i]); 2008c07a7b2SBrian Somers if ((i % 2) == 0) 20185b542cfSBrian Somers prompt_Printf(&prompt, "\n"); 2028c07a7b2SBrian Somers } 2038c07a7b2SBrian Somers if (i % 2) 20485b542cfSBrian Somers prompt_Printf(&prompt, "\n"); 2058c07a7b2SBrian Somers } 206