octonet/octoserve/ssdp.c

/*  
    (C) 2012-14 Digital Devices GmbH. 

    This file is part of the octoserve SAT>IP server.

    Octoserve is free software: you can redistribute it and/or modify
    it under the terms of the GNU General Public License as published by
    the Free Software Foundation, either version 3 of the License, or
    (at your option) any later version.

    Octoserve is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU General Public License for more details.

    You should have received a copy of the GNU General Public License
    along with octoserve.  If not, see <http://www.gnu.org/licenses/>.
*/

#include "octoserve.h"

extern struct rtsp_error rtsp_errors;

extern uint32_t debug;

static void ssdp_reset_setup(struct os_ssdp *ss)
{
	ss->setup = 0;
	mtime(&ss->setupt);
	ss->setupt += 5;
	mtime(&ss->annt);
}

static int read_id(char *type, uint32_t *id)
{
	int fd, len;
	char name[80];

	len = snprintf(name, 80, "/config/%s.id", type);
	if (len < 0 || len == 80) 
		return -1;
	fd = open(name, O_RDONLY);
	if (fd < 0)
		return -1;
	printf("read id from %s\n", name);
	len = read(fd, name, 80);
	name[len] = 0;
	*id = strtol(name, NULL, 10);
	printf("%s.id = %d\n", type, *id);
	return 0;
}

static int write_id(char *type, uint32_t id)
{
	int fd, len;
	char name[80];

	len = snprintf(name, 80, "/config/%s.id", type);
	if (len < 0 || len == 80) 
		return -1;
	fd = open(name, O_WRONLY|O_CREAT|O_TRUNC, 00644);
	if (fd < 0)
		return -1;
	printf("write id = %d to %s\n", id, name);
	len = snprintf(name, 80, "%d", id);
	write(fd, name, len);
	close(fd);
	return 0;
}

static int ssdp_msg(struct os_ssdp *ss, char *buf, int n, int notify, int nr, int v6, int send_id)
{
	int len;
	uint8_t *u = ss->uuid;
	char uuid[37];
	char *header = notify ? 
		"NOTIFY * HTTP/1.1\r\nHOST: 239.255.255.250:1900\r\n" :
		"HTTP/1.1 200 OK\r\n";
	char id[32];

	if (send_id) {
		len = snprintf(id, sizeof(id), 
			       "DEVICEID.SES.COM: %d",
			       ss->devid);
		if (len < 0  || len >= sizeof(id)) 
			return -1;
	} else
		id[0] = 0;

	if (ss->alive) {
		len = snprintf(buf, n, 
			       "%s"
			       "CACHE-CONTROL: max-age=1800\r\n"
			       "LOCATION: http://%s%s\r\n"
			       "NT: %s\r\n"
			       "NTS: ssdp:%s\r\n"
			       "SERVER: %s\r\n"
			       "USN: %s%s%s\r\n"
			       "BOOTID.UPNP.ORG: %d\r\n"
			       "CONFIGID.UPNP.ORG: %d\r\n"
			       "%s\r\n"
			       "\r\n",
			       header,
			       v6 ? ss->ip6 : ss->ip,
			       ss->dev[nr].loc,
			       ss->dev[nr].nt[0] ? ss->dev[nr].nt : ss->dev[nr].uuid,
			       "alive",
			       ss->dev[nr].server,
			       ss->dev[nr].uuid, ss->dev[nr].nt[0] ? "::" : "", ss->dev[nr].nt, 
			       ss->bootid, ss->configid,
			       id
			);
	} else {
		dbgprintf(DEBUG_SSDP, "BYEBYE\n");
				
		len = snprintf(buf, n, 
			       "%s"
			       "NT: %s\r\n"
			       "NTS: ssdp:byebye\r\n"
			       "USN: %s%s%s\r\n"
			       "BOOTID.UPNP.ORG: %d\r\n"
			       "CONFIGID.UPNP.ORG: %d\r\n"
			       "\r\n",
			       header,
			       ss->dev[nr].nt[0] ? ss->dev[nr].nt : ss->dev[nr].uuid,
			       ss->dev[nr].uuid, ss->dev[nr].nt[0] ? "::" : "", ss->dev[nr].nt, 
			       ss->bootid, ss->configid
			);

	}
	return len;
}

