2 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
4 * Copyright (c) 2001 Brian Somers <brian@Awfulhak.org>
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31 #include <sys/param.h>
32 #include <netinet/in_systm.h>
33 #include <netinet/in.h>
34 #include <netinet/ip.h>
35 #include <sys/socket.h>
36 #include <net/route.h>
54 #include "throughput.h"
55 #include "slcompress.h"
62 #include "descriptor.h"
84 static u_short default_urgent_tcp_ports[] = {
94 #define NDEFTCPPORTS \
95 (sizeof default_urgent_tcp_ports / sizeof default_urgent_tcp_ports[0])
98 ncp_Init(struct ncp *ncp, struct bundle *bundle)
103 ncp->cfg.urgent.tcp.port = (u_short *)malloc(NDEFTCPPORTS * sizeof(u_short));
104 if (ncp->cfg.urgent.tcp.port == NULL) {
105 log_Printf(LogERROR, "ncp_Init: Out of memory allocating urgent ports\n");
106 ncp->cfg.urgent.tcp.nports = ncp->cfg.urgent.tcp.maxports = 0;
108 ncp->cfg.urgent.tcp.nports = ncp->cfg.urgent.tcp.maxports = NDEFTCPPORTS;
109 memcpy(ncp->cfg.urgent.tcp.port, default_urgent_tcp_ports,
110 NDEFTCPPORTS * sizeof(u_short));
112 ncp->cfg.urgent.tos = 1;
114 ncp->cfg.urgent.udp.nports = ncp->cfg.urgent.udp.maxports = 0;
115 ncp->cfg.urgent.udp.port = NULL;
117 mp_Init(&ncp->mp, bundle);
119 /* Send over the first physical link by default */
120 ipcp_Init(&ncp->ipcp, bundle, &bundle->links->physical->link,
123 ipv6cp_Init(&ncp->ipv6cp, bundle, &bundle->links->physical->link,
129 ncp_Destroy(struct ncp *ncp)
131 ipcp_Destroy(&ncp->ipcp);
133 ipv6cp_Destroy(&ncp->ipv6cp);
136 if (ncp->cfg.urgent.tcp.maxports) {
137 ncp->cfg.urgent.tcp.nports = ncp->cfg.urgent.tcp.maxports = 0;
138 free(ncp->cfg.urgent.tcp.port);
139 ncp->cfg.urgent.tcp.port = NULL;
141 if (ncp->cfg.urgent.udp.maxports) {
142 ncp->cfg.urgent.udp.nports = ncp->cfg.urgent.udp.maxports = 0;
143 free(ncp->cfg.urgent.udp.port);
144 ncp->cfg.urgent.udp.port = NULL;
149 ncp_fsmStart(struct ncp *ncp,
151 struct bundle *bundle __unused
153 struct bundle *bundle
160 if (Enabled(bundle, OPT_IPCP)) {
162 fsm_Up(&ncp->ipcp.fsm);
163 fsm_Open(&ncp->ipcp.fsm);
168 if (Enabled(bundle, OPT_IPV6CP)) {
169 fsm_Up(&ncp->ipv6cp.fsm);
170 fsm_Open(&ncp->ipv6cp.fsm);
179 ncp_IfaceAddrAdded(struct ncp *ncp, const struct iface_addr *addr)
181 switch (ncprange_family(&addr->ifa)) {
183 ipcp_IfaceAddrAdded(&ncp->ipcp, addr);
187 ipv6cp_IfaceAddrAdded(&ncp->ipv6cp, addr);
194 ncp_IfaceAddrDeleted(struct ncp *ncp, const struct iface_addr *addr)
196 if (ncprange_family(&addr->ifa) == AF_INET)
197 ipcp_IfaceAddrDeleted(&ncp->ipcp, addr);
201 ncp_SetLink(struct ncp *ncp, struct link *l)
203 ipcp_SetLink(&ncp->ipcp, l);
205 ipv6cp_SetLink(&ncp->ipv6cp, l);
210 * Enqueue a packet of the given address family. Nothing will make it
211 * down to the physical link level 'till ncp_FillPhysicalQueues() is used.
214 ncp_Enqueue(struct ncp *ncp, int af, unsigned pri, char *ptr, int count)
217 struct ipv6cp *ipv6cp = &ncp->ipv6cp;
219 struct ipcp *ipcp = &ncp->ipcp;
223 * We allocate an extra 6 bytes, four at the front and two at the end.
224 * This is an optimisation so that we need to do less work in
225 * m_prepend() in acf_LayerPush() and proto_LayerPush() and
226 * appending in hdlc_LayerPush().
231 if (pri >= IPCP_QUEUES(ipcp)) {
232 log_Printf(LogERROR, "Can't store in ip queue %u\n", pri);
236 bp = m_get(count + 6, MB_IPOUT);
239 memcpy(MBUF_CTOP(bp), ptr, count);
240 m_enqueue(ipcp->Queue + pri, bp);
245 if (pri >= IPV6CP_QUEUES(ipcp)) {
246 log_Printf(LogERROR, "Can't store in ipv6 queue %u\n", pri);
250 bp = m_get(count + 6, MB_IPOUT);
253 memcpy(MBUF_CTOP(bp), ptr, count);
254 m_enqueue(ipv6cp->Queue + pri, bp);
259 log_Printf(LogERROR, "Can't enqueue protocol family %d\n", af);
264 * How many packets are queued to go out ?
267 ncp_QueueLen(struct ncp *ncp)
271 result = ipcp_QueueLen(&ncp->ipcp);
273 result += ipv6cp_QueueLen(&ncp->ipv6cp);
275 result += mp_QueueLen(&ncp->mp); /* Usually empty */
281 * Ditch all queued packets. This is usually done after our choked timer
282 * has fired - which happens because we couldn't send any traffic over
283 * any links for some time.
286 ncp_DeleteQueues(struct ncp *ncp)
289 struct ipv6cp *ipv6cp = &ncp->ipv6cp;
291 struct ipcp *ipcp = &ncp->ipcp;
292 struct mp *mp = &ncp->mp;
295 for (q = ipcp->Queue; q < ipcp->Queue + IPCP_QUEUES(ipcp); q++)
297 m_freem(m_dequeue(q));
300 for (q = ipv6cp->Queue; q < ipv6cp->Queue + IPV6CP_QUEUES(ipv6cp); q++)
302 m_freem(m_dequeue(q));
305 link_DeleteQueue(&mp->link); /* Usually empty anyway */
309 * Arrange that each of our links has at least one packet. We keep the
310 * number of packets queued at the link level to a minimum so that the
311 * loss of a link in multi-link mode results in the minimum number of
315 ncp_FillPhysicalQueues(struct ncp *ncp, struct bundle *bundle)
319 if (bundle->ncp.mp.active)
320 total = mp_FillPhysicalQueues(bundle);
325 for (total = 0, dl = bundle->links; dl; dl = dl->next)
326 if (dl->state == DATALINK_OPEN) {
327 add = link_QueueLen(&dl->physical->link);
328 if (add == 0 && dl->physical->out == NULL)
329 add = ncp_PushPacket(ncp, &ncp->afq, &dl->physical->link);
334 return total + ncp_QueueLen(&bundle->ncp);
338 * Push a packet into the given link. ``af'' is used as a persistent record
339 * of what is to be pushed next, coming either from mp->out or ncp->afq.
342 ncp_PushPacket(struct ncp *ncp __unused,
350 struct bundle *bundle = l->lcp.fsm.bundle;
354 if (*af == AF_INET) {
355 if ((res = ipcp_PushPacket(&bundle->ncp.ipcp, l)))
358 res = ipv6cp_PushPacket(&bundle->ncp.ipv6cp, l);
360 if ((res = ipv6cp_PushPacket(&bundle->ncp.ipv6cp, l)))
363 res = ipcp_PushPacket(&bundle->ncp.ipcp, l);
366 res = ipcp_PushPacket(&bundle->ncp.ipcp, l);
373 ncp_IsUrgentPort(struct port_range *range, u_short src, u_short dst)
377 for (f = 0; f < range->nports; f++)
378 if (range->port[f] == src || range->port[f] == dst)
385 ncp_AddUrgentPort(struct port_range *range, u_short port)
390 if (range->nports == range->maxports) {
391 range->maxports += 10;
392 newport = (u_short *)realloc(range->port,
393 range->maxports * sizeof(u_short));
394 if (newport == NULL) {
395 log_Printf(LogERROR, "ncp_AddUrgentPort: realloc: %s\n",
397 range->maxports -= 10;
400 range->port = newport;
403 for (p = 0; p < range->nports; p++)
404 if (range->port[p] == port) {
405 log_Printf(LogWARN, "%u: Port already set to urgent\n", port);
407 } else if (range->port[p] > port) {
408 memmove(range->port + p + 1, range->port + p,
409 (range->nports - p) * sizeof(u_short));
410 range->port[p] = port;
415 if (p == range->nports)
416 range->port[range->nports++] = port;
420 ncp_RemoveUrgentPort(struct port_range *range, u_short port)
424 for (p = 0; p < range->nports; p++)
425 if (range->port[p] == port) {
426 if (p + 1 != range->nports)
427 memmove(range->port + p, range->port + p + 1,
428 (range->nports - p - 1) * sizeof(u_short));
433 if (p == range->nports)
434 log_Printf(LogWARN, "%u: Port not set to urgent\n", port);
438 ncp_ClearUrgentPorts(struct port_range *range)
444 ncp_IsUrgentTcpLen(struct ncp *ncp, int len)
446 if (len < ncp->cfg.urgent.len)
453 ncp_SetUrgentTcpLen(struct ncp *ncp, int len)
455 ncp->cfg.urgent.len = len;
459 ncp_Show(struct cmdargs const *arg)
461 struct ncp *ncp = &arg->bundle->ncp;
465 prompt_Printf(arg->prompt, "Next queued AF: %s\n",
466 ncp->afq == AF_INET6 ? "inet6" : "inet");
470 prompt_Printf(arg->prompt, "\n");
471 route_ShowSticky(arg->prompt, ncp->route, "Sticky routes", 1);
474 prompt_Printf(arg->prompt, "\nDefaults:\n");
475 prompt_Printf(arg->prompt, " sendpipe: ");
476 if (ncp->cfg.sendpipe > 0)
477 prompt_Printf(arg->prompt, "%-20ld\n", ncp->cfg.sendpipe);
479 prompt_Printf(arg->prompt, "unspecified\n");
480 prompt_Printf(arg->prompt, " recvpipe: ");
481 if (ncp->cfg.recvpipe > 0)
482 prompt_Printf(arg->prompt, "%ld\n", ncp->cfg.recvpipe);
484 prompt_Printf(arg->prompt, "unspecified\n");
486 prompt_Printf(arg->prompt, "\n Urgent ports\n");
487 prompt_Printf(arg->prompt, " TCP: ");
488 if (ncp->cfg.urgent.tcp.nports == 0)
489 prompt_Printf(arg->prompt, "none");
491 for (p = 0; p < ncp->cfg.urgent.tcp.nports; p++) {
493 prompt_Printf(arg->prompt, ", ");
494 prompt_Printf(arg->prompt, "%u", ncp->cfg.urgent.tcp.port[p]);
497 prompt_Printf(arg->prompt, "\n UDP: ");
498 if (ncp->cfg.urgent.udp.nports == 0)
499 prompt_Printf(arg->prompt, "none");
501 for (p = 0; p < ncp->cfg.urgent.udp.nports; p++) {
503 prompt_Printf(arg->prompt, ", ");
504 prompt_Printf(arg->prompt, "%u", ncp->cfg.urgent.udp.port[p]);
506 prompt_Printf(arg->prompt, "\n TOS: %s\n\n",
507 ncp->cfg.urgent.tos ? "yes" : "no");
513 ncp_LayersOpen(struct ncp *ncp)
517 n = !!(ncp->ipcp.fsm.state == ST_OPENED);
519 n += !!(ncp->ipv6cp.fsm.state == ST_OPENED);
526 ncp_LayersUnfinished(struct ncp *ncp)
530 if (ncp->ipcp.fsm.state > ST_CLOSED ||
531 ncp->ipcp.fsm.state == ST_STARTING)
535 if (ncp->ipv6cp.fsm.state > ST_CLOSED ||
536 ncp->ipv6cp.fsm.state == ST_STARTING)
544 ncp_Close(struct ncp *ncp)
546 if (ncp->ipcp.fsm.state > ST_CLOSED ||
547 ncp->ipcp.fsm.state == ST_STARTING)
548 fsm_Close(&ncp->ipcp.fsm);
551 if (ncp->ipv6cp.fsm.state > ST_CLOSED ||
552 ncp->ipv6cp.fsm.state == ST_STARTING)
553 fsm_Close(&ncp->ipv6cp.fsm);
558 ncp2initial(struct ncp *ncp)
560 fsm2initial(&ncp->ipcp.fsm);
562 fsm2initial(&ncp->ipv6cp.fsm);