WPS: Convert struct subscr_addr to use dl_list
[libeap.git] / src / wps / wps_upnp.c
1 /*
2  * UPnP WPS Device
3  * Copyright (c) 2000-2003 Intel Corporation
4  * Copyright (c) 2006-2007 Sony Corporation
5  * Copyright (c) 2008-2009 Atheros Communications
6  * Copyright (c) 2009, Jouni Malinen <j@w1.fi>
7  *
8  * See below for more details on licensing and code history.
9  */
10
11 /*
12  * This has been greatly stripped down from the original file
13  * (upnp_wps_device.c) by Ted Merrill, Atheros Communications
14  * in order to eliminate use of the bulky libupnp library etc.
15  *
16  * History:
17  * upnp_wps_device.c is/was a shim layer between wps_opt_upnp.c and
18  * the libupnp library.
19  * The layering (by Sony) was well done; only a very minor modification
20  * to API of upnp_wps_device.c was required.
21  * libupnp was found to be undesirable because:
22  * -- It consumed too much code and data space
23  * -- It uses multiple threads, making debugging more difficult
24  *      and possibly reducing reliability.
25  * -- It uses static variables and only supports one instance.
26  * The shim and libupnp are here replaced by special code written
27  * specifically for the needs of hostapd.
28  * Various shortcuts can and are taken to keep the code size small.
29  * Generally, execution time is not as crucial.
30  *
31  * BUGS:
32  * -- UPnP requires that we be able to resolve domain names.
33  * While uncommon, if we have to do it then it will stall the entire
34  * hostapd program, which is bad.
35  * This is because we use the standard linux getaddrinfo() function
36  * which is syncronous.
37  * An asyncronous solution would be to use the free "ares" library.
38  * -- Does not have a robust output buffering scheme.  Uses a single
39  * fixed size output buffer per TCP/HTTP connection, with possible (although
40  * unlikely) possibility of overflow and likely excessive use of RAM.
41  * A better solution would be to write the HTTP output as a buffered stream,
42  * using chunking: (handle header specially, then) generate data with
43  * a printf-like function into a buffer, catching buffer full condition,
44  * then send it out surrounded by http chunking.
45  * -- There is some code that could be separated out into the common
46  * library to be shared with wpa_supplicant.
47  * -- Needs renaming with module prefix to avoid polluting the debugger
48  * namespace and causing possible collisions with other static fncs
49  * and structure declarations when using the debugger.
50  * -- The http error code generation is pretty bogus, hopefully noone cares.
51  *
52  * Author: Ted Merrill, Atheros Communications, based upon earlier work
53  * as explained above and below.
54  *
55  * Copyright:
56  * Copyright 2008 Atheros Communications.
57  *
58  * The original header (of upnp_wps_device.c) reads:
59  *
60  *  Copyright (c) 2006-2007 Sony Corporation. All Rights Reserved.
61  *
62  *  File Name: upnp_wps_device.c
63  *  Description: EAP-WPS UPnP device source
64  *
65  *   Redistribution and use in source and binary forms, with or without
66  *   modification, are permitted provided that the following conditions
67  *   are met:
68  *
69  *     * Redistributions of source code must retain the above copyright
70  *       notice, this list of conditions and the following disclaimer.
71  *     * Redistributions in binary form must reproduce the above copyright
72  *       notice, this list of conditions and the following disclaimer in
73  *       the documentation and/or other materials provided with the
74  *       distribution.
75  *     * Neither the name of Sony Corporation nor the names of its
76  *       contributors may be used to endorse or promote products derived
77  *       from this software without specific prior written permission.
78  *
79  *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
80  *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
81  *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
82  *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
83  *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
84  *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
85  *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
86  *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
87  *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
88  *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
89  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
90  *
91  * Portions from Intel libupnp files, e.g. genlib/net/http/httpreadwrite.c
92  * typical header:
93  *
94  * Copyright (c) 2000-2003 Intel Corporation
95  * All rights reserved.
96  *
97  * Redistribution and use in source and binary forms, with or without
98  * modification, are permitted provided that the following conditions are met:
99  *
100  * * Redistributions of source code must retain the above copyright notice,
101  * this list of conditions and the following disclaimer.
102  * * Redistributions in binary form must reproduce the above copyright notice,
103  * this list of conditions and the following disclaimer in the documentation
104  * and/or other materials provided with the distribution.
105  * * Neither name of Intel Corporation nor the names of its contributors
106  * may be used to endorse or promote products derived from this software
107  * without specific prior written permission.
108  *
109  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
110  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
111  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
112  * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL INTEL OR
113  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
114  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
115  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
116  * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY
117  * OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
118  * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
119  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
120 */
121
122 /*
123  * Overview of WPS over UPnP:
124  *
125  * UPnP is a protocol that allows devices to discover each other and control
126  * each other. In UPnP terminology, a device is either a "device" (a server
127  * that provides information about itself and allows itself to be controlled)
128  * or a "control point" (a client that controls "devices") or possibly both.
129  * This file implements a UPnP "device".
130  *
131  * For us, we use mostly basic UPnP discovery, but the control part of interest
132  * is WPS carried via UPnP messages. There is quite a bit of basic UPnP
133  * discovery to do before we can get to WPS, however.
134  *
135  * UPnP discovery begins with "devices" send out multicast UDP packets to a
136  * certain fixed multicast IP address and port, and "control points" sending
137  * out other such UDP packets.
138  *
139  * The packets sent by devices are NOTIFY packets (not to be confused with TCP
140  * NOTIFY packets that are used later) and those sent by control points are
141  * M-SEARCH packets. These packets contain a simple HTTP style header. The
142  * packets are sent redundantly to get around packet loss. Devices respond to
143  * M-SEARCH packets with HTTP-like UDP packets containing HTTP/1.1 200 OK
144  * messages, which give similar information as the UDP NOTIFY packets.
145  *
146  * The above UDP packets advertise the (arbitrary) TCP ports that the
147  * respective parties will listen to. The control point can then do a HTTP
148  * SUBSCRIBE (something like an HTTP PUT) after which the device can do a
149  * separate HTTP NOTIFY (also like an HTTP PUT) to do event messaging.
150  *
151  * The control point will also do HTTP GET of the "device file" listed in the
152  * original UDP information from the device (see UPNP_WPS_DEVICE_XML_FILE
153  * data), and based on this will do additional GETs... HTTP POSTs are done to
154  * cause an action.
155  *
156  * Beyond some basic information in HTTP headers, additional information is in
157  * the HTTP bodies, in a format set by the SOAP and XML standards, a markup
158  * language related to HTML used for web pages. This language is intended to
159  * provide the ultimate in self-documentation by providing a universal
160  * namespace based on pseudo-URLs called URIs. Note that although a URI looks
161  * like a URL (a web address), they are never accessed as such but are used
162  * only as identifiers.
163  *
164  * The POST of a GetDeviceInfo gets information similar to what might be
165  * obtained from a probe request or response on Wi-Fi. WPS messages M1-M8
166  * are passed via a POST of a PutMessage; the M1-M8 WPS messages are converted
167  * to a bin64 ascii representation for encapsulation. When proxying messages,
168  * WLANEvent and PutWLANResponse are used.
169  *
170  * This of course glosses over a lot of details.
171  */
172
173 #include "includes.h"
174
175 #include <assert.h>
176 #include <net/if.h>
177 #include <netdb.h>
178 #include <sys/ioctl.h>
179
180 #include "common.h"
181 #include "uuid.h"
182 #include "base64.h"
183 #include "wps.h"
184 #include "wps_i.h"
185 #include "wps_upnp.h"
186 #include "wps_upnp_i.h"
187
188
189 /*
190  * UPnP allows a client ("control point") to send a server like us ("device")
191  * a domain name for registration, and we are supposed to resolve it. This is
192  * bad because, using the standard Linux library, we will stall the entire
193  * hostapd waiting for resolution.
194  *
195  * The "correct" solution would be to use an event driven library for domain
196  * name resolution such as "ares". However, this would increase code size
197  * further. Since it is unlikely that we'll actually see such domain names, we
198  * can just refuse to accept them.
199  */
200 #define NO_DOMAIN_NAME_RESOLUTION 1  /* 1 to allow only dotted ip addresses */
201
202
203 /*
204  * UPnP does not scale well. If we were in a room with thousands of control
205  * points then potentially we could be expected to handle subscriptions for
206  * each of them, which would exhaust our memory. So we must set a limit. In
207  * practice we are unlikely to see more than one or two.
208  */
209 #define MAX_SUBSCRIPTIONS 4    /* how many subscribing clients we handle */
210 #define MAX_ADDR_PER_SUBSCRIPTION 8
211
212
213 /* Write the current date/time per RFC */
214 void format_date(struct wpabuf *buf)
215 {
216         const char *weekday_str = "Sun\0Mon\0Tue\0Wed\0Thu\0Fri\0Sat";
217         const char *month_str = "Jan\0Feb\0Mar\0Apr\0May\0Jun\0"
218                 "Jul\0Aug\0Sep\0Oct\0Nov\0Dec";
219         struct tm *date;
220         time_t t;
221
222         t = time(NULL);
223         date = gmtime(&t);
224         wpabuf_printf(buf, "%s, %02d %s %d %02d:%02d:%02d GMT",
225                       &weekday_str[date->tm_wday * 4], date->tm_mday,
226                       &month_str[date->tm_mon * 4], date->tm_year + 1900,
227                       date->tm_hour, date->tm_min, date->tm_sec);
228 }
229
230
231 /***************************************************************************
232  * UUIDs (unique identifiers)
233  *
234  * These are supposed to be unique in all the world.
235  * Sometimes permanent ones are used, sometimes temporary ones
236  * based on random numbers... there are different rules for valid content
237  * of different types.
238  * Each uuid is 16 bytes long.
239  **************************************************************************/
240
241 /* uuid_make -- construct a random UUID
242  * The UPnP documents don't seem to offer any guidelines as to which method to
243  * use for constructing UUIDs for subscriptions. Presumably any method from
244  * rfc4122 is good enough; I've chosen random number method.
245  */
246 static void uuid_make(u8 uuid[UUID_LEN])
247 {
248         os_get_random(uuid, UUID_LEN);
249
250         /* Replace certain bits as specified in rfc4122 or X.667 */
251         uuid[6] &= 0x0f; uuid[6] |= (4 << 4);   /* version 4 == random gen */
252         uuid[8] &= 0x3f; uuid[8] |= 0x80;
253 }
254
255
256 /*
257  * Subscriber address handling.
258  * Since a subscriber may have an arbitrary number of addresses, we have to
259  * add a bunch of code to handle them.
260  *
261  * Addresses are passed in text, and MAY be domain names instead of the (usual
262  * and expected) dotted IP addresses. Resolving domain names consumes a lot of
263  * resources. Worse, we are currently using the standard Linux getaddrinfo()
264  * which will block the entire program until complete or timeout! The proper
265  * solution would be to use the "ares" library or similar with more state
266  * machine steps etc. or just disable domain name resolution by setting
267  * NO_DOMAIN_NAME_RESOLUTION to 1 at top of this file.
268  */
269
270 /* subscr_addr_delete -- delete single unlinked subscriber address
271  * (be sure to unlink first if need be)
272  */
273 static void subscr_addr_delete(struct subscr_addr *a)
274 {
275         /*
276          * Note: do NOT free domain_and_port or path because they point to
277          * memory within the allocation of "a".
278          */
279         os_free(a);
280 }
281
282
283 /* subscr_addr_free_all -- unlink and delete list of subscriber addresses. */
284 static void subscr_addr_free_all(struct subscription *s)
285 {
286         struct subscr_addr *a, *tmp;
287         dl_list_for_each_safe(a, tmp, &s->addr_list, struct subscr_addr, list)
288         {
289                 dl_list_del(&a->list);
290                 subscr_addr_delete(a);
291         }
292 }
293
294
295 /* subscr_addr_add_url -- add address(es) for one url to subscription */
296 static void subscr_addr_add_url(struct subscription *s, const char *url)
297 {
298         int alloc_len;
299         char *scratch_mem = NULL;
300         char *mem;
301         char *domain_and_port;
302         char *delim;
303         char *path;
304         char *domain;
305         int port = 80;  /* port to send to (default is port 80) */
306         struct addrinfo hints;
307         struct addrinfo *result = NULL;
308         struct addrinfo *rp;
309         int rerr;
310         struct subscr_addr *a = NULL;
311
312         /* url MUST begin with http: */
313         if (os_strncasecmp(url, "http://", 7))
314                 goto fail;
315         url += 7;
316
317         /* allocate memory for the extra stuff we need */
318         alloc_len = (2 * (os_strlen(url) + 1));
319         scratch_mem = os_zalloc(alloc_len);
320         if (scratch_mem == NULL)
321                 goto fail;
322         mem = scratch_mem;
323         strcpy(mem, url);
324         domain_and_port = mem;
325         mem += 1 + os_strlen(mem);
326         delim = os_strchr(domain_and_port, '/');
327         if (delim) {
328                 *delim++ = 0;   /* null terminate domain and port */
329                 path = delim;
330         } else {
331                 path = domain_and_port + os_strlen(domain_and_port);
332         }
333         domain = mem;
334         strcpy(domain, domain_and_port);
335         delim = strchr(domain, ':');
336         if (delim) {
337                 *delim++ = 0;   /* null terminate domain */
338                 if (isdigit(*delim))
339                         port = atol(delim);
340         }
341
342         /*
343          * getaddrinfo does the right thing with dotted decimal notations, or
344          * will resolve domain names. Resolving domain names will unfortunately
345          * hang the entire program until it is resolved or it times out
346          * internal to getaddrinfo; fortunately we think that the use of actual
347          * domain names (vs. dotted decimal notations) should be uncommon.
348          */
349         os_memset(&hints, 0, sizeof(struct addrinfo));
350         hints.ai_family = AF_INET;      /* IPv4 */
351         hints.ai_socktype = SOCK_STREAM;
352 #if NO_DOMAIN_NAME_RESOLUTION
353         /* Suppress domain name resolutions that would halt
354          * the program for periods of time
355          */
356         hints.ai_flags = AI_NUMERICHOST;
357 #else
358         /* Allow domain name resolution. */
359         hints.ai_flags = 0;
360 #endif
361         hints.ai_protocol = 0;          /* Any protocol? */
362         rerr = getaddrinfo(domain, NULL /* fill in port ourselves */,
363                            &hints, &result);
364         if (rerr) {
365                 wpa_printf(MSG_INFO, "WPS UPnP: Resolve error %d (%s) on: %s",
366                            rerr, gai_strerror(rerr), domain);
367                 goto fail;
368         }
369         for (rp = result; rp; rp = rp->ai_next) {
370                 /* Limit no. of address to avoid denial of service attack */
371                 if (dl_list_len(&s->addr_list) >= MAX_ADDR_PER_SUBSCRIPTION) {
372                         wpa_printf(MSG_INFO, "WPS UPnP: subscr_addr_add_url: "
373                                    "Ignoring excessive addresses");
374                         break;
375                 }
376
377                 a = os_zalloc(sizeof(*a) + alloc_len);
378                 if (a == NULL)
379                         continue;
380                 a->s = s;
381                 mem = (void *) (a + 1);
382                 a->domain_and_port = mem;
383                 strcpy(mem, domain_and_port);
384                 mem += 1 + strlen(mem);
385                 a->path = mem;
386                 if (path[0] != '/')
387                         *mem++ = '/';
388                 strcpy(mem, path);
389                 mem += 1 + strlen(mem);
390                 os_memcpy(&a->saddr, rp->ai_addr, sizeof(a->saddr));
391                 a->saddr.sin_port = htons(port);
392
393                 dl_list_add(&s->addr_list, &a->list);
394                 a = NULL;       /* don't free it below */
395         }
396
397 fail:
398         if (result)
399                 freeaddrinfo(result);
400         os_free(scratch_mem);
401         os_free(a);
402 }
403
404
405 /* subscr_addr_list_create -- create list from urls in string.
406  *      Each url is enclosed by angle brackets.
407  */
408 static void subscr_addr_list_create(struct subscription *s,
409                                     const char *url_list)
410 {
411         char *end;
412         for (;;) {
413                 while (*url_list == ' ' || *url_list == '\t')
414                         url_list++;
415                 if (*url_list != '<')
416                         break;
417                 url_list++;
418                 end = os_strchr(url_list, '>');
419                 if (end == NULL)
420                         break;
421                 *end++ = 0;
422                 subscr_addr_add_url(s, url_list);
423                 url_list = end;
424         }
425 }
426
427
428 int send_wpabuf(int fd, struct wpabuf *buf)
429 {
430         wpa_printf(MSG_DEBUG, "WPS UPnP: Send %lu byte message",
431                    (unsigned long) wpabuf_len(buf));
432         errno = 0;
433         if (write(fd, wpabuf_head(buf), wpabuf_len(buf)) !=
434             (int) wpabuf_len(buf)) {
435                 wpa_printf(MSG_ERROR, "WPS UPnP: Failed to send buffer: "
436                            "errno=%d (%s)",
437                            errno, strerror(errno));
438                 return -1;
439         }
440
441         return 0;
442 }
443
444
445 static void wpabuf_put_property(struct wpabuf *buf, const char *name,
446                                 const char *value)
447 {
448         wpabuf_put_str(buf, "<e:property>");
449         wpabuf_printf(buf, "<%s>", name);
450         if (value)
451                 wpabuf_put_str(buf, value);
452         wpabuf_printf(buf, "</%s>", name);
453         wpabuf_put_str(buf, "</e:property>\n");
454 }
455
456
457 /**
458  * upnp_wps_device_send_event - Queue event messages for subscribers
459  * @sm: WPS UPnP state machine from upnp_wps_device_init()
460  *
461  * This function queues the last WLANEvent to be sent for all currently
462  * subscribed UPnP control points. sm->wlanevent must have been set with the
463  * encoded data before calling this function.
464  */
465 static void upnp_wps_device_send_event(struct upnp_wps_device_sm *sm)
466 {
467         /* Enqueue event message for all subscribers */
468         struct wpabuf *buf; /* holds event message */
469         int buf_size = 0;
470         struct subscription *s;
471         /* Actually, utf-8 is the default, but it doesn't hurt to specify it */
472         const char *format_head =
473                 "<?xml version=\"1.0\" encoding=\"utf-8\"?>\n"
474                 "<e:propertyset xmlns:e=\"urn:schemas-upnp-org:event-1-0\">\n";
475         const char *format_tail = "</e:propertyset>\n";
476
477         if (sm->subscriptions == NULL) {
478                 /* optimize */
479                 return;
480         }
481
482         /* Determine buffer size needed first */
483         buf_size += os_strlen(format_head);
484         buf_size += 50 + 2 * os_strlen("WLANEvent");
485         if (sm->wlanevent)
486                 buf_size += os_strlen(sm->wlanevent);
487         buf_size += os_strlen(format_tail);
488
489         buf = wpabuf_alloc(buf_size);
490         if (buf == NULL)
491                 return;
492         wpabuf_put_str(buf, format_head);
493         wpabuf_put_property(buf, "WLANEvent", sm->wlanevent);
494         wpabuf_put_str(buf, format_tail);
495
496         wpa_printf(MSG_MSGDUMP, "WPS UPnP: WLANEvent message:\n%s",
497                    (char *) wpabuf_head(buf));
498
499         s = sm->subscriptions;
500         do {
501                 if (event_add(s, buf)) {
502                         struct subscription *s_old = s;
503                         wpa_printf(MSG_INFO, "WPS UPnP: Dropping "
504                                    "subscriber due to event backlog");
505                         s = s_old->next;
506                         subscription_unlink(s_old);
507                         subscription_destroy(s_old);
508                 } else {
509                         s = s->next;
510                 }
511         } while (s != sm->subscriptions);
512
513         wpabuf_free(buf);
514 }
515
516
517 /*
518  * Event subscription (subscriber machines register with us to receive event
519  * messages).
520  * This is the result of an incoming HTTP over TCP SUBSCRIBE request.
521  */
522
523 /* subscription_unlink -- remove from the active list */
524 void subscription_unlink(struct subscription *s)
525 {
526         struct upnp_wps_device_sm *sm = s->sm;
527
528         if (s->next == s) {
529                 /* only one? */
530                 sm->subscriptions = NULL;
531         } else  {
532                 if (sm->subscriptions == s)
533                         sm->subscriptions = s->next;
534                 s->next->prev = s->prev;
535                 s->prev->next = s->next;
536         }
537         sm->n_subscriptions--;
538 }
539
540
541 /* subscription_link_to_end -- link to end of active list
542  * (should have high expiry time!)
543  */
544 static void subscription_link_to_end(struct subscription *s)
545 {
546         struct upnp_wps_device_sm *sm = s->sm;
547
548         if (sm->subscriptions) {
549                 s->next = sm->subscriptions;
550                 s->prev = s->next->prev;
551                 s->prev->next = s;
552                 s->next->prev = s;
553         } else {
554                 sm->subscriptions = s->next = s->prev = s;
555         }
556         sm->n_subscriptions++;
557 }
558
559
560 /* subscription_destroy -- destroy an unlinked subscription
561  * Be sure to unlink first if necessary.
562  */
563 void subscription_destroy(struct subscription *s)
564 {
565         wpa_printf(MSG_DEBUG, "WPS UPnP: Destroy subscription %p", s);
566         subscr_addr_free_all(s);
567         event_delete_all(s);
568         upnp_er_remove_notification(s);
569         os_free(s);
570 }
571
572
573 /* subscription_list_age -- remove expired subscriptions */
574 static void subscription_list_age(struct upnp_wps_device_sm *sm, time_t now)
575 {
576         struct subscription *s;
577         while ((s = sm->subscriptions) != NULL && s->timeout_time < now) {
578                 wpa_printf(MSG_DEBUG, "WPS UPnP: Removing aged subscription");
579                 subscription_unlink(s);
580                 subscription_destroy(s);
581         }
582 }
583
584
585 /* subscription_find -- return existing subscription matching uuid, if any
586  * returns NULL if not found
587  */
588 struct subscription * subscription_find(struct upnp_wps_device_sm *sm,
589                                         const u8 uuid[UUID_LEN])
590 {
591         struct subscription *s0 = sm->subscriptions;
592         struct subscription *s = s0;
593
594         if (s0 == NULL)
595                 return NULL;
596         do {
597                 if (os_memcmp(s->uuid, uuid, UUID_LEN) == 0)
598                         return s; /* Found match */
599                 s = s->next;
600         } while (s != s0);
601
602         return NULL;
603 }
604
605
606 static struct wpabuf * build_fake_wsc_ack(void)
607 {
608         struct wpabuf *msg = wpabuf_alloc(100);
609         if (msg == NULL)
610                 return NULL;
611         wpabuf_put_u8(msg, UPNP_WPS_WLANEVENT_TYPE_EAP);
612         wpabuf_put_str(msg, "00:00:00:00:00:00");
613         wps_build_version(msg);
614         wps_build_msg_type(msg, WPS_WSC_ACK);
615         /* Enrollee Nonce */
616         wpabuf_put_be16(msg, ATTR_ENROLLEE_NONCE);
617         wpabuf_put_be16(msg, WPS_NONCE_LEN);
618         wpabuf_put(msg, WPS_NONCE_LEN);
619         /* Registrar Nonce */
620         wpabuf_put_be16(msg, ATTR_REGISTRAR_NONCE);
621         wpabuf_put_be16(msg, WPS_NONCE_LEN);
622         wpabuf_put(msg, WPS_NONCE_LEN);
623         return msg;
624 }
625
626
627 /* subscription_first_event -- send format/queue event that is automatically
628  * sent on a new subscription.
629  */
630 static int subscription_first_event(struct subscription *s)
631 {
632         /*
633          * Actually, utf-8 is the default, but it doesn't hurt to specify it.
634          *
635          * APStatus is apparently a bit set,
636          * 0x1 = configuration change (but is always set?)
637          * 0x10 = ap is locked
638          *
639          * Per UPnP spec, we send out the last value of each variable, even
640          * for WLANEvent, whatever it was.
641          */
642         char *wlan_event;
643         struct wpabuf *buf;
644         int ap_status = 1;      /* TODO: add 0x10 if access point is locked */
645         const char *head =
646                 "<?xml version=\"1.0\" encoding=\"utf-8\"?>\n"
647                 "<e:propertyset xmlns:e=\"urn:schemas-upnp-org:event-1-0\">\n";
648         const char *tail = "</e:propertyset>\n";
649         char txt[10];
650
651         if (s->sm->wlanevent == NULL) {
652                 /*
653                  * There has been no events before the subscription. However,
654                  * UPnP device architecture specification requires all the
655                  * evented variables to be included, so generate a dummy event
656                  * for this particular case using a WSC_ACK and all-zeros
657                  * nonces. The ER (UPnP control point) will ignore this, but at
658                  * least it will learn that WLANEvent variable will be used in
659                  * event notifications in the future.
660                  */
661                 struct wpabuf *msg;
662                 wpa_printf(MSG_DEBUG, "WPS UPnP: Use a fake WSC_ACK as the "
663                            "initial WLANEvent");
664                 msg = build_fake_wsc_ack();
665                 if (msg) {
666                         s->sm->wlanevent = (char *)
667                                 base64_encode(wpabuf_head(msg),
668                                               wpabuf_len(msg), NULL);
669                         wpabuf_free(msg);
670                 }
671         }
672
673         wlan_event = s->sm->wlanevent;
674         if (wlan_event == NULL || *wlan_event == '\0') {
675                 wpa_printf(MSG_DEBUG, "WPS UPnP: WLANEvent not known for "
676                            "initial event message");
677                 wlan_event = "";
678         }
679         buf = wpabuf_alloc(500 + os_strlen(wlan_event));
680         if (buf == NULL)
681                 return 1;
682
683         wpabuf_put_str(buf, head);
684         wpabuf_put_property(buf, "STAStatus", "1");
685         os_snprintf(txt, sizeof(txt), "%d", ap_status);
686         wpabuf_put_property(buf, "APStatus", txt);
687         if (*wlan_event)
688                 wpabuf_put_property(buf, "WLANEvent", wlan_event);
689         wpabuf_put_str(buf, tail);
690
691         if (event_add(s, buf)) {
692                 wpabuf_free(buf);
693                 return 1;
694         }
695         wpabuf_free(buf);
696
697         return 0;
698 }
699
700
701 /**
702  * subscription_start - Remember a UPnP control point to send events to.
703  * @sm: WPS UPnP state machine from upnp_wps_device_init()
704  * @callback_urls: Callback URLs
705  * Returns: %NULL on error, or pointer to new subscription structure.
706  */
707 struct subscription * subscription_start(struct upnp_wps_device_sm *sm,
708                                          const char *callback_urls)
709 {
710         struct subscription *s;
711         time_t now = time(NULL);
712         time_t expire = now + UPNP_SUBSCRIBE_SEC;
713
714         /* Get rid of expired subscriptions so we have room */
715         subscription_list_age(sm, now);
716
717         /* If too many subscriptions, remove oldest */
718         if (sm->n_subscriptions >= MAX_SUBSCRIPTIONS) {
719                 s = sm->subscriptions;
720                 wpa_printf(MSG_INFO, "WPS UPnP: Too many subscriptions, "
721                            "trashing oldest");
722                 subscription_unlink(s);
723                 subscription_destroy(s);
724         }
725
726         s = os_zalloc(sizeof(*s));
727         if (s == NULL)
728                 return NULL;
729         dl_list_init(&s->addr_list);
730
731         s->sm = sm;
732         s->timeout_time = expire;
733         uuid_make(s->uuid);
734         subscr_addr_list_create(s, callback_urls);
735         /* Add to end of list, since it has the highest expiration time */
736         subscription_link_to_end(s);
737         /* Queue up immediate event message (our last event)
738          * as required by UPnP spec.
739          */
740         if (subscription_first_event(s)) {
741                 wpa_printf(MSG_INFO, "WPS UPnP: Dropping subscriber due to "
742                            "event backlog");
743                 subscription_unlink(s);
744                 subscription_destroy(s);
745                 return NULL;
746         }
747         wpa_printf(MSG_DEBUG, "WPS UPnP: Subscription %p started with %s",
748                    s, callback_urls);
749         /* Schedule sending this */
750         event_send_all_later(sm);
751         return s;
752 }
753
754
755 /* subscription_renew -- find subscription and reset timeout */
756 struct subscription * subscription_renew(struct upnp_wps_device_sm *sm,
757                                          const u8 uuid[UUID_LEN])
758 {
759         time_t now = time(NULL);
760         time_t expire = now + UPNP_SUBSCRIBE_SEC;
761         struct subscription *s = subscription_find(sm, uuid);
762         if (s == NULL)
763                 return NULL;
764         wpa_printf(MSG_DEBUG, "WPS UPnP: Subscription renewed");
765         subscription_unlink(s);
766         s->timeout_time = expire;
767         /* add back to end of list, since it now has highest expiry */
768         subscription_link_to_end(s);
769         return s;
770 }
771
772
773 /**
774  * upnp_wps_device_send_wlan_event - Event notification
775  * @sm: WPS UPnP state machine from upnp_wps_device_init()
776  * @from_mac_addr: Source (Enrollee) MAC address for the event
777  * @ev_type: Event type
778  * @msg: Event data
779  * Returns: 0 on success, -1 on failure
780  *
781  * Tell external Registrars (UPnP control points) that something happened. In
782  * particular, events include WPS messages from clients that are proxied to
783  * external Registrars.
784  */
785 int upnp_wps_device_send_wlan_event(struct upnp_wps_device_sm *sm,
786                                     const u8 from_mac_addr[ETH_ALEN],
787                                     enum upnp_wps_wlanevent_type ev_type,
788                                     const struct wpabuf *msg)
789 {
790         int ret = -1;
791         char type[2];
792         const u8 *mac = from_mac_addr;
793         char mac_text[18];
794         u8 *raw = NULL;
795         size_t raw_len;
796         char *val;
797         size_t val_len;
798         int pos = 0;
799
800         if (!sm)
801                 goto fail;
802
803         os_snprintf(type, sizeof(type), "%1u", ev_type);
804
805         raw_len = 1 + 17 + (msg ? wpabuf_len(msg) : 0);
806         raw = os_zalloc(raw_len);
807         if (!raw)
808                 goto fail;
809
810         *(raw + pos) = (u8) ev_type;
811         pos += 1;
812         os_snprintf(mac_text, sizeof(mac_text), MACSTR, MAC2STR(mac));
813         wpa_printf(MSG_DEBUG, "WPS UPnP: Proxying WLANEvent from %s",
814                    mac_text);
815         os_memcpy(raw + pos, mac_text, 17);
816         pos += 17;
817         if (msg) {
818                 os_memcpy(raw + pos, wpabuf_head(msg), wpabuf_len(msg));
819                 pos += wpabuf_len(msg);
820         }
821         raw_len = pos;
822
823         val = (char *) base64_encode(raw, raw_len, &val_len);
824         if (val == NULL)
825                 goto fail;
826
827         os_free(sm->wlanevent);
828         sm->wlanevent = val;
829         upnp_wps_device_send_event(sm);
830
831         ret = 0;
832
833 fail:
834         os_free(raw);
835
836         return ret;
837 }
838
839
840 #ifdef __FreeBSD__
841 #include <sys/sysctl.h>
842 #include <net/route.h>
843 #include <net/if_dl.h>
844
845 static int eth_get(const char *device, u8 ea[ETH_ALEN])
846 {
847         struct if_msghdr *ifm;
848         struct sockaddr_dl *sdl;
849         u_char *p, *buf;
850         size_t len;
851         int mib[] = { CTL_NET, AF_ROUTE, 0, AF_LINK, NET_RT_IFLIST, 0 };
852
853         if (sysctl(mib, 6, NULL, &len, NULL, 0) < 0)
854                 return -1;
855         if ((buf = os_malloc(len)) == NULL)
856                 return -1;
857         if (sysctl(mib, 6, buf, &len, NULL, 0) < 0) {
858                 os_free(buf);
859                 return -1;
860         }
861         for (p = buf; p < buf + len; p += ifm->ifm_msglen) {
862                 ifm = (struct if_msghdr *)p;
863                 sdl = (struct sockaddr_dl *)(ifm + 1);
864                 if (ifm->ifm_type != RTM_IFINFO ||
865                     (ifm->ifm_addrs & RTA_IFP) == 0)
866                         continue;
867                 if (sdl->sdl_family != AF_LINK || sdl->sdl_nlen == 0 ||
868                     os_memcmp(sdl->sdl_data, device, sdl->sdl_nlen) != 0)
869                         continue;
870                 os_memcpy(ea, LLADDR(sdl), sdl->sdl_alen);
871                 break;
872         }
873         os_free(buf);
874
875         if (p >= buf + len) {
876                 errno = ESRCH;
877                 return -1;
878         }
879         return 0;
880 }
881 #endif /* __FreeBSD__ */
882
883
884 /**
885  * get_netif_info - Get hw and IP addresses for network device
886  * @net_if: Selected network interface name
887  * @ip_addr: Buffer for returning IP address in network byte order
888  * @ip_addr_text: Buffer for returning a pointer to allocated IP address text
889  * @mac: Buffer for returning MAC address
890  * @mac_addr_text: Buffer for returning allocated MAC address text
891  * Returns: 0 on success, -1 on failure
892  */
893 int get_netif_info(const char *net_if, unsigned *ip_addr, char **ip_addr_text,
894                    u8 mac[ETH_ALEN], char **mac_addr_text)
895 {
896         struct ifreq req;
897         int sock = -1;
898         struct sockaddr_in *addr;
899         struct in_addr in_addr;
900
901         *ip_addr_text = os_zalloc(16);
902         *mac_addr_text = os_zalloc(18);
903         if (*ip_addr_text == NULL || *mac_addr_text == NULL)
904                 goto fail;
905
906         sock = socket(AF_INET, SOCK_DGRAM, 0);
907         if (sock < 0)
908                 goto fail;
909
910         os_strlcpy(req.ifr_name, net_if, sizeof(req.ifr_name));
911         if (ioctl(sock, SIOCGIFADDR, &req) < 0) {
912                 wpa_printf(MSG_ERROR, "WPS UPnP: SIOCGIFADDR failed: %d (%s)",
913                            errno, strerror(errno));
914                 goto fail;
915         }
916         addr = (void *) &req.ifr_addr;
917         *ip_addr = addr->sin_addr.s_addr;
918         in_addr.s_addr = *ip_addr;
919         os_snprintf(*ip_addr_text, 16, "%s", inet_ntoa(in_addr));
920
921 #ifdef __linux__
922         os_strlcpy(req.ifr_name, net_if, sizeof(req.ifr_name));
923         if (ioctl(sock, SIOCGIFHWADDR, &req) < 0) {
924                 wpa_printf(MSG_ERROR, "WPS UPnP: SIOCGIFHWADDR failed: "
925                            "%d (%s)", errno, strerror(errno));
926                 goto fail;
927         }
928         os_memcpy(mac, req.ifr_addr.sa_data, 6);
929 #elif defined(__FreeBSD__)
930         if (eth_get(net_if, mac) < 0) {
931                 wpa_printf(MSG_ERROR, "WPS UPnP: Failed to get MAC address");
932                 goto fail;
933         }
934 #else
935 #error MAC address fetch not implemented
936 #endif
937         os_snprintf(*mac_addr_text, 18, MACSTR, MAC2STR(mac));
938
939         close(sock);
940         return 0;
941
942 fail:
943         if (sock >= 0)
944                 close(sock);
945         os_free(*ip_addr_text);
946         *ip_addr_text = NULL;
947         os_free(*mac_addr_text);
948         *mac_addr_text = NULL;
949         return -1;
950 }
951
952
953 /**
954  * upnp_wps_device_stop - Stop WPS UPnP operations on an interface
955  * @sm: WPS UPnP state machine from upnp_wps_device_init()
956  */
957 void upnp_wps_device_stop(struct upnp_wps_device_sm *sm)
958 {
959         if (!sm || !sm->started)
960                 return;
961
962         wpa_printf(MSG_DEBUG, "WPS UPnP: Stop device");
963         web_listener_stop(sm);
964         while (sm->msearch_replies)
965                 msearchreply_state_machine_stop(sm->msearch_replies);
966         while (sm->subscriptions)  {
967                 struct subscription *s = sm->subscriptions;
968                 subscription_unlink(s);
969                 subscription_destroy(s);
970         }
971
972         advertisement_state_machine_stop(sm, 1);
973
974         event_send_stop_all(sm);
975         os_free(sm->wlanevent);
976         sm->wlanevent = NULL;
977         os_free(sm->net_if);
978         sm->net_if = NULL;
979         os_free(sm->mac_addr_text);
980         sm->mac_addr_text = NULL;
981         os_free(sm->ip_addr_text);
982         sm->ip_addr_text = NULL;
983         if (sm->multicast_sd >= 0)
984                 close(sm->multicast_sd);
985         sm->multicast_sd = -1;
986         ssdp_listener_stop(sm);
987
988         sm->started = 0;
989 }
990
991
992 /**
993  * upnp_wps_device_start - Start WPS UPnP operations on an interface
994  * @sm: WPS UPnP state machine from upnp_wps_device_init()
995  * @net_if: Selected network interface name
996  * Returns: 0 on success, -1 on failure
997  */
998 int upnp_wps_device_start(struct upnp_wps_device_sm *sm, char *net_if)
999 {
1000         if (!sm || !net_if)
1001                 return -1;
1002
1003         if (sm->started)
1004                 upnp_wps_device_stop(sm);
1005
1006         sm->net_if = strdup(net_if);
1007         sm->multicast_sd = -1;
1008         sm->ssdp_sd = -1;
1009         sm->started = 1;
1010         sm->advertise_count = 0;
1011
1012         /* Fix up linux multicast handling */
1013         if (add_ssdp_network(net_if))
1014                 goto fail;
1015
1016         /* Determine which IP and mac address we're using */
1017         if (get_netif_info(net_if,
1018                            &sm->ip_addr, &sm->ip_addr_text,
1019                            sm->mac_addr, &sm->mac_addr_text)) {
1020                 wpa_printf(MSG_INFO, "WPS UPnP: Could not get IP/MAC address "
1021                            "for %s. Does it have IP address?", net_if);
1022                 goto fail;
1023         }
1024
1025         /* Listen for incoming TCP connections so that others
1026          * can fetch our "xml files" from us.
1027          */
1028         if (web_listener_start(sm))
1029                 goto fail;
1030
1031         /* Set up for receiving discovery (UDP) packets */
1032         if (ssdp_listener_start(sm))
1033                 goto fail;
1034
1035         /* Set up for sending multicast */
1036         if (ssdp_open_multicast(sm) < 0)
1037                 goto fail;
1038
1039         /*
1040          * Broadcast NOTIFY messages to let the world know we exist.
1041          * This is done via a state machine since the messages should not be
1042          * all sent out at once.
1043          */
1044         if (advertisement_state_machine_start(sm))
1045                 goto fail;
1046
1047         return 0;
1048
1049 fail:
1050         upnp_wps_device_stop(sm);
1051         return -1;
1052 }
1053
1054
1055 /**
1056  * upnp_wps_device_deinit - Deinitialize WPS UPnP
1057  * @sm: WPS UPnP state machine from upnp_wps_device_init()
1058  */
1059 void upnp_wps_device_deinit(struct upnp_wps_device_sm *sm)
1060 {
1061         if (!sm)
1062                 return;
1063
1064         upnp_wps_device_stop(sm);
1065
1066         if (sm->peer.wps)
1067                 wps_deinit(sm->peer.wps);
1068         os_free(sm->root_dir);
1069         os_free(sm->desc_url);
1070         os_free(sm->ctx->ap_pin);
1071         os_free(sm->ctx);
1072         os_free(sm);
1073 }
1074
1075
1076 /**
1077  * upnp_wps_device_init - Initialize WPS UPnP
1078  * @ctx: callback table; we must eventually free it
1079  * @wps: Pointer to longterm WPS context
1080  * @priv: External context data that will be used in callbacks
1081  * Returns: WPS UPnP state or %NULL on failure
1082  */
1083 struct upnp_wps_device_sm *
1084 upnp_wps_device_init(struct upnp_wps_device_ctx *ctx, struct wps_context *wps,
1085                      void *priv)
1086 {
1087         struct upnp_wps_device_sm *sm;
1088
1089         sm = os_zalloc(sizeof(*sm));
1090         if (!sm) {
1091                 wpa_printf(MSG_ERROR, "WPS UPnP: upnp_wps_device_init failed");
1092                 return NULL;
1093         }
1094
1095         sm->ctx = ctx;
1096         sm->wps = wps;
1097         sm->priv = priv;
1098
1099         return sm;
1100 }
1101
1102
1103 /**
1104  * upnp_wps_subscribers - Check whether there are any event subscribers
1105  * @sm: WPS UPnP state machine from upnp_wps_device_init()
1106  * Returns: 0 if no subscribers, 1 if subscribers
1107  */
1108 int upnp_wps_subscribers(struct upnp_wps_device_sm *sm)
1109 {
1110         return sm->subscriptions != NULL;
1111 }