static int sendto_port(int sock, const void *buf, size_t len,
		       struct sockaddr *cadr, uint16_t port)
{
	struct sockaddr_in adr;
	int r;

	/*adr = *((struct sockaddr_in *) cadr); */
	/* struct assignment seem to be broken in arm gcc 4.5.4?!? */
	memcpy(&adr, cadr, sizeof(adr));
	adr.sin_port = htons(port);
	r = sendto(sock, buf, len, 0, (struct sockaddr *) &adr, sizeof(adr));
	//dbgprintf(DEBUG_SSDP, "sent to port %u, family %u, ret=%d errno=%d\n", port, adr.sin_family, r, errno);
	return r;
}

static int send_ssdp_msg(struct os_ssdp *ss, int nr, int notify)
{
	uint8_t buf[2048];
	int len;
	
	len = ssdp_msg(ss, buf, sizeof(buf), notify, nr, 0, nr < 3);
	
	if (len < 0  || len >= sizeof(buf))
		return -1;
	if (notify) {
		struct sockaddr_in insadr;

		memset(&insadr, 0, sizeof(insadr));
		insadr.sin_family = AF_INET;
		insadr.sin_port = htons(1900);
		insadr.sin_addr.s_addr = inet_addr("239.255.255.250");
		return sendto(ss->sock, buf, len, 0, (struct sockaddr *) &insadr, sizeof(insadr));
	} else 
		return sendto(ss->sock, buf, len, 0, &ss->cadr, sizeof(struct sockaddr));
}

static int ssdp_announce(struct octoserve *os, int alive, int notify)
{
	struct os_ssdp *ss = &os->ssdp;
	uint8_t buf[2048];
	int len, nr, res;
	int s = os->ssdp.sock;
	uint8_t *u = ss->uuid;
	time_t t;

	if (notify) {
		mtime(&t);
		if (!ss->setup)
			if (t >= ss->setupt) {
				ss->setup = 1;
				dbgprintf(DEBUG_SSDP, "END SSDP SETUP\n");
			}
		if (ss->alive == alive && t  < ss->annt)
			return 0;
		ss->alive = alive;
		ss->annt = t + 900;  //FIXME: +/- random
	}
	for (nr = 0; nr < ss->dev_num; nr++) {
		send_ssdp_msg(ss, nr, notify);
	}
}

static int ssdp_defend(struct os_ssdp *ss)
{
	char buf[2048], host[64];
	int len;
	int s = ss->v6 ? ss->sock6 : ss->sock;

	sockname(&ss->cadr, host);
	dbgprintf(DEBUG_SSDP, "defend against HOST:%s\n", host);

	len = snprintf(buf, sizeof(buf), 
		       "M-SEARCH * HTTP/1.1\r\n"
		       "HOST: %s:1900\r\n"
		       "MAN: \"ssdp:discover\"\r\n"
		       "ST: urn:ses-com:device:SatIPServer:1\r\n"
		       "USER-AGENT: %s\r\n"
		       "DEVICEID.SES.COM: %d\r\n"
		       "\r\n",
		       ss->v6 ? ss->ip6 : ss->ip,
		       ss->server,
		       ss->devid);
	if (len < 0  || len >= sizeof(buf)) 
		return -1;
	//return sendto(s, buf, len, 0, &ss->cadr, sizeof(ss->cadr));
	return sendto_port(ss->sock, buf, len, &ss->cadr, ss->csport);
}

