PPPoE updates: don't exit if discovery fails, cope with both
[ppp.git] / pppd / plugins / rp-pppoe / plugin.c
1 /***********************************************************************
2 *
3 * plugin.c
4 *
5 * pppd plugin for kernel-mode PPPoE on Linux
6 *
7 * Copyright (C) 2001 by Roaring Penguin Software Inc., Michal Ostrowski
8 * and Jamal Hadi Salim.
9 *
10 * Much code and many ideas derived from pppoe plugin by Michal
11 * Ostrowski and Jamal Hadi Salim, which carries this copyright:
12 *
13 * Copyright 2000 Michal Ostrowski <mostrows@styx.uwaterloo.ca>,
14 *                Jamal Hadi Salim <hadi@cyberus.ca>
15 * Borrows heavily from the PPPoATM plugin by Mitchell Blank Jr.,
16 * which is based in part on work from Jens Axboe and Paul Mackerras.
17 *
18 * This program is free software; you can redistribute it and/or
19 * modify it under the terms of the GNU General Public License
20 * as published by the Free Software Foundation; either version
21 * 2 of the License, or (at your option) any later version.
22 ***********************************************************************/
23
24 static char const RCSID[] =
25 "$Id: plugin.c,v 1.10 2004/01/13 04:03:58 paulus Exp $";
26
27 #define _GNU_SOURCE 1
28 #include "pppoe.h"
29
30 #include "pppd/pppd.h"
31 #include "pppd/fsm.h"
32 #include "pppd/lcp.h"
33 #include "pppd/ipcp.h"
34 #include "pppd/ccp.h"
35 #include "pppd/pathnames.h"
36
37 #include <linux/types.h>
38 #include <syslog.h>
39 #include <sys/ioctl.h>
40 #include <sys/types.h>
41 #include <sys/socket.h>
42 #include <sys/stat.h>
43 #include <string.h>
44 #include <stdlib.h>
45 #include <errno.h>
46 #include <unistd.h>
47 #include <fcntl.h>
48 #include <signal.h>
49 #include <net/ethernet.h>
50 #include <net/if_arp.h>
51 #include "ppp_defs.h"
52 #include "if_ppp.h"
53 #include "if_pppox.h"
54
55 #define _PATH_ETHOPT         _ROOT_PATH "/etc/ppp/options."
56
57 char pppd_version[] = VERSION;
58
59 /* From sys-linux.c in pppd -- MUST FIX THIS! */
60 extern int new_style_driver;
61
62 char *pppd_pppoe_service = NULL;
63 static char *acName = NULL;
64 static char *existingSession = NULL;
65 static int printACNames = 0;
66
67 static int PPPoEDevnameHook(char *cmd, char **argv, int doit);
68 static option_t Options[] = {
69     { "device name", o_wild, (void *) &PPPoEDevnameHook,
70       "PPPoE device name",
71       OPT_DEVNAM | OPT_PRIVFIX | OPT_NOARG  | OPT_A2STRVAL | OPT_STATIC,
72       devnam},
73     { "rp_pppoe_service", o_string, &pppd_pppoe_service,
74       "Desired PPPoE service name" },
75     { "rp_pppoe_ac",      o_string, &acName,
76       "Desired PPPoE access concentrator name" },
77     { "rp_pppoe_sess",    o_string, &existingSession,
78       "Attach to existing session (sessid:macaddr)" },
79     { "rp_pppoe_verbose", o_int, &printACNames,
80       "Be verbose about discovered access concentrators"},
81     { NULL }
82 };
83 int (*OldDevnameHook)(char *cmd, char **argv, int doit) = NULL;
84 static PPPoEConnection *conn = NULL;
85
86 /**********************************************************************
87  * %FUNCTION: PPPOEInitDevice
88  * %ARGUMENTS:
89  * None
90  * %RETURNS:
91  *
92  * %DESCRIPTION:
93  * Initializes PPPoE device.
94  ***********************************************************************/
95 static int
96 PPPOEInitDevice(void)
97 {
98     conn = malloc(sizeof(PPPoEConnection));
99     if (!conn) {
100         fatal("Could not allocate memory for PPPoE session");
101     }
102     memset(conn, 0, sizeof(PPPoEConnection));
103     if (acName) {
104         SET_STRING(conn->acName, acName);
105     }
106     if (pppd_pppoe_service) {
107         SET_STRING(conn->serviceName, pppd_pppoe_service);
108     }
109     SET_STRING(conn->ifName, devnam);
110     conn->discoverySocket = -1;
111     conn->sessionSocket = -1;
112     conn->useHostUniq = 1;
113     conn->printACNames = printACNames;
114     return 1;
115 }
116
117 /**********************************************************************
118  * %FUNCTION: PPPOEConnectDevice
119  * %ARGUMENTS:
120  * None
121  * %RETURNS:
122  * Non-negative if all goes well; -1 otherwise
123  * %DESCRIPTION:
124  * Connects PPPoE device.
125  ***********************************************************************/
126 static int
127 PPPOEConnectDevice(void)
128 {
129     struct sockaddr_pppox sp;
130
131     strlcpy(ppp_devnam, devnam, sizeof(ppp_devnam));
132     if (existingSession) {
133         unsigned int mac[ETH_ALEN];
134         int i, ses;
135         if (sscanf(existingSession, "%d:%x:%x:%x:%x:%x:%x",
136                    &ses, &mac[0], &mac[1], &mac[2],
137                    &mac[3], &mac[4], &mac[5]) != 7) {
138             fatal("Illegal value for rp_pppoe_sess option");
139         }
140         conn->session = htons(ses);
141         for (i=0; i<ETH_ALEN; i++) {
142             conn->peerEth[i] = (unsigned char) mac[i];
143         }
144     } else {
145         discovery(conn);
146         if (conn->discoveryState != STATE_SESSION) {
147             error("Unable to complete PPPoE Discovery");
148             return -1;
149         }
150     }
151
152     /* Set PPPoE session-number for further consumption */
153     ppp_session_number = ntohs(conn->session);
154
155     /* Make the session socket */
156     conn->sessionSocket = socket(AF_PPPOX, SOCK_STREAM, PX_PROTO_OE);
157     if (conn->sessionSocket < 0) {
158         fatal("Failed to create PPPoE socket: %m");
159     }
160     sp.sa_family = AF_PPPOX;
161     sp.sa_protocol = PX_PROTO_OE;
162     sp.sa_addr.pppoe.sid = conn->session;
163     memcpy(sp.sa_addr.pppoe.dev, conn->ifName, IFNAMSIZ);
164     memcpy(sp.sa_addr.pppoe.remote, conn->peerEth, ETH_ALEN);
165
166     /* Set remote_number for ServPoET */
167     sprintf(remote_number, "%02X:%02X:%02X:%02X:%02X:%02X",
168             (unsigned) conn->peerEth[0],
169             (unsigned) conn->peerEth[1],
170             (unsigned) conn->peerEth[2],
171             (unsigned) conn->peerEth[3],
172             (unsigned) conn->peerEth[4],
173             (unsigned) conn->peerEth[5]);
174
175     if (connect(conn->sessionSocket, (struct sockaddr *) &sp,
176                 sizeof(struct sockaddr_pppox)) < 0) {
177         fatal("Failed to connect PPPoE socket: %d %m", errno);
178         return -1;
179     }
180
181     return conn->sessionSocket;
182 }
183
184 static void
185 PPPOESendConfig(int mtu,
186                 u_int32_t asyncmap,
187                 int pcomp,
188                 int accomp)
189 {
190     int sock;
191     struct ifreq ifr;
192
193     if (mtu > MAX_PPPOE_MTU) {
194         warn("Couldn't increase MTU to %d", mtu);
195         mtu = MAX_PPPOE_MTU;
196     }
197     sock = socket(AF_INET, SOCK_DGRAM, 0);
198     if (sock < 0) {
199         error("Couldn't create IP socket: %m");
200         return;
201     }
202     strlcpy(ifr.ifr_name, ifname, sizeof(ifr.ifr_name));
203     ifr.ifr_mtu = mtu;
204     if (ioctl(sock, SIOCSIFMTU, &ifr) < 0) {
205         error("Couldn't set interface MTU to %d: %m", mtu);
206         return;
207     }
208     (void) close (sock);
209 }
210
211
212 static void
213 PPPOERecvConfig(int mru,
214                 u_int32_t asyncmap,
215                 int pcomp,
216                 int accomp)
217 {
218     if (mru > MAX_PPPOE_MTU)
219         warn("Couldn't increase MRU to %d", mru);
220 }
221
222 /**********************************************************************
223  * %FUNCTION: PPPOEDisconnectDevice
224  * %ARGUMENTS:
225  * None
226  * %RETURNS:
227  * Nothing
228  * %DESCRIPTION:
229  * Disconnects PPPoE device
230  ***********************************************************************/
231 static void
232 PPPOEDisconnectDevice(void)
233 {
234     struct sockaddr_pppox sp;
235
236     sp.sa_family = AF_PPPOX;
237     sp.sa_protocol = PX_PROTO_OE;
238     sp.sa_addr.pppoe.sid = 0;
239     memcpy(sp.sa_addr.pppoe.dev, conn->ifName, IFNAMSIZ);
240     memcpy(sp.sa_addr.pppoe.remote, conn->peerEth, ETH_ALEN);
241     if (connect(conn->sessionSocket, (struct sockaddr *) &sp,
242                 sizeof(struct sockaddr_pppox)) < 0) {
243         fatal("Failed to disconnect PPPoE socket: %d %m", errno);
244         return;
245     }
246     close(conn->sessionSocket);
247 }
248
249 static void
250 PPPOEDeviceOptions(void)
251 {
252     char buf[256];
253     snprintf(buf, 256, _PATH_ETHOPT "%s",devnam);
254     if(!options_from_file(buf, 0, 0, 1))
255         exit(EXIT_OPTION_ERROR);
256
257 }
258
259 struct channel pppoe_channel;
260
261 /**********************************************************************
262  * %FUNCTION: PPPoEDevnameHook
263  * %ARGUMENTS:
264  * cmd -- the command (actually, the device name
265  * argv -- argument vector
266  * doit -- if non-zero, set device name.  Otherwise, just check if possible
267  * %RETURNS:
268  * 1 if we will handle this device; 0 otherwise.
269  * %DESCRIPTION:
270  * Checks if name is a valid interface name; if so, returns 1.  Also
271  * sets up devnam (string representation of device).
272  ***********************************************************************/
273 static int
274 PPPoEDevnameHook(char *cmd, char **argv, int doit)
275 {
276     int r = 1;
277     int fd;
278     struct ifreq ifr;
279
280     /* Only do it if name is "ethXXX", "nasXXX", "tapXXX" or "nic-XXXX.
281        In latter case strip off the "nic-" */
282     /* Thanks to Russ Couturier for this fix */
283     if (strlen(cmd) > 4 && !strncmp(cmd, "nic-", 4)) {
284         /* Strip off "nic-" */
285         cmd += 4;
286     } else if (strlen(cmd) < 4 || (strncmp(cmd, "eth", 3) &&
287                 strncmp(cmd, "nas", 3) && strncmp(cmd, "tap", 3))) {
288         if (OldDevnameHook) return OldDevnameHook(cmd, argv, doit);
289         return 0;
290     }
291
292     /* Open a socket */
293     if ((fd = socket(PF_PACKET, SOCK_RAW, 0)) < 0) {
294         r = 0;
295     }
296
297     /* Try getting interface index */
298     if (r) {
299         strncpy(ifr.ifr_name, cmd, sizeof(ifr.ifr_name));
300         if (ioctl(fd, SIOCGIFINDEX, &ifr) < 0) {
301             r = 0;
302         } else {
303             if (ioctl(fd, SIOCGIFHWADDR, &ifr) < 0) {
304                 r = 0;
305             } else {
306                 if (ifr.ifr_hwaddr.sa_family != ARPHRD_ETHER) {
307                     error("Interface %s not Ethernet", cmd);
308                     r=0;
309                 }
310             }
311         }
312     }
313
314     /* Close socket */
315     close(fd);
316     if (r) {
317         strncpy(devnam, cmd, sizeof(devnam));
318         if (the_channel != &pppoe_channel) {
319
320             the_channel = &pppoe_channel;
321             modem = 0;
322
323             lcp_allowoptions[0].neg_accompression = 0;
324             lcp_wantoptions[0].neg_accompression = 0;
325
326             lcp_allowoptions[0].neg_asyncmap = 0;
327             lcp_wantoptions[0].neg_asyncmap = 0;
328
329             lcp_allowoptions[0].neg_pcompression = 0;
330             lcp_wantoptions[0].neg_pcompression = 0;
331
332             ccp_allowoptions[0].deflate = 0 ;
333             ccp_wantoptions[0].deflate = 0 ;
334
335             ipcp_allowoptions[0].neg_vj=0;
336             ipcp_wantoptions[0].neg_vj=0;
337
338             ccp_allowoptions[0].bsd_compress = 0;
339             ccp_wantoptions[0].bsd_compress = 0;
340
341             PPPOEInitDevice();
342         }
343         return 1;
344     }
345
346     if (OldDevnameHook) r = OldDevnameHook(cmd, argv, doit);
347     return r;
348 }
349
350 /**********************************************************************
351  * %FUNCTION: plugin_init
352  * %ARGUMENTS:
353  * None
354  * %RETURNS:
355  * Nothing
356  * %DESCRIPTION:
357  * Initializes hooks for pppd plugin
358  ***********************************************************************/
359 void
360 plugin_init(void)
361 {
362     if (!ppp_available() && !new_style_driver) {
363         fatal("Linux kernel does not support PPPoE -- are you running 2.4.x?");
364     }
365
366     add_options(Options);
367
368     info("RP-PPPoE plugin version %s compiled against pppd %s",
369          RP_VERSION, VERSION);
370 }
371
372 /**********************************************************************
373 *%FUNCTION: fatalSys
374 *%ARGUMENTS:
375 * str -- error message
376 *%RETURNS:
377 * Nothing
378 *%DESCRIPTION:
379 * Prints a message plus the errno value to stderr and syslog and exits.
380 ***********************************************************************/
381 void
382 fatalSys(char const *str)
383 {
384     char buf[1024];
385     int i = errno;
386     sprintf(buf, "%.256s: %.256s", str, strerror(i));
387     printErr(buf);
388     sprintf(buf, "RP-PPPoE: %.256s: %.256s", str, strerror(i));
389     sendPADT(conn, buf);
390     exit(1);
391 }
392
393 /**********************************************************************
394 *%FUNCTION: rp_fatal
395 *%ARGUMENTS:
396 * str -- error message
397 *%RETURNS:
398 * Nothing
399 *%DESCRIPTION:
400 * Prints a message to stderr and syslog and exits.
401 ***********************************************************************/
402 void
403 rp_fatal(char const *str)
404 {
405     char buf[1024];
406     printErr(str);
407     sprintf(buf, "RP-PPPoE: %.256s", str);
408     sendPADT(conn, buf);
409     exit(1);
410 }
411 /**********************************************************************
412 *%FUNCTION: sysErr
413 *%ARGUMENTS:
414 * str -- error message
415 *%RETURNS:
416 * Nothing
417 *%DESCRIPTION:
418 * Prints a message plus the errno value to syslog.
419 ***********************************************************************/
420 void
421 sysErr(char const *str)
422 {
423     rp_fatal(str);
424 }
425
426
427 struct channel pppoe_channel = {
428     options: Options,
429     process_extra_options: &PPPOEDeviceOptions,
430     check_options: NULL,
431     connect: &PPPOEConnectDevice,
432     disconnect: &PPPOEDisconnectDevice,
433     establish_ppp: &generic_establish_ppp,
434     disestablish_ppp: &generic_disestablish_ppp,
435     send_config: &PPPOESendConfig,
436     recv_config: &PPPOERecvConfig,
437     close: NULL,
438     cleanup: NULL
439 };