UPNP TR064 test tool

/* * Broadcom UPnP module SSDP implementation * * Copyright (C) 2008, Broadcom Corporation * All Rights Reserved. * * This is UNPUBLISHED PROPRIETARY SOURCE CODE of Broadcom Corporation; * the contents of this file may not be disclosed to third parties, copied * or duplicated in any form, in whole or in part, without the prior * written permission of Broadcom Corporation. * * $Id: ssdp.c,v 1.1.1.2 2008/10/01 02:44:47 jack Exp $ */ #include <upnp.h> #include <ILibParsers.h> #ifdef UI_GTK_SUPPORT #include <gui.h> #endif struct upnp_method ssdp_ctrlpoint_methods[] = { {"HTTP/1.1 ", sizeof("HTTP/1.1 ")-1, METHOD_HTTP_RESPONSE, ssdp_msearch_response_process}, {0, 0, 0, 0} }; //static int read_header(UPNP_CONTEXT *, struct upnp_method *); static struct upnp_state ssdp_ctrlpoint_fsm[] = { {upnp_http_fsm_init, 0}, {read_ssdp_header, 0}, {parse_method, ssdp_ctrlpoint_methods}, {parse_uri, 0}, {parse_msghdr, 0}, {upnp_http_fsm_dispatch, ssdp_ctrlpoint_methods}, {0, 0} }; int hasUpnpActionInputArgument(struct UPnPAction *action) { struct UPnPActionArgument *arg = NULL; if(action) { arg = action->Args; while(arg) { if( strcmp(arg->Direction, "in") == 0 ) return TRUE; arg = arg->Next; } } return FALSE; } struct UPnPDevice * find_device(struct UPnPDevice *device, const char *udn) { struct UPnPDevice *e_Device = device->EmbeddedDevices; struct UPnPDevice *t_Device; if(device!=NULL) { if( strcmp(udn, device->UDN) == 0 ) return device; } while(e_Device!=NULL) { t_Device = find_device(e_Device, udn); if(t_Device) return t_Device; e_Device = e_Device->Next; } return NULL; } struct UPnPService * find_service(struct UPnPDevice *device, const char *uuid) { struct UPnPDevice *e_Device = device->EmbeddedDevices; struct UPnPService *service; struct UPnPService *e_service; service = device->Services; while(service!=NULL) { if( strcmp(uuid, service->ServiceId) == 0 ) return service; service = service->Next; } while(e_Device!=NULL) { e_service = find_service(e_Device, uuid); if(e_service) return e_service; e_Device = e_Device->Next; } return NULL; } struct UPnPService * find_service_by_sid(struct UPnPDevice *device, const char *sid) { struct UPnPDevice *e_Device = device->EmbeddedDevices; struct UPnPService *service; struct UPnPService *e_service; service = device->Services; while(service!=NULL) { if( service->SubscriptionID!=NULL && strcmp(sid, service->SubscriptionID) == 0 ) return service; service = service->Next; } while(e_Device!=NULL) { e_service = find_service_by_sid(e_Device, sid); if(e_service) return e_service; e_Device = e_Device->Next; } return NULL; } struct UPnPService * find_upnp_service(UPNP_CONTEXT *context, const char *uuid) { struct UPnPDevice *rootdevice; struct UPnPService *service; UPNP_INTERFACE *ifp; for (ifp = context->iflist; ifp; ifp = ifp->next) { context->focus_ifp = ifp; rootdevice = ifp->rootdevice; while(rootdevice) { service = find_service(rootdevice, uuid); if(service) return service; rootdevice = rootdevice->Next; } } return NULL; } struct UPnPDevice * find_upnp_device(UPNP_CONTEXT *context, const char *udn) { struct UPnPDevice *rootdevice; struct UPnPDevice *device; UPNP_INTERFACE *ifp; for (ifp = context->iflist; ifp; ifp = ifp->next) { context->focus_ifp = ifp; rootdevice = ifp->rootdevice; while(rootdevice) { device = find_device(rootdevice, udn); if(device) return device; rootdevice = rootdevice->Next; } } return NULL; } struct UPnPService * find_upnp_service_by_sid(UPNP_CONTEXT *context, const char *sid) { struct UPnPDevice *rootdevice; struct UPnPService *service; UPNP_INTERFACE *ifp; for (ifp = context->iflist; ifp; ifp = ifp->next) { context->focus_ifp = ifp; rootdevice = ifp->rootdevice; while(rootdevice) { service = find_service_by_sid(rootdevice, sid); if(service) return service; rootdevice = rootdevice->Next; } } return NULL; } struct UPnPAction * find_upnp_action(struct UPnPService *service, const char *name) { struct UPnPAction *action = service->Actions; while(action) { if( strcmp(action->Name, name)==0 ) return action; action = action->Next; } return NULL; } struct UPnPActionArgument * find_upnp_action_argument(struct UPnPAction *action, const char *name) { struct UPnPActionArgument *arg = action->Args; while(arg) { if( strcmp(arg->Name, name)==0 ) return arg; arg = arg->Next; } return NULL; } struct UPnPStateVariable * find_upnp_state_variable(struct UPnPService *service, const char *name) { struct UPnPStateVariable *variable = service->Variables; while(variable) { if( strcmp(variable->Name, name)==0 ) return variable; variable = variable->Next; } return NULL; } /* Read SSDP header */ #if 0 static int read_header(UPNP_CONTEXT *context, struct upnp_method *methods) { //UPNP_INTERFACE *ifp = context->focus_ifp; UPNP_INTERFACE *ifp = context->iflist; socklen_t size = sizeof(struct sockaddr_in); int len; memset(&context->dst_addr, 0, size); len = recvfrom(context->fd, context->buf, sizeof(context->buf), 0, (struct sockaddr *)&context->dst_addr, &size); /* Read done */ if (len > 0) { /* locate UPnP interface for the multicast socket */ while (ifp) { if ((ifp->ipaddr.s_addr & ifp->netmask.s_addr) == (context->dst_addr.sin_addr.s_addr & ifp->netmask.s_addr)) { /* Set focus interface */ context->focus_ifp = ifp; break; } ifp = ifp->next; } if (ifp == NULL) { upnp_syslog(LOG_ERR, "Not found correct interface %s", inet_ntoa(context->dst_addr.sin_addr)); return -1; } context->buf[len] = 0; context->end = len; context->dst = &context->dst_addr; /* Get message header */ get_msghdr(context); if (context->status != 0) { upnp_syslog(LOG_ERR, "Erro occured when get message header"); return -1; }else{ upnp_syslog(LOG_ERR, "Recv message len NULL"); } return 0; } return -1; } #endif /* Send out SSDP packet */ void upnp_msearch_send(UPNP_CONTEXT *context) { struct sockaddr_in dst; char *buf = context->head_buffer; int len = strlen(buf); /* * if caller does not specify a unicast address, send multicast * (239.255.255.250) */ if (context->dst == 0) { /* Assign mutlicast interface to send */ struct in_addr inaddr = context->focus_ifp->ipaddr; setsockopt(context->MSEARCH_Response_Socket, IPPROTO_IP, IP_MULTICAST_IF, (void *)&inaddr, sizeof(inaddr)); /* Send to SSDP_ADDR:SSDP_PORT */ #if defined(__ECOS) dst.sin_len = sizeof(struct sockaddr_in); #endif dst.sin_family = AF_INET; dst.sin_port = htons(SSDP_PORT); inet_aton(SSDP_ADDR, &dst.sin_addr); /* Send packet */ sendto(context->MSEARCH_Response_Socket, buf, len, 0, (struct sockaddr *)&dst, sizeof(dst)); return; } else { dst = *context->dst; /* Send packet */ sendto(context->ssdp_sock, buf, len, 0, (struct sockaddr *)&dst, sizeof(dst)); return; } } void msearch_msg_send(UPNP_CONTEXT *context) { UPNP_INTERFACE *ifp; int bufferlength; char *buf = context->head_buffer; context->dst = 0; memset(buf, 0, sizeof(context->head_buffer)); bufferlength = sprintf(buf,"M-SEARCH * HTTP/1.1\r\nMX: 10\r\nST: %s\r\nHOST: 239.255.255.250:1900\r\nMAN: \"ssdp:discover\"\r\n\r\n", "urn:schemas-upnp-org:device:InternetGatewayDevice:1");//"ssdp:all"; for (ifp = context->iflist; ifp; ifp = ifp->next) { context->focus_ifp = ifp; upnp_msearch_send(context); } } void msearch_response_process(UPNP_CONTEXT *context, int fd) { context->fd = fd; upnp_http_fsm_engine(context, ssdp_ctrlpoint_fsm); return; } int ssdp_msearch_response_process(UPNP_CONTEXT *context) { char name[128]; int type; char *host; char *nt; char *st; char *usn; char