kernel/drivers/net/wireless/ath/ath10k/p2p.c

   1 /*
   2  * Copyright (c) 2015 Qualcomm Atheros, Inc.
   3  *
   4  * Permission to use, copy, modify, and/or distribute this software for any
   5  * purpose with or without fee is hereby granted, provided that the above
   6  * copyright notice and this permission notice appear in all copies.
   7  *
   8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
   9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  11  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15  */
  16
  17 #include "core.h"
  18 #include "wmi.h"
  19 #include "mac.h"
  20 #include "p2p.h"
  21
  22 static void ath10k_p2p_noa_ie_fill(u8 *data, size_t len,
  23                                    const struct wmi_p2p_noa_info *noa)
  24 {
  25         struct ieee80211_p2p_noa_attr *noa_attr;
  26         u8  ctwindow_oppps = noa->ctwindow_oppps;
  27         u8 ctwindow = ctwindow_oppps >> WMI_P2P_OPPPS_CTWINDOW_OFFSET;
  28         bool oppps = !!(ctwindow_oppps & WMI_P2P_OPPPS_ENABLE_BIT);
  29         __le16 *noa_attr_len;
  30         u16 attr_len;
  31         u8 noa_descriptors = noa->num_descriptors;
  32         int i;
  33
  34         /* P2P IE */
  35         data[0] = WLAN_EID_VENDOR_SPECIFIC;
  36         data[1] = len - 2;
  37         data[2] = (WLAN_OUI_WFA >> 16) & 0xff;
  38         data[3] = (WLAN_OUI_WFA >> 8) & 0xff;
  39         data[4] = (WLAN_OUI_WFA >> 0) & 0xff;
  40         data[5] = WLAN_OUI_TYPE_WFA_P2P;
  41
  42         /* NOA ATTR */
  43         data[6] = IEEE80211_P2P_ATTR_ABSENCE_NOTICE;
  44         noa_attr_len = (__le16 *)&data[7]; /* 2 bytes */
  45         noa_attr = (struct ieee80211_p2p_noa_attr *)&data[9];
  46
  47         noa_attr->index = noa->index;
  48         noa_attr->oppps_ctwindow = ctwindow;
  49         if (oppps)
  50                 noa_attr->oppps_ctwindow |= IEEE80211_P2P_OPPPS_ENABLE_BIT;
  51
  52         for (i = 0; i < noa_descriptors; i++) {
  53                 noa_attr->desc[i].count =
  54                         __le32_to_cpu(noa->descriptors[i].type_count);
  55                 noa_attr->desc[i].duration = noa->descriptors[i].duration;
  56                 noa_attr->desc[i].interval = noa->descriptors[i].interval;
  57                 noa_attr->desc[i].start_time = noa->descriptors[i].start_time;
  58         }
  59
  60         attr_len = 2; /* index + oppps_ctwindow */
  61         attr_len += noa_descriptors * sizeof(struct ieee80211_p2p_noa_desc);
  62         *noa_attr_len = __cpu_to_le16(attr_len);
  63 }
  64
  65 static size_t ath10k_p2p_noa_ie_len_compute(const struct wmi_p2p_noa_info *noa)
  66 {
  67         size_t len = 0;
  68
  69         if (!noa->num_descriptors &&
  70             !(noa->ctwindow_oppps & WMI_P2P_OPPPS_ENABLE_BIT))
  71                 return 0;
  72
  73         len += 1 + 1 + 4; /* EID + len + OUI */
  74         len += 1 + 2; /* noa attr + attr len */
  75         len += 1 + 1; /* index + oppps_ctwindow */
  76         len += noa->num_descriptors * sizeof(struct ieee80211_p2p_noa_desc);
  77
  78         return len;
  79 }
  80
  81 static void ath10k_p2p_noa_ie_assign(struct ath10k_vif *arvif, void *ie,
  82                                      size_t len)
  83 {
  84         struct ath10k *ar = arvif->ar;
  85
  86         lockdep_assert_held(&ar->data_lock);
  87
  88         kfree(arvif->u.ap.noa_data);
  89
  90         arvif->u.ap.noa_data = ie;
  91         arvif->u.ap.noa_len = len;
  92 }
  93
  94 static void __ath10k_p2p_noa_update(struct ath10k_vif *arvif,
  95                                     const struct wmi_p2p_noa_info *noa)
  96 {
  97         struct ath10k *ar = arvif->ar;
  98         void *ie;
  99         size_t len;
 100
 101         lockdep_assert_held(&ar->data_lock);
 102
 103         ath10k_p2p_noa_ie_assign(arvif, NULL, 0);
 104
 105         len = ath10k_p2p_noa_ie_len_compute(noa);
 106         if (!len)
 107                 return;
 108
 109         ie = kmalloc(len, GFP_ATOMIC);
 110         if (!ie)
 111                 return;
 112
 113         ath10k_p2p_noa_ie_fill(ie, len, noa);
 114         ath10k_p2p_noa_ie_assign(arvif, ie, len);
 115 }
 116
 117 void ath10k_p2p_noa_update(struct ath10k_vif *arvif,
 118                            const struct wmi_p2p_noa_info *noa)
 119 {
 120         struct ath10k *ar = arvif->ar;
 121
 122         spin_lock_bh(&ar->data_lock);
 123         __ath10k_p2p_noa_update(arvif, noa);
 124         spin_unlock_bh(&ar->data_lock);
 125 }
 126
 127 struct ath10k_p2p_noa_arg {
 128         u32 vdev_id;
 129         const struct wmi_p2p_noa_info *noa;
 130 };
 131
 132 static void ath10k_p2p_noa_update_vdev_iter(void *data, u8 *mac,
 133                                             struct ieee80211_vif *vif)
 134 {
 135         struct ath10k_vif *arvif = ath10k_vif_to_arvif(vif);
 136         struct ath10k_p2p_noa_arg *arg = data;
 137
 138         if (arvif->vdev_id != arg->vdev_id)
 139                 return;
 140
 141         ath10k_p2p_noa_update(arvif, arg->noa);
 142 }
 143
 144 void ath10k_p2p_noa_update_by_vdev_id(struct ath10k *ar, u32 vdev_id,
 145                                       const struct wmi_p2p_noa_info *noa)
 146 {
 147         struct ath10k_p2p_noa_arg arg = {
 148                 .vdev_id = vdev_id,
 149                 .noa = noa,
 150         };
 151
 152         ieee80211_iterate_active_interfaces_atomic(ar->hw,
 153                                                    IEEE80211_IFACE_ITER_NORMAL,
 154                                                    ath10k_p2p_noa_update_vdev_iter,
 155                                                    &arg);
 156 }