wps_dev_attr.c revision 04949598a23f501be6eec21697465fd46a28840a
15821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)/* 25821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * Wi-Fi Protected Setup - device attributes 35821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * Copyright (c) 2008, Jouni Malinen <j@w1.fi> 45821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * 55821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * This software may be distributed under the terms of the BSD license. 65821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * See README for more details. 75821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) */ 85821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 95821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#include "includes.h" 105821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 115821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#include "common.h" 125821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#include "wps_i.h" 135821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#include "wps_dev_attr.h" 145821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 155821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 165821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)int wps_build_manufacturer(struct wps_device_data *dev, struct wpabuf *msg) 175821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 185821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) size_t len; 195821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_printf(MSG_DEBUG, "WPS: * Manufacturer"); 205821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, ATTR_MANUFACTURER); 215821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) len = dev->manufacturer ? os_strlen(dev->manufacturer) : 0; 225821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#ifndef CONFIG_WPS_STRICT 235821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (len == 0) { 245821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) /* 255821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * Some deployed WPS implementations fail to parse zero-length 265821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * attributes. As a workaround, send a space character if the 275821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * device attribute string is empty. 285821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) */ 295821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, 1); 305821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_u8(msg, ' '); 315821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 325821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 335821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#endif /* CONFIG_WPS_STRICT */ 345821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, len); 355821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_data(msg, dev->manufacturer, len); 365821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 375821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 385821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 395821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 405821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)int wps_build_model_name(struct wps_device_data *dev, struct wpabuf *msg) 415821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 425821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) size_t len; 435821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_printf(MSG_DEBUG, "WPS: * Model Name"); 445821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, ATTR_MODEL_NAME); 455821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) len = dev->model_name ? os_strlen(dev->model_name) : 0; 465821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#ifndef CONFIG_WPS_STRICT 475821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (len == 0) { 485821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) /* 495821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * Some deployed WPS implementations fail to parse zero-length 505821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * attributes. As a workaround, send a space character if the 515821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * device attribute string is empty. 525821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) */ 535821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, 1); 545821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_u8(msg, ' '); 555821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 565821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 575821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#endif /* CONFIG_WPS_STRICT */ 585821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, len); 595821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_data(msg, dev->model_name, len); 605821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 615821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 625821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 635821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 645821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)int wps_build_model_number(struct wps_device_data *dev, struct wpabuf *msg) 655821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 665821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) size_t len; 675821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_printf(MSG_DEBUG, "WPS: * Model Number"); 685821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, ATTR_MODEL_NUMBER); 695821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) len = dev->model_number ? os_strlen(dev->model_number) : 0; 705821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#ifndef CONFIG_WPS_STRICT 715821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (len == 0) { 725821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) /* 735821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * Some deployed WPS implementations fail to parse zero-length 745821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * attributes. As a workaround, send a space character if the 755821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * device attribute string is empty. 765821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) */ 775821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, 1); 785821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_u8(msg, ' '); 795821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 805821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 815821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#endif /* CONFIG_WPS_STRICT */ 825821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, len); 835821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_data(msg, dev->model_number, len); 845821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 855821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 865821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 875821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 885821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)static int wps_build_serial_number(struct wps_device_data *dev, 895821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) struct wpabuf *msg) 905821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 915821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) size_t len; 925821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_printf(MSG_DEBUG, "WPS: * Serial Number"); 935821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, ATTR_SERIAL_NUMBER); 945821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) len = dev->serial_number ? os_strlen(dev->serial_number) : 0; 955821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#ifndef CONFIG_WPS_STRICT 965821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (len == 0) { 975821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) /* 985821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * Some deployed WPS implementations fail to parse zero-length 995821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * attributes. As a workaround, send a space character if the 1005821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * device attribute string is empty. 1015821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) */ 1025821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, 1); 1035821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_u8(msg, ' '); 1045821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 1055821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 1065821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#endif /* CONFIG_WPS_STRICT */ 1075821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, len); 1085821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_data(msg, dev->serial_number, len); 1095821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 1105821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 1115821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 1125821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 1133551c9c881056c480085172ff9840cab31610854Torne (Richard Coles)int wps_build_primary_dev_type(struct wps_device_data *dev, struct wpabuf *msg) 1145821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 1155821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_printf(MSG_DEBUG, "WPS: * Primary Device Type"); 1165821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, ATTR_PRIMARY_DEV_TYPE); 1175821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, WPS_DEV_TYPE_LEN); 1185821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_data(msg, dev->pri_dev_type, WPS_DEV_TYPE_LEN); 1195821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 1205821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 1215821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 1225821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 1235821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)int wps_build_secondary_dev_type(struct wps_device_data *dev, 1245821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) struct wpabuf *msg) 1255821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 1265821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (!dev->num_sec_dev_types) 1275821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 1285821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 1295821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_printf(MSG_DEBUG, "WPS: * Secondary Device Type"); 1305821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, ATTR_SECONDARY_DEV_TYPE_LIST); 1315821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, WPS_DEV_TYPE_LEN * dev->num_sec_dev_types); 1325821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_data(msg, dev->sec_dev_type, 1335821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) WPS_DEV_TYPE_LEN * dev->num_sec_dev_types); 1345821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 1355821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 1365821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 1375821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 1385821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 1395821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)int wps_build_req_dev_type(struct wps_device_data *dev, struct wpabuf *msg, 1405821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) unsigned int num_req_dev_types, 1415821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) const u8 *req_dev_types) 1425821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 1435821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) unsigned int i; 1445821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 1455821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) for (i = 0; i < num_req_dev_types; i++) { 1465821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_hexdump(MSG_DEBUG, "WPS: * Requested Device Type", 1475821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) req_dev_types + i * WPS_DEV_TYPE_LEN, 1485821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) WPS_DEV_TYPE_LEN); 1495821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, ATTR_REQUESTED_DEV_TYPE); 1505821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, WPS_DEV_TYPE_LEN); 1515821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_data(msg, req_dev_types + i * WPS_DEV_TYPE_LEN, 1525821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) WPS_DEV_TYPE_LEN); 1535821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 1545821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 1555821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 1565821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 1575821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 1585821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 1595821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)int wps_build_dev_name(struct wps_device_data *dev, struct wpabuf *msg) 1605821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 1615821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) size_t len; 1625821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_printf(MSG_DEBUG, "WPS: * Device Name"); 1635821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, ATTR_DEV_NAME); 1645821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) len = dev->device_name ? os_strlen(dev->device_name) : 0; 1655821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#ifndef CONFIG_WPS_STRICT 1665821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (len == 0) { 1675821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) /* 1685821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * Some deployed WPS implementations fail to parse zero-length 1695821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * attributes. As a workaround, send a space character if the 1705821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) * device attribute string is empty. 1715821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) */ 1725821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, 1); 1735821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_u8(msg, ' '); 1745821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 1755821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 1765821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#endif /* CONFIG_WPS_STRICT */ 1775821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, len); 1785821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_data(msg, dev->device_name, len); 1795821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 1805821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 1815821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 1825821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 1835821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)int wps_build_device_attrs(struct wps_device_data *dev, struct wpabuf *msg) 1845821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 1855821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (wps_build_manufacturer(dev, msg) || 1863551c9c881056c480085172ff9840cab31610854Torne (Richard Coles) wps_build_model_name(dev, msg) || 1875821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wps_build_model_number(dev, msg) || 1885821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wps_build_serial_number(dev, msg) || 1895821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wps_build_primary_dev_type(dev, msg) || 1903551c9c881056c480085172ff9840cab31610854Torne (Richard Coles) wps_build_dev_name(dev, msg)) 1915821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return -1; 1925821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 1935821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 1943551c9c881056c480085172ff9840cab31610854Torne (Richard Coles) 1955821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 1965821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)int wps_build_os_version(struct wps_device_data *dev, struct wpabuf *msg) 1975821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 1985821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_printf(MSG_DEBUG, "WPS: * OS Version"); 1995821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, ATTR_OS_VERSION); 2005821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, 4); 2015821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be32(msg, 0x80000000 | dev->os_version); 2025821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 2035821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 2045821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2055821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2065821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)int wps_build_vendor_ext_m1(struct wps_device_data *dev, struct wpabuf *msg) 2075821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 2085821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (dev->vendor_ext_m1 != NULL) { 2095821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_hexdump(MSG_DEBUG, "WPS: * Vendor Extension M1", 2105821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_head_u8(dev->vendor_ext_m1), 2115821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_len(dev->vendor_ext_m1)); 2125821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, ATTR_VENDOR_EXT); 2135821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, wpabuf_len(dev->vendor_ext_m1)); 2145821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_buf(msg, dev->vendor_ext_m1); 2155821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 2165821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 2175821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 2185821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2195821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2205821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)int wps_build_rf_bands(struct wps_device_data *dev, struct wpabuf *msg) 2215821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 2225821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_printf(MSG_DEBUG, "WPS: * RF Bands (%x)", dev->rf_bands); 2235821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, ATTR_RF_BANDS); 2245821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, 1); 2255821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_u8(msg, dev->rf_bands); 2265821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 2275821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 2285821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2295821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2305821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)int wps_build_vendor_ext(struct wps_device_data *dev, struct wpabuf *msg) 2315821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 2325821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) int i; 2335821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2345821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) for (i = 0; i < MAX_WPS_VENDOR_EXTENSIONS; i++) { 2355821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (dev->vendor_ext[i] == NULL) 2365821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) continue; 2375821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_hexdump(MSG_DEBUG, "WPS: * Vendor Extension", 2385821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_head_u8(dev->vendor_ext[i]), 2395821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_len(dev->vendor_ext[i])); 2405821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, ATTR_VENDOR_EXT); 2415821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_be16(msg, wpabuf_len(dev->vendor_ext[i])); 2425821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpabuf_put_buf(msg, dev->vendor_ext[i]); 2435821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 2445821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2455821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 2465821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 2475821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2485821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2495821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)static int wps_process_manufacturer(struct wps_device_data *dev, const u8 *str, 2505821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) size_t str_len) 2515821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 2525821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (str == NULL) { 2535821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_printf(MSG_DEBUG, "WPS: No Manufacturer received"); 2545821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return -1; 2555821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 2565821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2575821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_hexdump_ascii(MSG_DEBUG, "WPS: Manufacturer", str, str_len); 2585821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2595821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) os_free(dev->manufacturer); 2605821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dev->manufacturer = os_malloc(str_len + 1); 2615821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (dev->manufacturer == NULL) 2625821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return -1; 2635821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) os_memcpy(dev->manufacturer, str, str_len); 2645821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dev->manufacturer[str_len] = '\0'; 2655821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2665821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 2675821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 2685821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2695821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2705821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)static int wps_process_model_name(struct wps_device_data *dev, const u8 *str, 2715821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) size_t str_len) 2725821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 2735821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (str == NULL) { 2745821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_printf(MSG_DEBUG, "WPS: No Model Name received"); 2755821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return -1; 2765821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 2775821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2785821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_hexdump_ascii(MSG_DEBUG, "WPS: Model Name", str, str_len); 2795821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2805821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) os_free(dev->model_name); 2815821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dev->model_name = os_malloc(str_len + 1); 2825821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (dev->model_name == NULL) 2835821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return -1; 2845821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) os_memcpy(dev->model_name, str, str_len); 2855821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dev->model_name[str_len] = '\0'; 2865821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2875821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 2885821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 2895821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2905821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2915821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)static int wps_process_model_number(struct wps_device_data *dev, const u8 *str, 2925821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) size_t str_len) 2935821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 2945821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (str == NULL) { 2955821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_printf(MSG_DEBUG, "WPS: No Model Number received"); 2965821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return -1; 2975821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 2985821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 2995821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_hexdump_ascii(MSG_DEBUG, "WPS: Model Number", str, str_len); 3005821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 3015821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) os_free(dev->model_number); 3025821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dev->model_number = os_malloc(str_len + 1); 3035821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (dev->model_number == NULL) 3045821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return -1; 3055821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) os_memcpy(dev->model_number, str, str_len); 3065821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dev->model_number[str_len] = '\0'; 3075821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 3085821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 3095821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 3105821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 3115821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 3125821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)static int wps_process_serial_number(struct wps_device_data *dev, 3135821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) const u8 *str, size_t str_len) 3145821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 3155821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (str == NULL) { 3165821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_printf(MSG_DEBUG, "WPS: No Serial Number received"); 3175821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return -1; 3185821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 3195821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 3205821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_hexdump_ascii(MSG_DEBUG, "WPS: Serial Number", str, str_len); 3215821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 3225821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) os_free(dev->serial_number); 323ba5b9a6411cb1792fd21f0a078d7a25cd1ceec16Ben Murdoch dev->serial_number = os_malloc(str_len + 1); 324ba5b9a6411cb1792fd21f0a078d7a25cd1ceec16Ben Murdoch if (dev->serial_number == NULL) 325ba5b9a6411cb1792fd21f0a078d7a25cd1ceec16Ben Murdoch return -1; 326ba5b9a6411cb1792fd21f0a078d7a25cd1ceec16Ben Murdoch os_memcpy(dev->serial_number, str, str_len); 327ba5b9a6411cb1792fd21f0a078d7a25cd1ceec16Ben Murdoch dev->serial_number[str_len] = '\0'; 328ba5b9a6411cb1792fd21f0a078d7a25cd1ceec16Ben Murdoch 329ba5b9a6411cb1792fd21f0a078d7a25cd1ceec16Ben Murdoch return 0; 330ba5b9a6411cb1792fd21f0a078d7a25cd1ceec16Ben Murdoch} 331ba5b9a6411cb1792fd21f0a078d7a25cd1ceec16Ben Murdoch 332ba5b9a6411cb1792fd21f0a078d7a25cd1ceec16Ben Murdoch 333ba5b9a6411cb1792fd21f0a078d7a25cd1ceec16Ben Murdochstatic int wps_process_dev_name(struct wps_device_data *dev, const u8 *str, 334ba5b9a6411cb1792fd21f0a078d7a25cd1ceec16Ben Murdoch size_t str_len) 335ba5b9a6411cb1792fd21f0a078d7a25cd1ceec16Ben Murdoch{ 336ba5b9a6411cb1792fd21f0a078d7a25cd1ceec16Ben Murdoch if (str == NULL) { 337ba5b9a6411cb1792fd21f0a078d7a25cd1ceec16Ben Murdoch wpa_printf(MSG_DEBUG, "WPS: No Device Name received"); 338ba5b9a6411cb1792fd21f0a078d7a25cd1ceec16Ben Murdoch return -1; 339ba5b9a6411cb1792fd21f0a078d7a25cd1ceec16Ben Murdoch } 340ba5b9a6411cb1792fd21f0a078d7a25cd1ceec16Ben Murdoch 3415821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_hexdump_ascii(MSG_DEBUG, "WPS: Device Name", str, str_len); 3425821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 3435821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) os_free(dev->device_name); 3445821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dev->device_name = os_malloc(str_len + 1); 3455821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (dev->device_name == NULL) 3465821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return -1; 3475821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) os_memcpy(dev->device_name, str, str_len); 3485821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) dev->device_name[str_len] = '\0'; 3495821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 3505821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 3515821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 3525821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 3535821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 3545821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)static int wps_process_primary_dev_type(struct wps_device_data *dev, 3555821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) const u8 *dev_type) 3565821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 3575821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#ifndef CONFIG_NO_STDOUT_DEBUG 3585821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) char devtype[WPS_DEV_TYPE_BUFSIZE]; 3595821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)#endif /* CONFIG_NO_STDOUT_DEBUG */ 3605821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 3615821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (dev_type == NULL) { 3625821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_printf(MSG_DEBUG, "WPS: No Primary Device Type received"); 3635821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return -1; 3645821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) } 3655821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 3665821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) os_memcpy(dev->pri_dev_type, dev_type, WPS_DEV_TYPE_LEN); 3675821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wpa_printf(MSG_DEBUG, "WPS: Primary Device Type: %s", 3685821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wps_dev_type_bin2str(dev->pri_dev_type, devtype, 3695821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) sizeof(devtype))); 3705821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 3715821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 3725821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 3735821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 3745821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 3755821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)int wps_process_device_attrs(struct wps_device_data *dev, 3765821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) struct wps_parse_attr *attr) 3775821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 3785821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (wps_process_manufacturer(dev, attr->manufacturer, 3795821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) attr->manufacturer_len) || 3805821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wps_process_model_name(dev, attr->model_name, 3815821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) attr->model_name_len) || 3825821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wps_process_model_number(dev, attr->model_number, 3835821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) attr->model_number_len) || 3845821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wps_process_serial_number(dev, attr->serial_number, 3855821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) attr->serial_number_len) || 3863551c9c881056c480085172ff9840cab31610854Torne (Richard Coles) wps_process_primary_dev_type(dev, attr->primary_dev_type) || 3875821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) wps_process_dev_name(dev, attr->dev_name, attr->dev_name_len)) 3885821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return -1; 3895821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) return 0; 3905821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)} 3915821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 3925821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) 3935821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles)int wps_process_os_version(struct wps_device_data *dev, const u8 *ver) 3945821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles){ 3955821806d5e7f356e8fa4b058a389a808ea183019Torne (Richard Coles) if (ver == NULL) { 396 wpa_printf(MSG_DEBUG, "WPS: No OS Version received"); 397 return -1; 398 } 399 400 dev->os_version = WPA_GET_BE32(ver); 401 wpa_printf(MSG_DEBUG, "WPS: OS Version %08x", dev->os_version); 402 403 return 0; 404} 405 406 407int wps_process_rf_bands(struct wps_device_data *dev, const u8 *bands) 408{ 409 if (bands == NULL) { 410 wpa_printf(MSG_DEBUG, "WPS: No RF Bands received"); 411 return -1; 412 } 413 414 dev->rf_bands = *bands; 415 wpa_printf(MSG_DEBUG, "WPS: Enrollee RF Bands 0x%x", dev->rf_bands); 416 417 return 0; 418} 419 420 421void wps_device_data_dup(struct wps_device_data *dst, 422 const struct wps_device_data *src) 423{ 424 if (src->device_name) 425 dst->device_name = os_strdup(src->device_name); 426 if (src->manufacturer) 427 dst->manufacturer = os_strdup(src->manufacturer); 428 if (src->model_name) 429 dst->model_name = os_strdup(src->model_name); 430 if (src->model_number) 431 dst->model_number = os_strdup(src->model_number); 432 if (src->serial_number) 433 dst->serial_number = os_strdup(src->serial_number); 434 os_memcpy(dst->pri_dev_type, src->pri_dev_type, WPS_DEV_TYPE_LEN); 435 dst->os_version = src->os_version; 436 dst->rf_bands = src->rf_bands; 437} 438 439 440void wps_device_data_free(struct wps_device_data *dev) 441{ 442 os_free(dev->device_name); 443 dev->device_name = NULL; 444 os_free(dev->manufacturer); 445 dev->manufacturer = NULL; 446 os_free(dev->model_name); 447 dev->model_name = NULL; 448 os_free(dev->model_number); 449 dev->model_number = NULL; 450 os_free(dev->serial_number); 451 dev->serial_number = NULL; 452} 453