static int send_reply_msearch(struct os_ssdp *ss, int mc, int send_id, int nr)
{
	char buf[2048], id[32];
	int len, res;
	int v6 = ss->v6;
	int s = v6 ? ss->sock6 : ss->sock;

	dbgprintf(DEBUG_SSDP, "send msearch reply nr=%d\n", nr);		
	if (send_id) {
		len = snprintf(id, sizeof(id), 
			       "DEVICEID.SES.COM: %d\r\n",
			       ss->devid);
		if (len < 0  || len >= sizeof(id)) 
			return -1;
	} else
		id[0] = 0;
	len = snprintf(buf, sizeof(buf), 
		       "HTTP/1.1 200 OK\r\n"
		       "CACHE-CONTROL: max-age=1800\r\n"
		       "EXT:\r\n"
		       "LOCATION: http://%s%s\r\n"
		       "SERVER: %s\r\n"
		       "ST: %s\r\n"
		       "USN: %s%s%s\r\n"
		       "BOOTID.UPNP.ORG: %d\r\n"
		       "CONFIGID.UPNP.ORG: %d\r\n"
		       "%s"
		       "\r\n",
		       ss->v6 ? ss->ip6 : ss->ip,
		       ss->dev[nr].loc,
		       ss->dev[nr].server,
		       ss->dev[nr].nt[0] ? ss->dev[nr].nt : ss->dev[nr].uuid,
		       ss->dev[nr].uuid, ss->dev[nr].nt[0] ? "::" : "", ss->dev[nr].nt, 
		       ss->bootid, ss->configid, id
		);
	if (len < 0  || len >= sizeof(buf)) 
		return -1;
	dbgprintf(DEBUG_SSDP, "sending:\n%s", buf);		
	if (mc) {
		struct sockaddr_in insadr;

		memset(&insadr, 0, sizeof(insadr));
		insadr.sin_family = AF_INET;
		insadr.sin_port = htons(1900);
		insadr.sin_addr.s_addr = inet_addr("239.255.255.250");
		res = sendto(s, buf, len, 0, (struct sockaddr *) &insadr, sizeof(insadr));
	} else 
	        res = sendto(s, buf, len, 0, &ss->cadr, sizeof(struct sockaddr));
	//res = sendto_port(s, buf, len, &ss->cadr, ss->csport);
	return res;
}

static int ssdp_msearch(struct os_ssdp *ss, int mc, char *st)
{
	int nr, len = strlen(st), type = 0;
	uint8_t *u = ss->uuid;

	if (!len)
		return 0;
	if (!strncasecmp(st, "ssdp:all", 8)) 
		type = 1;
	else if (!strncasecmp(st, "uuid:", 5))
		type = 2;
	dbgprintf(DEBUG_SSDP, "msearch mc=%u, st=%s (type=%u)\n", mc, st, type);
	
	for (nr = 0; nr < ss->dev_num; nr++) {
		if ((type == 1) || 
		    ((type == 2) && !ss->dev[nr].nt[0] &&
		     !strncasecmp(ss->dev[nr].uuid, st, len)) ||
		    ((type == 0) && !strncasecmp(ss->dev[nr].nt, st, len)))
			send_reply_msearch(ss, mc, nr < 3, nr);
	}
	return 0;
}

