+++ /dev/null
-/*
- * Wi-Fi Direct - P2P provision discovery
- * Copyright (c) 2009-2010, Atheros Communications
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2 as
- * published by the Free Software Foundation.
- *
- * Alternatively, this software may be distributed under the terms of BSD
- * license.
- *
- * See README and COPYING for more details.
- */
-
-#include "includes.h"
-
-#include "common.h"
-#include "common/ieee802_11_defs.h"
-#include "wps/wps_defs.h"
-#include "p2p_i.h"
-#include "p2p.h"
-
-
-static void p2p_build_wps_ie_config_methods(struct wpabuf *buf,
- u16 config_methods)
-{
- u8 *len;
- wpabuf_put_u8(buf, WLAN_EID_VENDOR_SPECIFIC);
- len = wpabuf_put(buf, 1);
- wpabuf_put_be32(buf, WPS_DEV_OUI_WFA);
-
- /* Config Methods */
- wpabuf_put_be16(buf, ATTR_CONFIG_METHODS);
- wpabuf_put_be16(buf, 2);
- wpabuf_put_be16(buf, config_methods);
-
- p2p_buf_update_ie_hdr(buf, len);
-}
-
-
-static struct wpabuf * p2p_build_prov_disc_req(struct p2p_data *p2p,
- u8 dialog_token,
- u16 config_methods,
- struct p2p_device *go)
-{
- struct wpabuf *buf;
- u8 *len;
-
- buf = wpabuf_alloc(1000);
- if (buf == NULL)
- return NULL;
-
- p2p_buf_add_public_action_hdr(buf, P2P_PROV_DISC_REQ, dialog_token);
-
- len = p2p_buf_add_ie_hdr(buf);
- p2p_buf_add_capability(buf, p2p->dev_capab, 0);
- p2p_buf_add_device_info(buf, p2p, NULL);
- if (go) {
- p2p_buf_add_group_id(buf, go->p2p_device_addr, go->oper_ssid,
- go->oper_ssid_len);
- }
- p2p_buf_update_ie_hdr(buf, len);
-
- /* WPS IE with Config Methods attribute */
- p2p_build_wps_ie_config_methods(buf, config_methods);
-
- return buf;
-}
-
-
-static struct wpabuf * p2p_build_prov_disc_resp(struct p2p_data *p2p,
- u8 dialog_token,
- u16 config_methods)
-{
- struct wpabuf *buf;
-
- buf = wpabuf_alloc(100);
- if (buf == NULL)
- return NULL;
-
- p2p_buf_add_public_action_hdr(buf, P2P_PROV_DISC_RESP, dialog_token);
-
- /* WPS IE with Config Methods attribute */
- p2p_build_wps_ie_config_methods(buf, config_methods);
-
- return buf;
-}
-
-
-void p2p_process_prov_disc_req(struct p2p_data *p2p, const u8 *sa,
- const u8 *data, size_t len, int rx_freq)
-{
- struct p2p_message msg;
- struct p2p_device *dev;
- int freq;
- int reject = 1;
- struct wpabuf *resp;
-
- if (p2p_parse(data, len, &msg))
- return;
-
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
- "P2P: Received Provision Discovery Request from " MACSTR
- " with config methods 0x%x (freq=%d)",
- MAC2STR(sa), msg.wps_config_methods, rx_freq);
-
- dev = p2p_get_device(p2p, sa);
- if (dev == NULL || !(dev->flags & P2P_DEV_PROBE_REQ_ONLY)) {
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
- "P2P: Provision Discovery Request from "
- "unknown peer " MACSTR, MAC2STR(sa));
- if (p2p_add_device(p2p, sa, rx_freq, 0, data + 1, len - 1)) {
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
- "P2P: Provision Discovery Request add device "
- "failed " MACSTR, MAC2STR(sa));
- }
- }
-
- if (!(msg.wps_config_methods &
- (WPS_CONFIG_DISPLAY | WPS_CONFIG_KEYPAD |
- WPS_CONFIG_PUSHBUTTON))) {
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Unsupported "
- "Config Methods in Provision Discovery Request");
- goto out;
- }
-
- if (dev)
- dev->flags &= ~(P2P_DEV_PD_PEER_DISPLAY |
- P2P_DEV_PD_PEER_KEYPAD);
- if (msg.wps_config_methods & WPS_CONFIG_DISPLAY) {
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Peer " MACSTR
- " requested us to show a PIN on display", MAC2STR(sa));
- if (dev)
- dev->flags |= P2P_DEV_PD_PEER_KEYPAD;
- } else if (msg.wps_config_methods & WPS_CONFIG_KEYPAD) {
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Peer " MACSTR
- " requested us to write its PIN using keypad",
- MAC2STR(sa));
- if (dev)
- dev->flags |= P2P_DEV_PD_PEER_DISPLAY;
- }
-
- reject = 0;
-
-out:
- resp = p2p_build_prov_disc_resp(p2p, msg.dialog_token,
- reject ? 0 : msg.wps_config_methods);
- if (resp == NULL) {
- p2p_parse_free(&msg);
- return;
- }
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
- "P2P: Sending Provision Discovery Response");
- if (rx_freq > 0)
- freq = rx_freq;
- else
- freq = p2p_channel_to_freq(p2p->cfg->country,
- p2p->cfg->reg_class,
- p2p->cfg->channel);
- if (freq < 0) {
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
- "P2P: Unknown regulatory class/channel");
- wpabuf_free(resp);
- p2p_parse_free(&msg);
- return;
- }
- p2p->pending_action_state = P2P_NO_PENDING_ACTION;
- if (p2p->cfg->send_action(p2p->cfg->cb_ctx, freq, sa,
- p2p->cfg->dev_addr, p2p->cfg->dev_addr,
- wpabuf_head(resp), wpabuf_len(resp), 200) <
- 0) {
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
- "P2P: Failed to send Action frame");
- }
-
- wpabuf_free(resp);
-
- if (!reject && p2p->cfg->prov_disc_req) {
- const u8 *dev_addr = sa;
- if (msg.p2p_device_addr)
- dev_addr = msg.p2p_device_addr;
- p2p->cfg->prov_disc_req(p2p->cfg->cb_ctx, sa,
- msg.wps_config_methods,
- dev_addr, msg.pri_dev_type,
- msg.device_name, msg.config_methods,
- msg.capability ? msg.capability[0] : 0,
- msg.capability ? msg.capability[1] :
- 0);
-
- }
- p2p_parse_free(&msg);
-}
-
-
-void p2p_process_prov_disc_resp(struct p2p_data *p2p, const u8 *sa,
- const u8 *data, size_t len)
-{
- struct p2p_message msg;
- struct p2p_device *dev;
- u16 report_config_methods = 0;
-
- if (p2p_parse(data, len, &msg))
- return;
-
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
- "P2P: Received Provisioning Discovery Response from " MACSTR
- " with config methods 0x%x",
- MAC2STR(sa), msg.wps_config_methods);
-
- dev = p2p_get_device(p2p, sa);
- if (dev == NULL || !dev->req_config_methods) {
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
- "P2P: Ignore Provisioning Discovery Response from "
- MACSTR " with no pending request", MAC2STR(sa));
- p2p_parse_free(&msg);
- return;
- }
-
- if (dev->dialog_token != msg.dialog_token) {
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
- "P2P: Ignore Provisioning Discovery Response with "
- "unexpected Dialog Token %u (expected %u)",
- msg.dialog_token, dev->dialog_token);
- p2p_parse_free(&msg);
- return;
- }
-
- if (msg.wps_config_methods != dev->req_config_methods) {
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Peer rejected "
- "our Provisioning Discovery Request");
- p2p_parse_free(&msg);
- goto out;
- }
-
- report_config_methods = dev->req_config_methods;
- dev->flags &= ~(P2P_DEV_PD_PEER_DISPLAY |
- P2P_DEV_PD_PEER_KEYPAD);
- if (dev->req_config_methods & WPS_CONFIG_DISPLAY) {
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Peer " MACSTR
- " accepted to show a PIN on display", MAC2STR(sa));
- dev->flags |= P2P_DEV_PD_PEER_DISPLAY;
- } else if (msg.wps_config_methods & WPS_CONFIG_KEYPAD) {
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Peer " MACSTR
- " accepted to write our PIN using keypad",
- MAC2STR(sa));
- dev->flags |= P2P_DEV_PD_PEER_KEYPAD;
- }
- p2p_parse_free(&msg);
-
-out:
- dev->req_config_methods = 0;
- p2p->cfg->send_action_done(p2p->cfg->cb_ctx);
- if (p2p->cfg->prov_disc_resp)
- p2p->cfg->prov_disc_resp(p2p->cfg->cb_ctx, sa,
- report_config_methods);
-}
-
-
-int p2p_send_prov_disc_req(struct p2p_data *p2p, struct p2p_device *dev,
- int join)
-{
- struct wpabuf *req;
- int freq;
-
- freq = dev->listen_freq > 0 ? dev->listen_freq : dev->oper_freq;
- if (freq <= 0) {
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
- "P2P: No Listen/Operating frequency known for the "
- "peer " MACSTR " to send Provision Discovery Request",
- MAC2STR(dev->p2p_device_addr));
- return -1;
- }
-
- if (dev->flags & P2P_DEV_GROUP_CLIENT_ONLY) {
- if (!(dev->dev_capab & P2P_DEV_CAPAB_CLIENT_DISCOVERABILITY)) {
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
- "P2P: Cannot use PD with P2P Device " MACSTR
- " that is in a group and is not discoverable",
- MAC2STR(dev->p2p_device_addr));
- return -1;
- }
- /* TODO: use device discoverability request through GO */
- }
-
- dev->dialog_token++;
- if (dev->dialog_token == 0)
- dev->dialog_token = 1;
- req = p2p_build_prov_disc_req(p2p, dev->dialog_token,
- dev->req_config_methods,
- join ? dev : NULL);
- if (req == NULL)
- return -1;
-
- p2p->pending_action_state = P2P_PENDING_PD;
- if (p2p->cfg->send_action(p2p->cfg->cb_ctx, freq,
- dev->p2p_device_addr, p2p->cfg->dev_addr,
- dev->p2p_device_addr,
- wpabuf_head(req), wpabuf_len(req), 200) < 0)
- {
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
- "P2P: Failed to send Action frame");
- wpabuf_free(req);
- return -1;
- }
-
- wpabuf_free(req);
- return 0;
-}
-
-
-int p2p_prov_disc_req(struct p2p_data *p2p, const u8 *peer_addr,
- u16 config_methods, int join)
-{
- struct p2p_device *dev;
-
- dev = p2p_get_device(p2p, peer_addr);
- if (dev == NULL)
- dev = p2p_get_device_interface(p2p, peer_addr);
- if (dev == NULL || (dev->flags & P2P_DEV_PROBE_REQ_ONLY)) {
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Provision "
- "Discovery Request destination " MACSTR
- " not yet known", MAC2STR(peer_addr));
- return -1;
- }
-
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Provision Discovery "
- "Request with " MACSTR " (config methods 0x%x)",
- MAC2STR(peer_addr), config_methods);
- if (config_methods == 0)
- return -1;
-
- dev->req_config_methods = config_methods;
-
- if (p2p->go_neg_peer ||
- (p2p->state != P2P_IDLE && p2p->state != P2P_SEARCH &&
- p2p->state != P2P_LISTEN_ONLY)) {
- wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG, "P2P: Busy with other "
- "operations; postpone Provision Discovery Request "
- "with " MACSTR " (config methods 0x%x)",
- MAC2STR(peer_addr), config_methods);
- return 0;
- }
-
- return p2p_send_prov_disc_req(p2p, dev, join);
-}