Skip to content

Commit

Permalink
staging: wilc1000: make use of cfg80211_inform_bss_frame()
Browse files Browse the repository at this point in the history
Use cfg80211_inform_bss_frame() api instead of cfg80211_inform_bss() to
inform cfg80211 about the BSS frame, to avoid unnecessary parsing of
frame in driver.

Signed-off-by: Ajay Singh <ajay.kathat@microchip.com>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
  • Loading branch information
ajaykathat authored and gregkh committed Jan 18, 2019
1 parent 6c2cfb4 commit 6cd4fa5
Show file tree
Hide file tree
Showing 3 changed files with 50 additions and 150 deletions.
144 changes: 28 additions & 116 deletions drivers/staging/wilc1000/host_interface.c
Original file line number Diff line number Diff line change
Expand Up @@ -72,7 +72,7 @@ struct wilc_gtk_key {
} __packed;

union message_body {
struct rcvd_net_info net_info;
struct wilc_rcvd_net_info net_info;
struct rcvd_async_info async_info;
struct set_multicast multicast_info;
struct remain_ch remain_on_ch;
Expand Down Expand Up @@ -743,129 +743,38 @@ void *wilc_parse_join_bss_param(struct cfg80211_bss *bss)
return (void *)param;
}

static inline u8 *get_bssid(struct ieee80211_mgmt *mgmt)
{
if (ieee80211_has_fromds(mgmt->frame_control))
return mgmt->sa;
else if (ieee80211_has_tods(mgmt->frame_control))
return mgmt->da;
else
return mgmt->bssid;
}

static s32 wilc_parse_network_info(u8 *msg_buffer,
struct network_info **ret_network_info)
static void handle_rcvd_ntwrk_info(struct work_struct *work)
{
struct network_info *info;
struct ieee80211_mgmt *mgt;
u8 *wid_val, *ies;
u16 wid_len, rx_len, ies_len;
u8 msg_type;
struct host_if_msg *msg = container_of(work, struct host_if_msg, work);
struct wilc_rcvd_net_info *rcvd_info = &msg->body.net_info;
struct user_scan_req *scan_req = &msg->vif->hif_drv->usr_scan_req;
const u8 *ch_elm;
u8 *ies;
int ies_len;
size_t offset;
const u8 *ch_elm, *tim_elm, *ssid_elm;

msg_type = msg_buffer[0];
if ('N' != msg_type)
return -EFAULT;

wid_len = get_unaligned_le16(&msg_buffer[6]);
wid_val = &msg_buffer[8];

info = kzalloc(sizeof(*info), GFP_KERNEL);
if (!info)
return -ENOMEM;

info->rssi = wid_val[0];

mgt = (struct ieee80211_mgmt *)&wid_val[1];
rx_len = wid_len - 1;

if (ieee80211_is_probe_resp(mgt->frame_control)) {
info->cap_info = le16_to_cpu(mgt->u.probe_resp.capab_info);
info->beacon_period = le16_to_cpu(mgt->u.probe_resp.beacon_int);
info->tsf = le64_to_cpu(mgt->u.probe_resp.timestamp);
info->tsf_lo = (u32)info->tsf;
if (ieee80211_is_probe_resp(rcvd_info->mgmt->frame_control))
offset = offsetof(struct ieee80211_mgmt, u.probe_resp.variable);
} else if (ieee80211_is_beacon(mgt->frame_control)) {
info->cap_info = le16_to_cpu(mgt->u.beacon.capab_info);
info->beacon_period = le16_to_cpu(mgt->u.beacon.beacon_int);
info->tsf = le64_to_cpu(mgt->u.beacon.timestamp);
info->tsf_lo = (u32)info->tsf;
else if (ieee80211_is_beacon(rcvd_info->mgmt->frame_control))
offset = offsetof(struct ieee80211_mgmt, u.beacon.variable);
} else {
/* only process probe response and beacon frame */
kfree(info);
return -EIO;
}

ether_addr_copy(info->bssid, get_bssid(mgt));

ies = mgt->u.beacon.variable;
ies_len = rx_len - offset;
if (ies_len <= 0) {
kfree(info);
return -EIO;
}

info->ies = kmemdup(ies, ies_len, GFP_KERNEL);
if (!info->ies) {
kfree(info);
return -ENOMEM;
}

info->ies_len = ies_len;
else
goto done;

ssid_elm = cfg80211_find_ie(WLAN_EID_SSID, ies, ies_len);
if (ssid_elm) {
info->ssid_len = ssid_elm[1];
if (info->ssid_len <= IEEE80211_MAX_SSID_LEN)
memcpy(info->ssid, ssid_elm + 2, info->ssid_len);
else
info->ssid_len = 0;
}
ies = rcvd_info->mgmt->u.beacon.variable;
ies_len = rcvd_info->frame_len - offset;
if (ies_len <= 0)
goto done;

ch_elm = cfg80211_find_ie(WLAN_EID_DS_PARAMS, ies, ies_len);
if (ch_elm && ch_elm[1] > 0)
info->ch = ch_elm[2];

tim_elm = cfg80211_find_ie(WLAN_EID_TIM, ies, ies_len);
if (tim_elm && tim_elm[1] >= 2)
info->dtim_period = tim_elm[3];

*ret_network_info = info;

return 0;
}