static void handle_ssdp(struct octoserve *os, char *m, int ml)
{
	struct os_ssdp *ss = &os->ssdp;
	int ln, ll, tl, as, al;
	char *l, *le, *me = m + ml, *st = NULL;
	int type = 0;
	int htype = 0;
	int devid = -1;
	int mx = -1;
	uint8_t uu[16];
	char host[64];
	char str[INET_ADDRSTRLEN];	
	int sport = 1900, hport = 1900;

	dbgprintf(DEBUG_SSDP, 
		  "\n********************************************************************************\n");
	inet_ntop(AF_INET, &((struct sockaddr_in *) &ss->cadr)->sin_addr, str, INET_ADDRSTRLEN);
	dbgprintf(DEBUG_SSDP, "\nSSDP: %s\n", str);

	memset(uu, 0, 16);

	for (l = m, ln = -1; l < me; l += ll + 1) {
		for (le = l; *le != '\r' && *le != '\n' && le < me; le++);
		ll = le - l;
		if (!ll) 
			continue;
		*le = 0;
		ln++;
		dbgprintf(DEBUG_SSDP, "%02d: %s\n", ln, l);
		if (ln == 0) {
			if (!strncasecmp(l, "M-SEARCH * HTTP/1.1", ll)) {
				type = 1;
				continue;
			}
			if (!strncasecmp(l, "NOTIFY * HTTP/1.1", ll)) {
				type = 2;
				continue;
			}
			if (!strncasecmp(l, "HTTP/1.1 200 OK", ll)) {
				type = 3;
				continue;
			}
			dbgprintf(DEBUG_SSDP, "unknown header\n");
			return;
		}
		for (tl = 0; tl < ll && l[tl] != ':'; tl++);
		if (tl == ll)
			continue;
		for (as = tl + 1; as < ll && isspace(l[as]); as++);
		al = ll - as;

		if (tl == 4 && !strncasecmp(l, "HOST", 4)) {
			char *h, *p;
			
			if (!strncmp(l + as, "239.255.255.250:1900", al)) 
				htype = 1;
			else {
				htype = 2;
				if (mx < 0)
					mx = 1;
			}
			h = host;
			p = l + as;
			while (*p && *p != ':')
				*(h++) = *(p++);
			*h = 0;
			p++;
			hport = atoi(p);
		}
		if (tl == 2 && !strncasecmp(l, "MX", tl)) {
			mx = atoi(l + as);
			continue;
		}
		if (tl == 2 && !strncasecmp(l, "ST", tl)) {
			st = l + as;
			continue;
		}
		if (tl == 16 && !memcmp(l, "DEVICEID.SES.COM", tl)) {
			devid = atoi(l + as);
			//dbgprintf(DEBUG_SSDP, "sat>ip device id %d\n", devid); 
			continue;
		}
		if (tl = 19 && !memcmp(l, "SEARCHPORT.UPNP.ORG", tl)) {
			sport = atoi(l + as);
			dbgprintf(DEBUG_SSDP, "searchport %d\n", sport); 
			continue;
		}
		if (tl == 3 && !memcmp(l, "USN", tl) && !memcmp(l+5, "uuid:", 5)) {
			int n;
			
			//printf("USN: %s\n", l+5);
			sscanf(l+10, "%2hhx%2hhx%2hhx%2hhx-%2hhx%2hhx-"
			       "%2hhx%2hhx-%2hhx%2hhx-%2hhx%2hhx%2hhx%2hhx%2hhx%2hhx%n",
			       &uu[0], &uu[1], &uu[2], &uu[3],
			       &uu[4], &uu[5], &uu[6], &uu[7],
			       &uu[8], &uu[9], &uu[10], &uu[11],
			       &uu[12], &uu[13], &uu[14], &uu[15], &n);
			/* ignore message from myself */
			if (!memcmp(uu, ss->uuid, 16))
				dbgprintf(DEBUG_SSDP, "that's me!\n");
			continue;
		}
	}
	ss->csport = sport;
	dbgprintf(DEBUG_SSDP, "host=%s, hport=%u, type=%d, htype=%d mx=%d\n",
		  host, hport, type, htype, mx); 
	/* M-SEARCH */
	if (ss->setup) {
		if (type == 1 && mx > 0 && st != NULL) {
			//ssdp_msearch(ss, htype == 2 ? 0 : 1, st);
			ssdp_msearch(ss, 0, st);
		}
		/* NOTIFY */
		if (type == 2 && devid == ss->devid && memcmp(uu, ss->uuid, 16))
			ssdp_defend(ss);
	} else {
		if (type == 1 && htype == 2 && ss->devid == devid) {
			send_reply_msearch(ss, 0, 1, 2);
			ss->devid++;
			write_id("device", ss->devid);
			dbgprintf(DEBUG_SSDP, "new device id %d \n", ss->devid);
			ssdp_reset_setup(ss);
		}
	}
}


