2 * Wi-Fi Protected Setup - External Registrar (SSDP)
3 * Copyright (c) 2009, Jouni Malinen <j@w1.fi>
5 * This software may be distributed under the terms of the BSD license.
6 * See README for more details.
16 #include "wps_upnp_i.h"
20 static void wps_er_ssdp_rx(int sd, void *eloop_ctx, void *sock_ctx)
22 struct wps_er *er = eloop_ctx;
23 struct sockaddr_in addr; /* client address */
26 char buf[MULTICAST_MAX_READ], *pos, *pos2, *start;
27 int wfa = 0, byebye = 0;
29 char *location = NULL;
30 u8 uuid[WPS_UUID_LEN];
32 addr_len = sizeof(addr);
33 nread = recvfrom(sd, buf, sizeof(buf) - 1, 0,
34 (struct sockaddr *) &addr, &addr_len);
38 if (er->filter_addr.s_addr &&
39 er->filter_addr.s_addr != addr.sin_addr.s_addr)
42 wpa_printf(MSG_DEBUG, "WPS ER: Received SSDP from %s",
43 inet_ntoa(addr.sin_addr));
44 wpa_hexdump_ascii(MSG_MSGDUMP, "WPS ER: Received SSDP contents",
47 if (sd == er->multicast_sd) {
48 /* Reply to M-SEARCH */
49 if (os_strncmp(buf, "HTTP/1.1 200 OK", 15) != 0)
50 return; /* unexpected response header */
52 /* Unsolicited message (likely NOTIFY or M-SEARCH) */
53 if (os_strncmp(buf, "NOTIFY ", 7) != 0)
54 return; /* only process notifications */
57 os_memset(uuid, 0, sizeof(uuid));
59 for (start = buf; start && *start; start = pos) {
60 pos = os_strchr(start, '\n');
66 if (os_strstr(start, "schemas-wifialliance-org:device:"
69 if (os_strstr(start, "schemas-wifialliance-org:service:"
72 if (os_strncasecmp(start, "LOCATION:", 9) == 0) {
77 } else if (os_strncasecmp(start, "NTS:", 4) == 0) {
78 if (os_strstr(start, "ssdp:byebye"))
80 } else if (os_strncasecmp(start, "CACHE-CONTROL:", 14) == 0) {
84 pos2 = os_strstr(start, "max-age=");
89 } else if (os_strncasecmp(start, "USN:", 4) == 0) {
91 pos2 = os_strstr(start, "uuid:");
96 if (uuid_str2bin(pos2, uuid) < 0) {
97 wpa_printf(MSG_DEBUG, "WPS ER: "
98 "Invalid UUID in USN: %s",
107 return; /* Not WPS advertisement/reply */
110 wps_er_ap_cache_settings(er, &addr.sin_addr);
111 wps_er_ap_remove(er, &addr.sin_addr);
116 return; /* Unknown location */
119 return; /* No max-age reported */
121 wpa_printf(MSG_DEBUG, "WPS ER: AP discovered: %s "
122 "(packet source: %s max-age: %d)",
123 location, inet_ntoa(addr.sin_addr), max_age);
125 wps_er_ap_add(er, uuid, &addr.sin_addr, location, max_age);
129 void wps_er_send_ssdp_msearch(struct wps_er *er)
132 struct sockaddr_in dest;
134 msg = wpabuf_alloc(500);
139 "M-SEARCH * HTTP/1.1\r\n"
140 "HOST: 239.255.255.250:1900\r\n"
141 "MAN: \"ssdp:discover\"\r\n"
143 "ST: urn:schemas-wifialliance-org:device:WFADevice:1"
147 os_memset(&dest, 0, sizeof(dest));
148 dest.sin_family = AF_INET;
149 dest.sin_addr.s_addr = inet_addr(UPNP_MULTICAST_ADDRESS);
150 dest.sin_port = htons(UPNP_MULTICAST_PORT);
152 if (sendto(er->multicast_sd, wpabuf_head(msg), wpabuf_len(msg), 0,
153 (struct sockaddr *) &dest, sizeof(dest)) < 0)
154 wpa_printf(MSG_DEBUG, "WPS ER: M-SEARCH sendto failed: "
155 "%d (%s)", errno, strerror(errno));
161 int wps_er_ssdp_init(struct wps_er *er)
163 if (add_ssdp_network(er->ifname)) {
164 wpa_printf(MSG_INFO, "WPS ER: Failed to add routing entry for "
169 er->multicast_sd = ssdp_open_multicast_sock(er->ip_addr);
170 if (er->multicast_sd < 0) {
171 wpa_printf(MSG_INFO, "WPS ER: Failed to open multicast socket "
176 er->ssdp_sd = ssdp_listener_open();
177 if (er->ssdp_sd < 0) {
178 wpa_printf(MSG_INFO, "WPS ER: Failed to open SSDP listener "
183 if (eloop_register_sock(er->multicast_sd, EVENT_TYPE_READ,
184 wps_er_ssdp_rx, er, NULL) ||
185 eloop_register_sock(er->ssdp_sd, EVENT_TYPE_READ,
186 wps_er_ssdp_rx, er, NULL))
189 wps_er_send_ssdp_msearch(er);
195 void wps_er_ssdp_deinit(struct wps_er *er)
197 if (er->multicast_sd >= 0) {
198 eloop_unregister_sock(er->multicast_sd, EVENT_TYPE_READ);
199 close(er->multicast_sd);
201 if (er->ssdp_sd >= 0) {
202 eloop_unregister_sock(er->ssdp_sd, EVENT_TYPE_READ);