]> git.ozlabs.org Git - ppp.git/blob - pppd/multilink.c
7444162e66eef0dc3d43c52f78569ef013ce59cd
[ppp.git] / pppd / multilink.c
1 /*
2  * multilink.c - support routines for multilink.
3  *
4  * Copyright (c) 2000-2002 Paul Mackerras. All rights reserved.
5  *
6  * Redistribution and use in source and binary forms, with or without
7  * modification, are permitted provided that the following conditions
8  * are met:
9  *
10  * 1. Redistributions of source code must retain the above copyright
11  *    notice, this list of conditions and the following disclaimer.
12  *
13  * 2. The name(s) of the authors of this software must not be used to
14  *    endorse or promote products derived from this software without
15  *    prior written permission.
16  *
17  * 3. Redistributions of any form whatsoever must retain the following
18  *    acknowledgment:
19  *    "This product includes software developed by Paul Mackerras
20  *     <paulus@samba.org>".
21  *
22  * THE AUTHORS OF THIS SOFTWARE DISCLAIM ALL WARRANTIES WITH REGARD TO
23  * THIS SOFTWARE, INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY
24  * AND FITNESS, IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY
25  * SPECIAL, INDIRECT OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
26  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN
27  * AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING
28  * OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
29  */
30 #include <string.h>
31 #include <ctype.h>
32 #include <stdlib.h>
33 #include <netdb.h>
34 #include <errno.h>
35 #include <signal.h>
36 #include <netinet/in.h>
37 #include <unistd.h>
38
39 #include "pppd.h"
40 #include "fsm.h"
41 #include "lcp.h"
42 #include "tdb.h"
43
44 bool endpoint_specified;        /* user gave explicit endpoint discriminator */
45 char *bundle_id;                /* identifier for our bundle */
46 char *blinks_id;                /* key for the list of links */
47 bool doing_multilink;           /* multilink was enabled and agreed to */
48 bool multilink_master;          /* we own the multilink bundle */
49
50 extern TDB_CONTEXT *pppdb;
51 extern char db_key[];
52
53 static void make_bundle_links __P((int append));
54 static void remove_bundle_link __P((void));
55 static void iterate_bundle_links __P((void (*func) __P((char *))));
56
57 static int get_default_epdisc __P((struct epdisc *));
58 static int parse_num __P((char *str, const char *key, int *valp));
59 static int owns_unit __P((TDB_DATA pid, int unit));
60
61 #define set_ip_epdisc(ep, addr) do {    \
62         ep->length = 4;                 \
63         ep->value[0] = addr >> 24;      \
64         ep->value[1] = addr >> 16;      \
65         ep->value[2] = addr >> 8;       \
66         ep->value[3] = addr;            \
67 } while (0)
68
69 #define LOCAL_IP_ADDR(addr)                                               \
70         (((addr) & 0xff000000) == 0x0a000000            /* 10.x.x.x */    \
71          || ((addr) & 0xfff00000) == 0xac100000         /* 172.16.x.x */  \
72          || ((addr) & 0xffff0000) == 0xc0a80000)        /* 192.168.x.x */
73
74 #define process_exists(n)       (kill((n), 0) == 0 || errno != ESRCH)
75
76 void
77 mp_check_options()
78 {
79         lcp_options *wo = &lcp_wantoptions[0];
80         lcp_options *ao = &lcp_allowoptions[0];
81
82         doing_multilink = 0;
83         if (!multilink)
84                 return;
85         /* if we're doing multilink, we have to negotiate MRRU */
86         if (!wo->neg_mrru) {
87                 /* mrru not specified, default to mru */
88                 wo->mrru = wo->mru;
89                 wo->neg_mrru = 1;
90         }
91         ao->mrru = ao->mru;
92         ao->neg_mrru = 1;
93
94         if (!wo->neg_endpoint && !noendpoint) {
95                 /* get a default endpoint value */
96                 wo->neg_endpoint = get_default_epdisc(&wo->endpoint);
97         }
98 }
99
100 /*
101  * Make a new bundle or join us to an existing bundle
102  * if we are doing multilink.
103  */
104 int
105 mp_join_bundle()
106 {
107         lcp_options *go = &lcp_gotoptions[0];
108         lcp_options *ho = &lcp_hisoptions[0];
109         lcp_options *ao = &lcp_allowoptions[0];
110         int unit, pppd_pid;
111         int l, mtu;
112         char *p;
113         TDB_DATA key, pid, rec;
114
115         if (doing_multilink) {
116                 /* have previously joined a bundle */
117                 if (!go->neg_mrru || !ho->neg_mrru) {
118                         notice("oops, didn't get multilink on renegotiation");
119                         lcp_close(0, "multilink required");
120                         return 0;
121                 }
122                 /* XXX should check the peer_authname and ho->endpoint
123                    are the same as previously */
124                 return 0;
125         }
126
127         if (!go->neg_mrru || !ho->neg_mrru) {
128                 /* not doing multilink */
129                 if (go->neg_mrru)
130                         notice("oops, multilink negotiated only for receive");
131                 mtu = ho->neg_mru? ho->mru: PPP_MRU;
132                 if (mtu > ao->mru)
133                         mtu = ao->mru;
134                 if (demand) {
135                         /* already have a bundle */
136                         cfg_bundle(0, 0, 0, 0);
137                         netif_set_mtu(0, mtu);
138                         return 0;
139                 }
140                 make_new_bundle(0, 0, 0, 0);
141                 set_ifunit(1);
142                 netif_set_mtu(0, mtu);
143                 return 0;
144         }
145
146         doing_multilink = 1;
147
148         /*
149          * Find the appropriate bundle or join a new one.
150          * First we make up a name for the bundle.
151          * The length estimate is worst-case assuming every
152          * character has to be quoted.
153          */
154         l = 4 * strlen(peer_authname) + 10;
155         if (ho->neg_endpoint)
156                 l += 3 * ho->endpoint.length + 8;
157         if (bundle_name)
158                 l += 3 * strlen(bundle_name) + 2;
159         bundle_id = malloc(l);
160         if (bundle_id == 0)
161                 novm("bundle identifier");
162
163         p = bundle_id;
164         p += slprintf(p, l-1, "BUNDLE=\"%q\"", peer_authname);
165         if (ho->neg_endpoint || bundle_name)
166                 *p++ = '/';
167         if (ho->neg_endpoint)
168                 p += slprintf(p, bundle_id+l-p, "%s",
169                               epdisc_to_str(&ho->endpoint));
170         if (bundle_name)
171                 p += slprintf(p, bundle_id+l-p, "/%v", bundle_name);
172
173         /* Make the key for the list of links belonging to the bundle */
174         l = p - bundle_id;
175         blinks_id = malloc(l + 7);
176         if (blinks_id == NULL)
177                 novm("bundle links key");
178         slprintf(blinks_id, l + 7, "BUNDLE_LINKS=%s", bundle_id + 7);
179
180         /*
181          * For demand mode, we only need to configure the bundle
182          * and attach the link.
183          */
184         mtu = MIN(ho->mrru, ao->mru);
185         if (demand) {
186                 cfg_bundle(go->mrru, ho->mrru, go->neg_ssnhf, ho->neg_ssnhf);
187                 netif_set_mtu(0, mtu);
188                 script_setenv("BUNDLE", bundle_id + 7, 1);
189                 return 0;
190         }
191
192         /*
193          * Check if the bundle ID is already in the database.
194          */
195         unit = -1;
196         tdb_writelock(pppdb);
197         key.dptr = bundle_id;
198         key.dsize = p - bundle_id;
199         pid = tdb_fetch(pppdb, key);
200         if (pid.dptr != NULL) {
201                 /* bundle ID exists, see if the pppd record exists */
202                 rec = tdb_fetch(pppdb, pid);
203                 if (rec.dptr != NULL && rec.dsize > 0) {
204                         /* make sure the string is null-terminated */
205                         rec.dptr[rec.dsize-1] = 0;
206                         /* parse the interface number */
207                         parse_num(rec.dptr, "IFNAME=ppp", &unit);
208                         /* check the pid value */
209                         if (!parse_num(rec.dptr, "PPPD_PID=", &pppd_pid)
210                             || !process_exists(pppd_pid)
211                             || !owns_unit(pid, unit))
212                                 unit = -1;
213                         free(rec.dptr);
214                 }
215                 free(pid.dptr);
216         }
217
218         if (unit >= 0) {
219                 /* attach to existing unit */
220                 if (bundle_attach(unit)) {
221                         set_ifunit(0);
222                         script_setenv("BUNDLE", bundle_id + 7, 0);
223                         make_bundle_links(1);
224                         tdb_writeunlock(pppdb);
225                         info("Link attached to %s", ifname);
226                         return 1;
227                 }
228                 /* attach failed because bundle doesn't exist */
229         }
230
231         /* we have to make a new bundle */
232         make_new_bundle(go->mrru, ho->mrru, go->neg_ssnhf, ho->neg_ssnhf);
233         set_ifunit(1);
234         netif_set_mtu(0, mtu);
235         script_setenv("BUNDLE", bundle_id + 7, 1);
236         make_bundle_links(0);
237         tdb_writeunlock(pppdb);
238         info("New bundle %s created", ifname);
239         multilink_master = 1;
240         return 0;
241 }
242
243 void mp_exit_bundle()
244 {
245         tdb_writelock(pppdb);
246         remove_bundle_link();
247         tdb_writeunlock(pppdb);
248 }
249
250 static void sendhup(char *str)
251 {
252         int pid;
253
254         if (parse_num(str, "PPPD_PID=", &pid) && pid != getpid()) {
255                 if (debug)
256                         dbglog("sending SIGHUP to process %d", pid);
257                 kill(pid, SIGHUP);
258         }
259 }
260
261 void mp_bundle_terminated()
262 {
263         TDB_DATA key;
264
265         bundle_terminating = 1;
266         upper_layers_down(0);
267         notice("Connection terminated.");
268         print_link_stats();
269         if (!demand) {
270                 remove_pidfiles();
271                 script_unsetenv("IFNAME");
272         }
273
274         tdb_writelock(pppdb);
275         destroy_bundle();
276         iterate_bundle_links(sendhup);
277         key.dptr = blinks_id;
278         key.dsize = strlen(blinks_id);
279         tdb_delete(pppdb, key);
280         tdb_writeunlock(pppdb);
281         
282 new_phase(PHASE_DEAD);
283 }
284
285 static void make_bundle_links(int append)
286 {
287         TDB_DATA key, rec;
288         char *p;
289         char entry[32];
290         int l;
291
292         key.dptr = blinks_id;
293         key.dsize = strlen(blinks_id);
294         slprintf(entry, sizeof(entry), "%s;", db_key);
295         p = entry;
296         if (append) {
297                 rec = tdb_fetch(pppdb, key);
298                 if (rec.dptr != NULL && rec.dsize > 0) {
299                         rec.dptr[rec.dsize-1] = 0;
300                         if (strstr(rec.dptr, db_key) != NULL) {
301                                 /* already in there? strange */
302                                 warn("link entry already exists in tdb");
303                                 return;
304                         }
305                         l = rec.dsize + strlen(entry);
306                         p = malloc(l);
307                         if (p == NULL)
308                                 novm("bundle link list");
309                         slprintf(p, l, "%s%s", rec.dptr, entry);
310                 } else {
311                         warn("bundle link list not found");
312                 }
313                 if (rec.dptr != NULL)
314                         free(rec.dptr);
315         }
316         rec.dptr = p;
317         rec.dsize = strlen(p) + 1;
318         if (tdb_store(pppdb, key, rec, TDB_REPLACE))
319                 error("couldn't %s bundle link list",
320                       append? "update": "create");
321         if (p != entry)
322                 free(p);
323 }
324
325 static void remove_bundle_link()
326 {
327         TDB_DATA key, rec;
328         char entry[32];
329         char *p, *q;
330         int l;
331
332         key.dptr = blinks_id;
333         key.dsize = strlen(blinks_id);
334         slprintf(entry, sizeof(entry), "%s;", db_key);
335
336         rec = tdb_fetch(pppdb, key);
337         if (rec.dptr == NULL || rec.dsize <= 0) {
338                 if (rec.dptr != NULL)
339                         free(rec.dptr);
340                 return;
341         }
342         rec.dptr[rec.dsize-1] = 0;
343         p = strstr(rec.dptr, entry);
344         if (p != NULL) {
345                 q = p + strlen(entry);
346                 l = strlen(q) + 1;
347                 memmove(p, q, l);
348                 rec.dsize = p - rec.dptr + l;
349                 if (tdb_store(pppdb, key, rec, TDB_REPLACE))
350                         error("couldn't update bundle link list (removal)");
351         }
352         free(rec.dptr);
353 }
354
355 static void iterate_bundle_links(void (*func)(char *))
356 {
357         TDB_DATA key, rec, pp;
358         char *p, *q;
359
360         key.dptr = blinks_id;
361         key.dsize = strlen(blinks_id);
362         rec = tdb_fetch(pppdb, key);
363         if (rec.dptr == NULL || rec.dsize <= 0) {
364                 error("bundle link list not found (iterating list)");
365                 if (rec.dptr != NULL)
366                         free(rec.dptr);
367                 return;
368         }
369         p = rec.dptr;
370         p[rec.dsize-1] = 0;
371         while ((q = strchr(p, ';')) != NULL) {
372                 *q = 0;
373                 key.dptr = p;
374                 key.dsize = q - p;
375                 pp = tdb_fetch(pppdb, key);
376                 if (pp.dptr != NULL && pp.dsize > 0) {
377                         pp.dptr[pp.dsize-1] = 0;
378                         func(pp.dptr);
379                 }
380                 if (pp.dptr != NULL)
381                         free(pp.dptr);
382                 p = q + 1;
383         }
384         free(rec.dptr);
385 }
386
387 static int
388 parse_num(str, key, valp)
389      char *str;
390      const char *key;
391      int *valp;
392 {
393         char *p, *endp;
394         int i;
395
396         p = strstr(str, key);
397         if (p != 0) {
398                 p += strlen(key);
399                 i = strtol(p, &endp, 10);
400                 if (endp != p && (*endp == 0 || *endp == ';')) {
401                         *valp = i;
402                         return 1;
403                 }
404         }
405         return 0;
406 }
407
408 /*
409  * Check whether the pppd identified by `key' still owns ppp unit `unit'.
410  */
411 static int
412 owns_unit(key, unit)
413      TDB_DATA key;
414      int unit;
415 {
416         char ifkey[32];
417         TDB_DATA kd, vd;
418         int ret = 0;
419
420         slprintf(ifkey, sizeof(ifkey), "IFNAME=ppp%d", unit);
421         kd.dptr = ifkey;
422         kd.dsize = strlen(ifkey);
423         vd = tdb_fetch(pppdb, kd);
424         if (vd.dptr != NULL) {
425                 ret = vd.dsize == key.dsize
426                         && memcmp(vd.dptr, key.dptr, vd.dsize) == 0;
427                 free(vd.dptr);
428         }
429         return ret;
430 }
431
432 static int
433 get_default_epdisc(ep)
434      struct epdisc *ep;
435 {
436         char *p;
437         struct hostent *hp;
438         u_int32_t addr;
439
440         /* First try for an ethernet MAC address */
441         p = get_first_ethernet();
442         if (p != 0 && get_if_hwaddr(ep->value, p) >= 0) {
443                 ep->class = EPD_MAC;
444                 ep->length = 6;
445                 return 1;
446         }
447
448         /* see if our hostname corresponds to a reasonable IP address */
449         hp = gethostbyname(hostname);
450         if (hp != NULL) {
451                 addr = *(u_int32_t *)hp->h_addr;
452                 if (!bad_ip_adrs(addr)) {
453                         addr = ntohl(addr);
454                         if (!LOCAL_IP_ADDR(addr)) {
455                                 ep->class = EPD_IP;
456                                 set_ip_epdisc(ep, addr);
457                                 return 1;
458                         }
459                 }
460         }
461
462         return 0;
463 }
464
465 /*
466  * epdisc_to_str - make a printable string from an endpoint discriminator.
467  */
468
469 static char *endp_class_names[] = {
470     "null", "local", "IP", "MAC", "magic", "phone"
471 };
472
473 char *
474 epdisc_to_str(ep)
475      struct epdisc *ep;
476 {
477         static char str[MAX_ENDP_LEN*3+8];
478         u_char *p = ep->value;
479         int i, mask = 0;
480         char *q, c, c2;
481
482         if (ep->class == EPD_NULL && ep->length == 0)
483                 return "null";
484         if (ep->class == EPD_IP && ep->length == 4) {
485                 u_int32_t addr;
486
487                 GETLONG(addr, p);
488                 slprintf(str, sizeof(str), "IP:%I", htonl(addr));
489                 return str;
490         }
491
492         c = ':';
493         c2 = '.';
494         if (ep->class == EPD_MAC && ep->length == 6)
495                 c2 = ':';
496         else if (ep->class == EPD_MAGIC && (ep->length % 4) == 0)
497                 mask = 3;
498         q = str;
499         if (ep->class <= EPD_PHONENUM)
500                 q += slprintf(q, sizeof(str)-1, "%s",
501                               endp_class_names[ep->class]);
502         else
503                 q += slprintf(q, sizeof(str)-1, "%d", ep->class);
504         c = ':';
505         for (i = 0; i < ep->length && i < MAX_ENDP_LEN; ++i) {
506                 if ((i & mask) == 0) {
507                         *q++ = c;
508                         c = c2;
509                 }
510                 q += slprintf(q, str + sizeof(str) - q, "%.2x", ep->value[i]);
511         }
512         return str;
513 }
514
515 static int hexc_val(int c)
516 {
517         if (c >= 'a')
518                 return c - 'a' + 10;
519         if (c >= 'A')
520                 return c - 'A' + 10;
521         return c - '0';
522 }
523
524 int
525 str_to_epdisc(ep, str)
526      struct epdisc *ep;
527      char *str;
528 {
529         int i, l;
530         char *p, *endp;
531
532         for (i = EPD_NULL; i <= EPD_PHONENUM; ++i) {
533                 int sl = strlen(endp_class_names[i]);
534                 if (strncasecmp(str, endp_class_names[i], sl) == 0) {
535                         str += sl;
536                         break;
537                 }
538         }
539         if (i > EPD_PHONENUM) {
540                 /* not a class name, try a decimal class number */
541                 i = strtol(str, &endp, 10);
542                 if (endp == str)
543                         return 0;       /* can't parse class number */
544                 str = endp;
545         }
546         ep->class = i;
547         if (*str == 0) {
548                 ep->length = 0;
549                 return 1;
550         }
551         if (*str != ':' && *str != '.')
552                 return 0;
553         ++str;
554
555         if (i == EPD_IP) {
556                 u_int32_t addr;
557                 i = parse_dotted_ip(str, &addr);
558                 if (i == 0 || str[i] != 0)
559                         return 0;
560                 set_ip_epdisc(ep, addr);
561                 return 1;
562         }
563         if (i == EPD_MAC && get_if_hwaddr(ep->value, str) >= 0) {
564                 ep->length = 6;
565                 return 1;
566         }
567
568         p = str;
569         for (l = 0; l < MAX_ENDP_LEN; ++l) {
570                 if (*str == 0)
571                         break;
572                 if (p <= str)
573                         for (p = str; isxdigit(*p); ++p)
574                                 ;
575                 i = p - str;
576                 if (i == 0)
577                         return 0;
578                 ep->value[l] = hexc_val(*str++);
579                 if ((i & 1) == 0)
580                         ep->value[l] = (ep->value[l] << 4) + hexc_val(*str++);
581                 if (*str == ':' || *str == '.')
582                         ++str;
583         }
584         if (*str != 0 || (ep->class == EPD_MAC && l != 6))
585                 return 0;
586         ep->length = l;
587         return 1;
588 }
589