#define SSDP_MCAST "239.255.255.250"
#define SSDP_MCAST_LL "FF02::C"
#define SSDP_MCAST_SL "FF05::C"

static int ssdp_mc_add(int s, const char *ifname, int add, int v6)
{
	if (v6)	{
		struct ipv6_mreq imr;
		unsigned int ifindex = if_nametoindex(ifname);

		memset(&imr, 0, sizeof(imr));
		inet_pton(AF_INET6, SSDP_MCAST_LL, &imr.ipv6mr_multiaddr);
		imr.ipv6mr_interface = ifindex;
		if (setsockopt(s, IPPROTO_IPV6, add ? IPV6_JOIN_GROUP : IPV6_LEAVE_GROUP,
			      &imr, sizeof(imr)) < 0)
			return -1;
		inet_pton(AF_INET6, SSDP_MCAST_SL, &imr.ipv6mr_multiaddr);
		if (setsockopt(s, IPPROTO_IPV6, add ? IPV6_JOIN_GROUP : IPV6_LEAVE_GROUP,
			      &imr, sizeof(imr)) < 0)
			return -1;
	} else {
		struct ip_mreq imr;
		struct sockaddr_in sadr;
		unsigned char ttl = 2, one = 1, zero = 0;

		get_ifa(ifname, AF_INET, (struct sockaddr *) &sadr);
		imr.imr_multiaddr.s_addr = inet_addr(SSDP_MCAST);
		imr.imr_interface.s_addr = sadr.sin_addr.s_addr;

		if (setsockopt(s, IPPROTO_IP, add ? IP_ADD_MEMBERSHIP : IP_DROP_MEMBERSHIP,
			       &imr, sizeof(imr)) < 0)
			return -1;
		setsockopt(s, IPPROTO_IP, IP_MULTICAST_TTL, &ttl, sizeof(ttl));
		//setsockopt(s, IPPROTO_IP, IP_MULTICAST_LOOP, &zero, sizeof(zero));
	}
	printf("mc_add OK\n");
	return 0;
}

static int ssdpsock(const char *ifnam, int family, struct sockaddr *sadr)
{
	int one=1, sock;
	struct addrinfo *ais, *ai, hints = {
		.ai_flags = AI_PASSIVE, 
		.ai_family = family,
		.ai_socktype = SOCK_DGRAM,
		.ai_protocol = 0,
		.ai_addrlen = 0,
		.ai_addr = sadr,
		.ai_canonname = NULL,
		.ai_next = NULL,
	};
	
	if (getaddrinfo(NULL, "1900", &hints, &ais) < 0)
		return -1;
	for (ai = ais; ai; ai = ai->ai_next)  {
		sock = socket(ai->ai_family, ai->ai_socktype, ai->ai_protocol);
		if (sock == -1)
			continue;
		//dump(ai->ai_addr, sizeof(*ai->ai_addr));
		if (!setsockopt(sock, SOL_SOCKET, SO_REUSEADDR, &one, sizeof(one)) &&
		    !bind(sock, ai->ai_addr, ai->ai_addrlen))
			break;
		close(sock);
	}
	freeaddrinfo(ais);
	ssdp_mc_add(sock, ifnam, 1, family == AF_INET6 ? 1 : 0);
	return sock;
}

static void add_fd(int fd, int *mfd, fd_set *fds)
{
	FD_SET(fd, fds);
	if (fd > *mfd)
		*mfd = fd;
}

