251 lines
		
	
	
		
			6.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			251 lines
		
	
	
		
			6.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * This file is part of wl12xx
 | |
|  *
 | |
|  * Copyright (C) 2012 Texas Instruments. All rights reserved.
 | |
|  *
 | |
|  * 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.
 | |
|  *
 | |
|  * This program is distributed in the hope that it will be useful, but
 | |
|  * WITHOUT ANY WARRANTY; without even the implied warranty of
 | |
|  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 | |
|  * General Public License for more details.
 | |
|  *
 | |
|  * You should have received a copy of the GNU General Public License
 | |
|  * along with this program; if not, write to the Free Software
 | |
|  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
 | |
|  * 02110-1301 USA
 | |
|  *
 | |
|  */
 | |
| 
 | |
| #include <net/genetlink.h>
 | |
| #include "event.h"
 | |
| #include "scan.h"
 | |
| #include "conf.h"
 | |
| #include "../wlcore/cmd.h"
 | |
| #include "../wlcore/debug.h"
 | |
| #include "../wlcore/vendor_cmd.h"
 | |
| 
 | |
| int wl18xx_wait_for_event(struct wl1271 *wl, enum wlcore_wait_event event,
 | |
| 			  bool *timeout)
 | |
| {
 | |
| 	u32 local_event;
 | |
| 
 | |
| 	switch (event) {
 | |
| 	case WLCORE_EVENT_PEER_REMOVE_COMPLETE:
 | |
| 		local_event = PEER_REMOVE_COMPLETE_EVENT_ID;
 | |
| 		break;
 | |
| 
 | |
| 	case WLCORE_EVENT_DFS_CONFIG_COMPLETE:
 | |
| 		local_event = DFS_CHANNELS_CONFIG_COMPLETE_EVENT;
 | |
| 		break;
 | |
| 
 | |
| 	default:
 | |
| 		/* event not implemented */
 | |
| 		return 0;
 | |
| 	}
 | |
| 	return wlcore_cmd_wait_for_event_or_timeout(wl, local_event, timeout);
 | |
| }
 | |
| 
 | |
| static const char *wl18xx_radar_type_decode(u8 radar_type)
 | |