static void handle_rcvd_ntwrk_info(struct work_struct *work)
{
struct host_if_msg *msg = container_of(work, struct host_if_msg, work);
struct wilc_vif *vif = msg->vif;
struct rcvd_net_info *rcvd_info = &msg->body.net_info;
struct network_info *info = NULL;
struct user_scan_req *scan_req = &vif->hif_drv->usr_scan_req;

if (!scan_req->scan_result)
goto done;
rcvd_info->ch = ch_elm[2];

wilc_parse_network_info(rcvd_info->buffer, &info);
if (!info) {
netdev_err(vif->ndev, "%s: info is NULL\n",
__func__);
goto done;
}

scan_req->scan_result(SCAN_EVENT_NETWORK_FOUND, info, scan_req->arg);
if (scan_req->scan_result)
scan_req->scan_result(SCAN_EVENT_NETWORK_FOUND, rcvd_info,
scan_req->arg);

done:
kfree(rcvd_info->buffer);
rcvd_info->buffer = NULL;

if (info) {
kfree(info->ies);
kfree(info);
}

kfree(rcvd_info->mgmt);
kfree(msg);
}

Expand Down Expand Up @@ -2143,17 +2052,20 @@ void wilc_network_info_received(struct wilc *wilc, u8 *buffer, u32 length)
if (IS_ERR(msg))
return;

msg->body.net_info.len = length;
msg->body.net_info.buffer = kmemdup(buffer, length, GFP_KERNEL);
if (!msg->body.net_info.buffer) {
msg->body.net_info.frame_len = get_unaligned_le16(&buffer[6]) - 1;
msg->body.net_info.rssi = buffer[8];
msg->body.net_info.mgmt = kmemdup(&buffer[9],
msg->body.net_info.frame_len,
GFP_KERNEL);
if (!msg->body.net_info.mgmt) {
kfree(msg);
return;
}

result = wilc_enqueue_work(msg);
if (result) {
netdev_err(vif->ndev, "%s: enqueue work failed\n", __func__);
kfree(msg->body.net_info.buffer);
kfree(msg->body.net_info.mgmt);
kfree(msg);
}
}
Expand Down
14 changes: 8 additions & 6 deletions drivers/staging/wilc1000/host_interface.h
Original file line number Diff line number Diff line change
Expand Up @@ -127,7 +127,14 @@ enum conn_event {
CONN_DISCONN_EVENT_FORCE_32BIT = 0xFFFFFFFF
};

typedef void (*wilc_scan_result)(enum scan_event, struct network_info *,
struct wilc_rcvd_net_info {
s8 rssi;
u8 ch;
u16 frame_len;
struct ieee80211_mgmt *mgmt;
};

typedef void (*wilc_scan_result)(enum scan_event, struct wilc_rcvd_net_info *,
void *);

typedef void (*wilc_connect_result)(enum conn_event,
Expand All @@ -139,11 +146,6 @@ typedef void (*wilc_connect_result)(enum conn_event,
typedef void (*wilc_remain_on_chan_expired)(void *, u32);
typedef void (*wilc_remain_on_chan_ready)(void *);

struct rcvd_net_info {
u8 *buffer;
u32 len;
};

struct hidden_net_info {
u8 *ssid;
u8 ssid_len;
Expand Down
42 changes: 14 additions & 28 deletions drivers/staging/wilc1000/wilc_wfi_cfgoperations.c
Original file line number Diff line number Diff line change
Expand Up @@ -82,48 +82,34 @@ static void clear_during_ip(struct timer_list *t)
}

static void cfg_scan_result(enum scan_event scan_event,
struct network_info *network_info,
void *user_void)
struct wilc_rcvd_net_info *info, void *user_void)
{
struct wilc_priv *priv;
struct wiphy *wiphy;
s32 freq;
struct ieee80211_channel *channel;
struct cfg80211_bss *bss;
struct wilc_priv *priv = user_void;

priv = user_void;
if (!priv->cfg_scanning)
return;

if (scan_event == SCAN_EVENT_NETWORK_FOUND) {
wiphy = priv->dev->ieee80211_ptr->wiphy;

if (!wiphy || !network_info)
return;
s32 freq;
struct ieee80211_channel *channel;
struct cfg80211_bss *bss;
struct wiphy *wiphy = priv->dev->ieee80211_ptr->wiphy;

if (wiphy->signal_type == CFG80211_SIGNAL_TYPE_UNSPEC &&
(((s32)network_info->rssi * 100) < 0 ||
((s32)network_info->rssi * 100) > 100))
if (!wiphy || !info)
return;

freq = ieee80211_channel_to_frequency((s32)network_info->ch,
freq = ieee80211_channel_to_frequency((s32)info->ch,
NL80211_BAND_2GHZ);
channel = ieee80211_get_channel(wiphy, freq);
if (!channel)
return;

bss = cfg80211_inform_bss(wiphy,
channel,
CFG80211_BSS_FTYPE_UNKNOWN,
network_info->bssid,
network_info->tsf,
network_info->cap_info,
network_info->beacon_period,
(const u8 *)network_info->ies,
(size_t)network_info->ies_len,
(s32)network_info->rssi * 100,
GFP_KERNEL);
cfg80211_put_bss(wiphy, bss);
bss = cfg80211_inform_bss_frame(wiphy, channel, info->mgmt,
info->frame_len,
(s32)info->rssi * 100,
GFP_KERNEL);
if (!bss)
cfg80211_put_bss(wiphy, bss);
} else if (scan_event == SCAN_EVENT_DONE) {
mutex_lock(&priv->scan_req_lock);

Expand Down

0 comments on commit 6cd4fa5

Please sign in to comment.