static void ssdp_loop(struct octoserve *os)
{
	struct os_ssdp *ss = &os->ssdp;
	int num;
	int mfd;
	fd_set fds;
	struct timeval timeout;
	char buf[1501];

	ss->http_sock = streamsock("8888", AF_INET, &ss->http_sadr);
	if (listen(ss->http_sock, 10) < 0) {
		printf("listen error");
		return;
	}
	ssdp_reset_setup(ss);
	
	while (!os->exit) {
		ssdp_announce(os, 1, 1);

		timeout.tv_sec = 1;
		timeout.tv_usec = 0;

		FD_ZERO(&fds);
		mfd = 0;
		add_fd(ss->sock, &mfd, &fds);
		//add_fd(ss->sock6, &mfd, &fds);
		add_fd(ss->http_sock, &mfd, &fds);

		num = select(mfd + 1, &fds, NULL, NULL, &timeout);
		if (num < 0)
			break;
		if (FD_ISSET(ss->sock, &fds)) {
			socklen_t len;
			int n;

			len = sizeof(ss->cadr);
			n = recvfrom(ss->sock, buf, sizeof(buf) - 1, 0, &ss->cadr, &len);
			ss->v6 = 0;
			if (n > 0) 
				handle_ssdp(os, buf, n);
		}
		if (FD_ISSET(ss->http_sock, &fds)) {
			socklen_t len;
			pthread_t pt;
			
			//ss->csock = accept4(ss->http_sock, &ss->cadr, &len, SOCK_NONBLOCK);
			ss->csock = accept(ss->http_sock, &ss->cadr, &len);
			handle_http(ss);
		}
	}
	ssdp_announce(os, 0, 1);
}

static void ssdp_search(int s)
{
	struct sockaddr_in insadr;
	char ms[] = "M-SEARCH * HTTP/1.1\r\nHOST: 239.255.255.250:1900\r\n"
		"MAN: \"ssdp:discover\"\r\nMX: 5\r\nST: ssdp:all\r\n\r\n";

	memset(&insadr, 0, sizeof(insadr));
	insadr.sin_family = AF_INET;
	insadr.sin_port = htons(1900);
	insadr.sin_addr.s_addr = inet_addr("239.255.255.250");
	sendto(s, &ms[0], sizeof(ms) - 1, 0, 
	       (struct sockaddr *) &insadr, sizeof(insadr));
}

void ssdp_thread(struct octoserve *os)
{
	//ssdp_search(s);
	ssdp_loop(os);
}

static uint64_t get_us(void)
{ 
	struct timeval tv;
	gettimeofday(&tv, 0);
	return ((uint64_t) tv.tv_sec * 1000000ULL + (uint64_t) tv.tv_usec);
}

static void create_uuid(uint8_t *u, uint8_t *mac)
{
	uint8_t uu[10] = { 0xdd, 0x84, 0x8d, 0x00, 0x26, 
			   0xec, 0x11, 0xeb, 0x80, 0x00 };
	
	memcpy(u, uu, 10);
	memcpy(u + 10, mac, 6);
}

static void create_uuid_old(uint8_t *u, uint8_t *mac)
{
	uint64_t us, ns;
	int i; 

	memcpy(u + 10, mac, 6);

	us = get_us();
	ns = us * 1000ULL + 122192928000000000ULL;

	u[0] = ns >> 24;
	u[1] = ns >> 16;
	u[2] = ns >> 8;
	u[3] = ns;
	u[4] = ns >> 40;
	u[5] = ns >> 32;
	u[6] = ns >> 56;
	u[7] = ns >> 48;

	u[8] = 0;
	u[9] = 0;

	u[6] = (u[6] & 0x0f) | 0x10;
	u[8] = (u[8] & 0x3f) | 0x80;
}

static int add_dev(struct os_ssdp *ss, char *nt, char *loc, char *uuid, char *server)
{
	int n = ss->dev_num;
	
	if (n == UPNP_DEV_MAX)
		return -1;
	ss->dev[n].nt = nt;
	ss->dev[n].loc = loc;
	ss->dev[n].uuid = uuid;
	ss->dev[n].server = server;
	ss->dev_num++;
}