| {
 | |
| 	switch (radar_type) {
 | |
| 	case RADAR_TYPE_REGULAR:
 | |
| 		return "REGULAR";
 | |
| 	case RADAR_TYPE_CHIRP:
 | |
| 		return "CHIRP";
 | |
| 	case RADAR_TYPE_NONE:
 | |
| 	default:
 | |
| 		return "N/A";
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static int wlcore_smart_config_sync_event(struct wl1271 *wl, u8 sync_channel,
 | |
| 					  u8 sync_band)
 | |
| {
 | |
| 	struct sk_buff *skb;
 | |
| 	enum nl80211_band band;
 | |
| 	int freq;
 | |
| 
 | |
| 	if (sync_band == WLCORE_BAND_5GHZ)
 | |
| 		band = NL80211_BAND_5GHZ;
 | |
| 	else
 | |
| 		band = NL80211_BAND_2GHZ;
 | |
| 
 | |
| 	freq = ieee80211_channel_to_frequency(sync_channel, band);
 | |
| 
 | |
| 	wl1271_debug(DEBUG_EVENT,
 | |
| 		     "SMART_CONFIG_SYNC_EVENT_ID, freq: %d (chan: %d band %d)",
 | |
| 		     freq, sync_channel, sync_band);
 | |
| 	skb = cfg80211_vendor_event_alloc(wl->hw->wiphy, NULL, 20,
 | |
| 					  WLCORE_VENDOR_EVENT_SC_SYNC,
 | |
| 					  GFP_KERNEL);
 | |
| 
 | |
| 	if (nla_put_u32(skb, WLCORE_VENDOR_ATTR_FREQ, freq)) {
 | |
| 		kfree_skb(skb);
 | |
| 		return -EMSGSIZE;
 | |
| 	}
 | |
| 	cfg80211_vendor_event(skb, GFP_KERNEL);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int wlcore_smart_config_decode_event(struct wl1271 *wl,
 | |
| 					    u8 ssid_len, u8 *ssid,
 | |
| 					    u8 pwd_len, u8 *pwd)
 | |
| {
 | |
| 	struct sk_buff *skb;
 | |
| 
 | |
| 	wl1271_debug(DEBUG_EVENT, "SMART_CONFIG_DECODE_EVENT_ID");
 | |
| 	wl1271_dump_ascii(DEBUG_EVENT, "SSID:", ssid, ssid_len);
 | |
| 
 | |
| 	skb = cfg80211_vendor_event_alloc(wl->hw->wiphy, NULL,
 | |
| 					  ssid_len + pwd_len + 20,
 | |
| 					  WLCORE_VENDOR_EVENT_SC_DECODE,
 | |
| 					  GFP_KERNEL);
 | |
| 
 | |
| 	if (nla_put(skb, WLCORE_VENDOR_ATTR_SSID, ssid_len, ssid) ||
 | |
| 	    nla_put(skb, WLCORE_VENDOR_ATTR_PSK, pwd_len, pwd)) {
 | |
| 		kfree_skb(skb);
 | |
| 		return -EMSGSIZE;
 | |
| 	}
 | |
| 	cfg80211_vendor_event(skb, GFP_KERNEL);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void wlcore_event_time_sync(struct wl1271 *wl,
 | |
| 				   u16 tsf_high_msb, u16 tsf_high_lsb,
 | |
| 				   u16 tsf_low_msb, u16 tsf_low_lsb)
 | |
| {
 | |
| 	u32 clock_low;
 | |
| 	u32 clock_high;
 | |
| 
 | |
| 	clock_high = (tsf_high_msb << 16) | tsf_high_lsb;
 | |
| 	clock_low = (tsf_low_msb << 16) | tsf_low_lsb;
 | |
| 
 | |
| 	wl1271_info("TIME_SYNC_EVENT_ID: clock_high %u, clock low %u",
 | |
| 		    clock_high, clock_low);
 | |
| }
 | |
| 
 | |
| int wl18xx_process_mailbox_events(struct wl1271 *wl)
 | |
| {
 | |
| 	struct wl18xx_event_mailbox *mbox = wl->mbox;
 | |
| 	u32 vector;
 | |
| 
 | |
| 	vector = le32_to_cpu(mbox->events_vector);
 | |
| 	wl1271_debug(DEBUG_EVENT, "MBOX vector: 0x%x", vector);
 | |
| 
 | |
| 	if (vector & SCAN_COMPLETE_EVENT_ID) {
 | |
| 		wl1271_debug(DEBUG_EVENT, "scan results: %d",
 | |
| 			     mbox->number_of_scan_results);
 | |
| 
 | |
| 		if (wl->scan_wlvif)
 | |
| 			wl18xx_scan_completed(wl, wl->scan_wlvif);
 | |
| 	}
 | |
| 
 | |
| 	if (vector & TIME_SYNC_EVENT_ID)
 | |
| 		wlcore_event_time_sync(wl,
 | |
| 			mbox->time_sync_tsf_high_msb,
 | |
| 			mbox->time_sync_tsf_high_lsb,
 | |
| 			mbox->time_sync_tsf_low_msb,
 | |
| 			mbox->time_sync_tsf_low_lsb);
 | |
| 
 | |
| 	if (vector & RADAR_DETECTED_EVENT_ID) {
 | |
| 		wl1271_info("radar event: channel %d type %s",
 | |
| 			    mbox->radar_channel,
 | |
| 			    wl18xx_radar_type_decode(mbox->radar_type));
 | |
| 
 | |
| 		if (!wl->radar_debug_mode)
 | |
| 			ieee80211_radar_detected(wl->hw);
 | |
| 	}
 | |
| 
 | |
| 	if (vector & PERIODIC_SCAN_REPORT_EVENT_ID) {
 | |
| 		wl1271_debug(DEBUG_EVENT,
 | |
| 			     "PERIODIC_SCAN_REPORT_EVENT (results %d)",
 | |
| 			     mbox->number_of_sched_scan_results);
 | |
| 
 | |
| 		wlcore_scan_sched_scan_results(wl);
 | |
| 	}
 | |
| 
 | |
| 	if (vector & PERIODIC_SCAN_COMPLETE_EVENT_ID)
 | |
| 		wlcore_event_sched_scan_completed(wl, 1);
 | |
| 
 | |
| 	if (vector & RSSI_SNR_TRIGGER_0_EVENT_ID)
 | |
| 		wlcore_event_rssi_trigger(wl, mbox->rssi_snr_trigger_metric);
 | |
| 
 | |
| 	if (vector & BA_SESSION_RX_CONSTRAINT_EVENT_ID)
 | |
| 		wlcore_event_ba_rx_constraint(wl,
 | |
| 				le16_to_cpu(mbox->rx_ba_role_id_bitmap),
 | |
| 				le16_to_cpu(mbox->rx_ba_allowed_bitmap));
 | |
| 
 | |
| 	if (vector & BSS_LOSS_EVENT_ID)
 | |
| 		wlcore_event_beacon_loss(wl,
 | |
| 					 le16_to_cpu(mbox->bss_loss_bitmap));
 | |
| 
 | |
| 	if (vector & CHANNEL_SWITCH_COMPLETE_EVENT_ID)
 | |
| 		wlcore_event_channel_switch(wl,
 | |
| 			le16_to_cpu(mbox->channel_switch_role_id_bitmap),
 | |
| 			true);
 | |
| 
 | |
| 	if (vector & DUMMY_PACKET_EVENT_ID)
 | |
| 		wlcore_event_dummy_packet(wl);
 | |
| 
 | |
| 	/*
 | |
| 	 * "TX retries exceeded" has a different meaning according to mode.
 | |
| 	 * In AP mode the offending station is disconnected.
 | |
| 	 */
 | |
| 	if (vector & MAX_TX_FAILURE_EVENT_ID)
 | |
| 		wlcore_event_max_tx_failure(wl,
 | |
| 				le16_to_cpu(mbox->tx_retry_exceeded_bitmap));
 | |
| 
 | |
| 	if (vector & INACTIVE_STA_EVENT_ID)
 | |
| 		wlcore_event_inactive_sta(wl,
 | |
| 				le16_to_cpu(mbox->inactive_sta_bitmap));
 | |
| 
 | |
| 	if (vector & REMAIN_ON_CHANNEL_COMPLETE_EVENT_ID)
 | |
| 		wlcore_event_roc_complete(wl);
 | |
| 
 | |
| 	if (vector & SMART_CONFIG_SYNC_EVENT_ID)
 | |
| 		wlcore_smart_config_sync_event(wl, mbox->sc_sync_channel,
 | |
| 					       mbox->sc_sync_band);
 | |
| 
 | |
| 	if (vector & SMART_CONFIG_DECODE_EVENT_ID)
 | |
| 		wlcore_smart_config_decode_event(wl,
 | |
| 						 mbox->sc_ssid_len,
 | |
| 						 mbox->sc_ssid,
 | |
| 						 mbox->sc_pwd_len,
 | |
| 						 mbox->sc_pwd);
 | |
| 	if (vector & FW_LOGGER_INDICATION)
 | |
| 		wlcore_event_fw_logger(wl);
 | |
| 
 | |
| 	if (vector & RX_BA_WIN_SIZE_CHANGE_EVENT_ID) {
 | |
| 		struct wl12xx_vif *wlvif;
 | |
| 		struct ieee80211_vif *vif;
 | |
| 		struct ieee80211_sta *sta;
 | |
| 		u8 link_id = mbox->rx_ba_link_id;
 | |
| 		u8 win_size = mbox->rx_ba_win_size;
 | |
| 		const u8 *addr;
 | |
| 
 | |
| 		wlvif = wl->links[link_id].wlvif;
 | |
| 		vif = wl12xx_wlvif_to_vif(wlvif);
 | |
| 
 | |
| 		/* Update RX aggregation window size and call
 | |
| 		 * MAC routine to stop active RX aggregations for this link
 | |
| 		 */
 | |
| 		if (wlvif->bss_type != BSS_TYPE_AP_BSS)
 | |
| 			addr = vif->bss_conf.bssid;
 | |
| 		else
 | |
| 			addr = wl->links[link_id].addr;
 | |
| 
 | |
| 		sta = ieee80211_find_sta(vif, addr);
 | |
| 		if (sta) {
 | |
| 			sta->max_rx_aggregation_subframes = win_size;
 | |
| 			ieee80211_stop_rx_ba_session(vif,
 | |
| 						wl->links[link_id].ba_bitmap,
 | |
| 						addr);
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 |