341 lines
9 KiB
C
341 lines
9 KiB
C
|
/*
|
||
|
|
* 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) {
|
||
|
|
wpa_msg(p2p->cfg->msg_ctx, MSG_DEBUG,
|
||
|
|
"P2P: Provision Discovery Request from "
|
||
|
|
"unknown peer " 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);
|
||
|
|
}
|