int init_ssdp(struct octoserve *os, struct os_ssdp *ss, uint32_t d, int nossdp, int nodms)
{
	time_t t;
	uint8_t *u, mac[6];
	struct ifreq ifr;
	uint32_t id;
	int stat;
	char *dms = "Linux/3.17.7 DLNADOC/1.50 UPnP/1.0 OctopusNet-DMS/1.0";

	debug = d;
	ss->os = os;
	ss->server = "Linux/3.17.7 UPnP/1.1 OctopusNet/" OCTOSERVE_VERSION;
	stat = read_id("device", &id);
	if (stat < 0) {
		ss->devid = 5;
		write_id("device", ss->devid);
	} else
		ss->devid = id;
	stat = read_id("boot", &id);
	if (stat < 0)
		ss->bootid = 0;
	else
		ss->bootid = id + 1;
	write_id("boot", ss->bootid);

	dbgprintf(DEBUG_SSDP, "DEVID = %u\n", ss->devid);

	
	ss->configid = 1;

	get_ifa(os->ifname, AF_INET, (struct sockaddr *) &os->ssdp.sadr);
	get_ifa(os->ifname, AF_INET6, (struct sockaddr *) &os->ssdp.sadr6);
	sockname((struct sockaddr *) &os->ssdp.sadr, os->ssdp.ip);
	sockname((struct sockaddr *) &os->ssdp.sadr6, os->ssdp.ip6);

	if (!nossdp) {
		ss->sock = ssdpsock(os->ifname, AF_INET, (struct sockaddr *) &os->ssdp.sadr);
		if (ss->sock < 0)
			return -1;
		
		ss->sock6 = ssdpsock(os->ifname, AF_INET6, (struct sockaddr *) &os->ssdp.sadr);
		if (ss->sock6 < 0)
			return -1;
		
		strcpy(ifr.ifr_name, os->ifname);
		ioctl(ss->sock, SIOCGIFHWADDR, &ifr);
		memcpy(mac, ifr.ifr_hwaddr.sa_data, 6);

		create_uuid(ss->uuid, mac);
		u = ss->uuid;

		snprintf(ss->uuid_str, 42, 
			 "uuid:%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x-%02x%02x%02x%02x%02x%02x",
			 u[0], u[1], u[2], u[3], u[4], u[5], u[6], u[7], 
			 u[8], u[9], u[10], u[11], u[12], u[13], u[14], u[15]);
		
		snprintf(ss->uuid_str2, 42, 
			 "uuid:f0287290-e1e1-11e2-9a21-%02x%02x%02x%02x%02x%02x",
			 u[10], u[11], u[12], u[13], u[14], u[15]);
		
		add_dev(ss, "upnp:rootdevice", "/octoserve/octonet.xml", ss->uuid_str, ss->server);
		add_dev(ss, "", "/octoserve/octonet.xml", ss->uuid_str, ss->server);
		add_dev(ss, "urn:ses-com:device:SatIPServer:1", "/octoserve/octonet.xml", 
			ss->uuid_str, ss->server);
		
		if (!nodms) {
			add_dev(ss, "upnp:rootdevice", ":8080/dms.xml", ss->uuid_str2, dms);
			add_dev(ss, "", ":8080/dms.xml", ss->uuid_str2, dms);
			add_dev(ss, "urn:schemas-upnp-org:device:MediaServer:1", ":8080/dms.xml",
				ss->uuid_str2, dms);
			add_dev(ss, "urn:schemas-upnp-org:service:ConnectionManager:1",
				":8080/dms.xml", ss->uuid_str2, dms);
			add_dev(ss, "urn:schemas-upnp-org:service:ContentDirectory:1",
				":8080/dms.xml", ss->uuid_str2, dms);
			add_dev(ss, "urn:microsoft.com:service:X_MS_MediaReceiverRegistrar:1",
				":8080/dms.xml", ss->uuid_str2, dms);
		}
		pthread_create(&os->ssdp.pt, NULL, (void *) ssdp_thread, os);
	}
	return 0;
}