2 * Wi-Fi Protected Setup - External Registrar (SSDP)
3 * Copyright (c) 2009, Jouni Malinen <j@w1.fi>
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
9 * Alternatively, this software may be distributed under the terms of BSD
12 * See README and COPYING for more details.
22 #include "wps_upnp_i.h"
26 static void wps_er_ssdp_rx(int sd, void *eloop_ctx, void *sock_ctx)
28 struct wps_er *er = eloop_ctx;
29 struct sockaddr_in addr; /* client address */
32 char buf[MULTICAST_MAX_READ], *pos, *pos2, *start;
33 int wfa = 0, byebye = 0;
35 char *location = NULL;
36 u8 uuid[WPS_UUID_LEN];
38 addr_len = sizeof(addr);
39 nread = recvfrom(sd, buf, sizeof(buf) - 1, 0,
40 (struct sockaddr *) &addr, &addr_len);
44 if (er->filter_addr.s_addr &&
45 er->filter_addr.s_addr != addr.sin_addr.s_addr)
48 wpa_printf(MSG_DEBUG, "WPS ER: Received SSDP from %s",
49 inet_ntoa(addr.sin_addr));
50 wpa_hexdump_ascii(MSG_MSGDUMP, "WPS ER: Received SSDP contents",
53 if (sd == er->multicast_sd) {
54 /* Reply to M-SEARCH */
55 if (os_strncmp(buf, "HTTP/1.1 200 OK", 15) != 0)
56 return; /* unexpected response header */
58 /* Unsolicited message (likely NOTIFY or M-SEARCH) */
59 if (os_strncmp(buf, "NOTIFY ", 7) != 0)
60 return; /* only process notifications */
63 os_memset(uuid, 0, sizeof(uuid));
65 for (start = buf; start && *start; start = pos) {
66 pos = os_strchr(start, '\n');
72 if (os_strstr(start, "schemas-wifialliance-org:device:"
75 if (os_strstr(start, "schemas-wifialliance-org:service:"
78 if (os_strncasecmp(start, "LOCATION:", 9) == 0) {
83 } else if (os_strncasecmp(start, "NTS:", 4) == 0) {
84 if (os_strstr(start, "ssdp:byebye"))
86 } else if (os_strncasecmp(start, "CACHE-CONTROL:", 14) == 0) {
90 pos2 = os_strstr(start, "max-age=");
95 } else if (os_strncasecmp(start, "USN:", 4) == 0) {
97 pos2 = os_strstr(start, "uuid:");
102 if (uuid_str2bin(pos2, uuid) < 0) {
103 wpa_printf(MSG_DEBUG, "WPS ER: "
104 "Invalid UUID in USN: %s",
113 return; /* Not WPS advertisement/reply */
116 wps_er_ap_remove(er, &addr.sin_addr);
121 return; /* Unknown location */
124 return; /* No max-age reported */
126 wpa_printf(MSG_DEBUG, "WPS ER: AP discovered: %s "
127 "(packet source: %s max-age: %d)",
128 location, inet_ntoa(addr.sin_addr), max_age);
130 wps_er_ap_add(er, uuid, &addr.sin_addr, location, max_age);
134 void wps_er_send_ssdp_msearch(struct wps_er *er)
137 struct sockaddr_in dest;
139 msg = wpabuf_alloc(500);
144 "M-SEARCH * HTTP/1.1\r\n"
145 "HOST: 239.255.255.250:1900\r\n"
146 "MAN: \"ssdp:discover\"\r\n"
148 "ST: urn:schemas-wifialliance-org:device:WFADevice:1"
152 os_memset(&dest, 0, sizeof(dest));
153 dest.sin_family = AF_INET;
154 dest.sin_addr.s_addr = inet_addr(UPNP_MULTICAST_ADDRESS);
155 dest.sin_port = htons(UPNP_MULTICAST_PORT);
157 if (sendto(er->multicast_sd, wpabuf_head(msg), wpabuf_len(msg), 0,
158 (struct sockaddr *) &dest, sizeof(dest)) < 0)
159 wpa_printf(MSG_DEBUG, "WPS ER: M-SEARCH sendto failed: "
160 "%d (%s)", errno, strerror(errno));
166 int wps_er_ssdp_init(struct wps_er *er)
168 if (add_ssdp_network(er->ifname)) {
169 wpa_printf(MSG_INFO, "WPS ER: Failed to add routing entry for "
174 er->multicast_sd = ssdp_open_multicast_sock(er->ip_addr);
175 if (er->multicast_sd < 0) {
176 wpa_printf(MSG_INFO, "WPS ER: Failed to open multicast socket "
181 er->ssdp_sd = ssdp_listener_open();
182 if (er->ssdp_sd < 0) {
183 wpa_printf(MSG_INFO, "WPS ER: Failed to open SSDP listener "
188 if (eloop_register_sock(er->multicast_sd, EVENT_TYPE_READ,
189 wps_er_ssdp_rx, er, NULL) ||
190 eloop_register_sock(er->ssdp_sd, EVENT_TYPE_READ,
191 wps_er_ssdp_rx, er, NULL))
194 wps_er_send_ssdp_msearch(er);
200 void wps_er_ssdp_deinit(struct wps_er *er)
202 if (er->multicast_sd >= 0) {
203 eloop_unregister_sock(er->multicast_sd, EVENT_TYPE_READ);
204 close(er->multicast_sd);
206 if (er->ssdp_sd >= 0) {
207 eloop_unregister_sock(er->ssdp_sd, EVENT_TYPE_READ);