[deliverable/linux.git] / drivers / net / wireless / marvell / mwifiex / 11h.c

/*
 * Marvell Wireless LAN device driver: 802.11h
 *
 * Copyright (C) 2013-2014, Marvell International Ltd.
 *
 * This software file (the "File") is distributed by Marvell International
 * Ltd. under the terms of the GNU General Public License Version 2, June 1991
 * (the "License").  You may use, redistribute and/or modify this File in
 * accordance with the terms and conditions of the License, a copy of which
 * is available by writing to the Free Software Foundation, Inc.,
 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
 * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
 *
 * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
 * ARE EXPRESSLY DISCLAIMED.  The License provides additional details about
 * this warranty disclaimer.
 */

#include "main.h"
#include "fw.h"


void mwifiex_init_11h_params(struct mwifiex_private *priv)
{
	priv->state_11h.is_11h_enabled = true;
	priv->state_11h.is_11h_active = false;
}

inline int mwifiex_is_11h_active(struct mwifiex_private *priv)
{
	return priv->state_11h.is_11h_active;
}
/* This function appends 11h info to a buffer while joining an
 * infrastructure BSS
 */
static void
mwifiex_11h_process_infra_join(struct mwifiex_private *priv, u8 **buffer,
			       struct mwifiex_bssdescriptor *bss_desc)
{
	struct mwifiex_ie_types_header *ie_header;
	struct mwifiex_ie_types_pwr_capability *cap;
	struct mwifiex_ie_types_local_pwr_constraint *constraint;
	struct ieee80211_supported_band *sband;
	u8 radio_type;
	int i;

	if (!buffer || !(*buffer))
		return;

	radio_type = mwifiex_band_to_radio_type((u8) bss_desc->bss_band);
	sband = priv->wdev.wiphy->bands[radio_type];

	cap = (struct mwifiex_ie_types_pwr_capability *)*buffer;
	cap->header.type = cpu_to_le16(WLAN_EID_PWR_CAPABILITY);
	cap->header.len = cpu_to_le16(2);
	cap->min_pwr = 0;
	cap->max_pwr = 0;
	*buffer += sizeof(*cap);

	constraint = (struct mwifiex_ie_types_local_pwr_constraint *)*buffer;
	constraint->header.type = cpu_to_le16(WLAN_EID_PWR_CONSTRAINT);
	constraint->header.len = cpu_to_le16(2);
	constraint->chan = bss_desc->channel;
	constraint->constraint = bss_desc->local_constraint;
	*buffer += sizeof(*constraint);

	ie_header = (struct mwifiex_ie_types_header *)*buffer;
	ie_header->type = cpu_to_le16(TLV_TYPE_PASSTHROUGH);
	ie_header->len  = cpu_to_le16(2 * sband->n_channels + 2);
	*buffer += sizeof(*ie_header);
	*(*buffer)++ = WLAN_EID_SUPPORTED_CHANNELS;
	*(*buffer)++ = 2 * sband->n_channels;
	for (i = 0; i < sband->n_channels; i++) {
		*(*buffer)++ = ieee80211_frequency_to_channel(
					sband->channels[i].center_freq);
		*(*buffer)++ = 1; /* one channel in the subband */
	}
}

/* Enable or disable the 11h extensions in the firmware */
int mwifiex_11h_activate(struct mwifiex_private *priv, bool flag)
{
	u32 enable = flag;

	/* enable master mode radar detection on AP interface */
	if ((GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_UAP) && enable)
		enable |= MWIFIEX_MASTER_RADAR_DET_MASK;

	return mwifiex_send_cmd(priv, HostCmd_CMD_802_11_SNMP_MIB,
				HostCmd_ACT_GEN_SET, DOT11H_I, &enable, true);
}

/* This functions processes TLV buffer for a pending BSS Join command.
 *
 * Activate 11h functionality in the firmware if the spectrum management
 * capability bit is found in the network we are joining. Also, necessary
 * TLVs are set based on requested network's 11h capability.
 */
void mwifiex_11h_process_join(struct mwifiex_private *priv, u8 **buffer,
			      struct mwifiex_bssdescriptor *bss_desc)
{
	if (bss_desc->sensed_11h) {
		/* Activate 11h functions in firmware, turns on capability
		 * bit
		 */
		mwifiex_11h_activate(priv, true);
		priv->state_11h.is_11h_active = true;
		bss_desc->cap_info_bitmap |= WLAN_CAPABILITY_SPECTRUM_MGMT;
		mwifiex_11h_process_infra_join(priv, buffer, bss_desc);
	} else {
		/* Deactivate 11h functions in the firmware */
		mwifiex_11h_activate(priv, false);
		priv->state_11h.is_11h_active = false;
		bss_desc->cap_info_bitmap &= ~WLAN_CAPABILITY_SPECTRUM_MGMT;
	}
}

/* This is DFS CAC work queue function.
 * This delayed work emits CAC finished event for cfg80211 if
 * CAC was started earlier.
 */
void mwifiex_dfs_cac_work_queue(struct work_struct *work)
{
	struct cfg80211_chan_def chandef;
	struct delayed_work *delayed_work = to_delayed_work(work);
	struct mwifiex_private *priv =
			container_of(delayed_work, struct mwifiex_private,
				     dfs_cac_work);

	if (WARN_ON(!priv))
		return;

	chandef = priv->dfs_chandef;
	if (priv->wdev.cac_started) {
		mwifiex_dbg(priv->adapter, MSG,
			    "CAC timer finished; No radar detected\n");
		cfg80211_cac_event(priv->netdev, &chandef,
				   NL80211_RADAR_CAC_FINISHED,
				   GFP_KERNEL);
	}
}

/* This function prepares channel report request command to FW for
 * starting radar detection.
 */
int mwifiex_cmd_issue_chan_report_request(struct mwifiex_private *priv,
					  struct host_cmd_ds_command *cmd,
					  void *data_buf)
{
	struct host_cmd_ds_chan_rpt_req *cr_req = &cmd->params.chan_rpt_req;
	struct mwifiex_radar_params *radar_params = (void *)data_buf;

	cmd->command = cpu_to_le16(HostCmd_CMD_CHAN_REPORT_REQUEST);
	cmd->size = cpu_to_le16(S_DS_GEN);
	le16_add_cpu(&cmd->size, sizeof(struct host_cmd_ds_chan_rpt_req));

	cr_req->chan_desc.start_freq = cpu_to_le16(MWIFIEX_A_BAND_START_FREQ);
	cr_req->chan_desc.chan_num = radar_params->chandef->chan->hw_value;
	cr_req->chan_desc.chan_width = radar_params->chandef->width;
	cr_req->msec_dwell_time = cpu_to_le32(radar_params->cac_time_ms);

	if (radar_params->cac_time_ms)
		mwifiex_dbg(priv->adapter, MSG,
			    "11h: issuing DFS Radar check for channel=%d\n",
			    radar_params->chandef->chan->hw_value);
	else
		mwifiex_dbg(priv->adapter, MSG, "cancelling CAC\n");

	return 0;
}

int mwifiex_stop_radar_detection(struct mwifiex_private *priv,
				 struct cfg80211_chan_def *chandef)
{
	struct mwifiex_radar_params radar_params;

	memset(&radar_params, 0, sizeof(struct mwifiex_radar_params));
	radar_params.chandef = chandef;
	radar_params.cac_time_ms = 0;

	return mwifiex_send_cmd(priv, HostCmd_CMD_CHAN_REPORT_REQUEST,
				HostCmd_ACT_GEN_SET, 0, &radar_params, true);
}

/* This function is to abort ongoing CAC upon stopping AP operations
 * or during unload.
 */
void mwifiex_abort_cac(struct mwifiex_private *priv)
{
	if (priv->wdev.cac_started) {
		if (mwifiex_stop_radar_detection(priv, &priv->dfs_chandef))
			mwifiex_dbg(priv->adapter, ERROR,
				    "failed to stop CAC in FW\n");
		mwifiex_dbg(priv->adapter, MSG,
			    "Aborting delayed work for CAC.\n");
		cancel_delayed_work_sync(&priv->dfs_cac_work);
		cfg80211_cac_event(priv->netdev, &priv->dfs_chandef,
				   NL80211_RADAR_CAC_ABORTED, GFP_KERNEL);
	}
}

/* This function handles channel report event from FW during CAC period.
 * If radar is detected during CAC, driver indicates the same to cfg80211
 * and also cancels ongoing delayed work.
 */
int mwifiex_11h_handle_chanrpt_ready(struct mwifiex_private *priv,
				     struct sk_buff *skb)
{
	struct host_cmd_ds_chan_rpt_event *rpt_event;
	struct mwifiex_ie_types_chan_rpt_data *rpt;
	u8 *evt_buf;
	u16 event_len, tlv_len;

	rpt_event = (void *)(skb->data + sizeof(u32));
	event_len = skb->len - (sizeof(struct host_cmd_ds_chan_rpt_event)+
				sizeof(u32));

	if (le32_to_cpu(rpt_event->result) != HostCmd_RESULT_OK) {
		mwifiex_dbg(priv->adapter, ERROR,
			    "Error in channel report event\n");
		return -1;
	}

	evt_buf = (void *)&rpt_event->tlvbuf;

	while (event_len >= sizeof(struct mwifiex_ie_types_header)) {
		rpt = (void *)&rpt_event->tlvbuf;
		tlv_len = le16_to_cpu(rpt->header.len);

		switch (le16_to_cpu(rpt->header.type)) {
		case TLV_TYPE_CHANRPT_11H_BASIC:
			if (rpt->map.radar) {
				mwifiex_dbg(priv->adapter, MSG,
					    "RADAR Detected on channel %d!\n",
					    priv->dfs_chandef.chan->hw_value);
				cancel_delayed_work_sync(&priv->dfs_cac_work);
				cfg80211_cac_event(priv->netdev,
						   &priv->dfs_chandef,
						   NL80211_RADAR_DETECTED,
						   GFP_KERNEL);
			}
			break;
		default:
			break;
		}

		evt_buf += (tlv_len + sizeof(rpt->header));
		event_len -= (tlv_len + sizeof(rpt->header));
	}

	return 0;
}

/* Handler for radar detected event from FW.*/
int mwifiex_11h_handle_radar_detected(struct mwifiex_private *priv,
				      struct sk_buff *skb)
{
	struct mwifiex_radar_det_event *rdr_event;

	rdr_event = (void *)(skb->data + sizeof(u32));

	mwifiex_dbg(priv->adapter, MSG,
		    "radar detected; indicating kernel\n");
	if (mwifiex_stop_radar_detection(priv, &priv->dfs_chandef))
		mwifiex_dbg(priv->adapter, ERROR,
			    "Failed to stop CAC in FW\n");
	cfg80211_radar_event(priv->adapter->wiphy, &priv->dfs_chandef,
			     GFP_KERNEL);
	mwifiex_dbg(priv->adapter, MSG, "regdomain: %d\n",
		    rdr_event->reg_domain);
	mwifiex_dbg(priv->adapter, MSG, "radar detection type: %d\n",
		    rdr_event->det_type);

	return 0;
}

/* This is work queue function for channel switch handling.
 * This function takes care of updating new channel definitin to
 * bss config structure, restart AP and indicate channel switch success
 * to cfg80211.
 */
void mwifiex_dfs_chan_sw_work_queue(struct work_struct *work)
{
	struct mwifiex_uap_bss_param *bss_cfg;
	struct delayed_work *delayed_work = to_delayed_work(work);
	struct mwifiex_private *priv =
			container_of(delayed_work, struct mwifiex_private,
				     dfs_chan_sw_work);

	if (WARN_ON(!priv))
		return;

	bss_cfg = &priv->bss_cfg;
	if (!bss_cfg->beacon_period) {
		mwifiex_dbg(priv->adapter, ERROR,
			    "channel switch: AP already stopped\n");
		return;
	}

	mwifiex_uap_set_channel(priv, bss_cfg, priv->dfs_chandef);

	if (mwifiex_config_start_uap(priv, bss_cfg)) {
		mwifiex_dbg(priv->adapter, ERROR,
			    "Failed to start AP after channel switch\n");
		return;
	}

	mwifiex_dbg(priv->adapter, MSG,
		    "indicating channel switch completion to kernel\n");
	cfg80211_ch_switch_notify(priv->netdev, &priv->dfs_chandef);
}
Commit	Line	Data
2a7305c8 AK	1	/*
	2	* Marvell Wireless LAN device driver: 802.11h
	3	*
65da33f5	4	* Copyright (C) 2013-2014, Marvell International Ltd.
2a7305c8 AK	5	*
	6	* This software file (the "File") is distributed by Marvell International
	7	* Ltd. under the terms of the GNU General Public License Version 2, June 1991
	8	* (the "License"). You may use, redistribute and/or modify this File in
	9	* accordance with the terms and conditions of the License, a copy of which
	10	* is available by writing to the Free Software Foundation, Inc.,
	11	* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
	12	* worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
	13	*
	14	* THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
	15	* IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
	16	* ARE EXPRESSLY DISCLAIMED. The License provides additional details about
	17	* this warranty disclaimer.
	18	*/
	19
	20	#include "main.h"
	21	#include "fw.h"
	22
	23
cf075eac AP	24	void mwifiex_init_11h_params(struct mwifiex_private *priv)
	25	{
	26	priv->state_11h.is_11h_enabled = true;
	27	priv->state_11h.is_11h_active = false;
	28	}
	29
	30	inline int mwifiex_is_11h_active(struct mwifiex_private *priv)
	31	{
	32	return priv->state_11h.is_11h_active;
	33	}
2a7305c8 AK	34	/* This function appends 11h info to a buffer while joining an
	35	* infrastructure BSS
	36	*/
	37	static void
	38	mwifiex_11h_process_infra_join(struct mwifiex_private priv, u8 *buffer,
	39	struct mwifiex_bssdescriptor *bss_desc)
	40	{
	41	struct mwifiex_ie_types_header *ie_header;
	42	struct mwifiex_ie_types_pwr_capability *cap;
	43	struct mwifiex_ie_types_local_pwr_constraint *constraint;
	44	struct ieee80211_supported_band *sband;
	45	u8 radio_type;
	46	int i;
	47
	48	if (!buffer \|\| !(*buffer))
	49	return;
	50
	51	radio_type = mwifiex_band_to_radio_type((u8) bss_desc->bss_band);
4facc34a	52	sband = priv->wdev.wiphy->bands[radio_type];
2a7305c8 AK	53
	54	cap = (struct mwifiex_ie_types_pwr_capability )buffer;
	55	cap->header.type = cpu_to_le16(WLAN_EID_PWR_CAPABILITY);
	56	cap->header.len = cpu_to_le16(2);
	57	cap->min_pwr = 0;
	58	cap->max_pwr = 0;
	59	buffer += sizeof(cap);
	60
	61	constraint = (struct mwifiex_ie_types_local_pwr_constraint )buffer;
	62	constraint->header.type = cpu_to_le16(WLAN_EID_PWR_CONSTRAINT);
	63	constraint->header.len = cpu_to_le16(2);
	64	constraint->chan = bss_desc->channel;
	65	constraint->constraint = bss_desc->local_constraint;
	66	buffer += sizeof(constraint);
	67
	68	ie_header = (struct mwifiex_ie_types_header )buffer;
	69	ie_header->type = cpu_to_le16(TLV_TYPE_PASSTHROUGH);
	70	ie_header->len = cpu_to_le16(2 * sband->n_channels + 2);
	71	buffer += sizeof(ie_header);
	72	(buffer)++ = WLAN_EID_SUPPORTED_CHANNELS;
	73	(buffer)++ = 2 * sband->n_channels;
	74	for (i = 0; i < sband->n_channels; i++) {
	75	(buffer)++ = ieee80211_frequency_to_channel(
	76	sband->channels[i].center_freq);
	77	(buffer)++ = 1; /* one channel in the subband */
	78	}
	79	}
	80
	81	/* Enable or disable the 11h extensions in the firmware */
cf075eac	82	int mwifiex_11h_activate(struct mwifiex_private *priv, bool flag)
2a7305c8 AK	83	{
	84	u32 enable = flag;
	85
cf075eac AP	86	/* enable master mode radar detection on AP interface */
	87	if ((GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_UAP) && enable)
	88	enable \|= MWIFIEX_MASTER_RADAR_DET_MASK;
	89
fa0ecbb9 BZ	90	return mwifiex_send_cmd(priv, HostCmd_CMD_802_11_SNMP_MIB,
fa0ecbb9 BZ	91	HostCmd_ACT_GEN_SET, DOT11H_I, &enable, true);
2a7305c8 AK	92	}
	93
	94	/* This functions processes TLV buffer for a pending BSS Join command.
	95	*
	96	* Activate 11h functionality in the firmware if the spectrum management
	97	* capability bit is found in the network we are joining. Also, necessary
	98	* TLVs are set based on requested network's 11h capability.
	99	*/
	100	void mwifiex_11h_process_join(struct mwifiex_private priv, u8 *buffer,
	101	struct mwifiex_bssdescriptor *bss_desc)
	102	{
	103	if (bss_desc->sensed_11h) {
	104	/* Activate 11h functions in firmware, turns on capability
	105	* bit
	106	*/
	107	mwifiex_11h_activate(priv, true);
cf075eac	108	priv->state_11h.is_11h_active = true;
2a7305c8 AK	109	bss_desc->cap_info_bitmap \|= WLAN_CAPABILITY_SPECTRUM_MGMT;
	110	mwifiex_11h_process_infra_join(priv, buffer, bss_desc);
	111	} else {
	112	/* Deactivate 11h functions in the firmware */
	113	mwifiex_11h_activate(priv, false);
cf075eac	114	priv->state_11h.is_11h_active = false;
2a7305c8 AK	115	bss_desc->cap_info_bitmap &= ~WLAN_CAPABILITY_SPECTRUM_MGMT;
	116	}
	117	}
85afb186 AP	118
	119	/* This is DFS CAC work queue function.
	120	* This delayed work emits CAC finished event for cfg80211 if
	121	* CAC was started earlier.
	122	*/
	123	void mwifiex_dfs_cac_work_queue(struct work_struct *work)
	124	{
	125	struct cfg80211_chan_def chandef;
8dd37c7c	126	struct delayed_work *delayed_work = to_delayed_work(work);
85afb186 AP	127	struct mwifiex_private *priv =
	128	container_of(delayed_work, struct mwifiex_private,
	129	dfs_cac_work);
	130
	131	if (WARN_ON(!priv))
	132	return;
	133
	134	chandef = priv->dfs_chandef;
	135	if (priv->wdev.cac_started) {
acebe8c1 ZL	136	mwifiex_dbg(priv->adapter, MSG,
acebe8c1 ZL	137	"CAC timer finished; No radar detected\n");
85afb186 AP	138	cfg80211_cac_event(priv->netdev, &chandef,
	139	NL80211_RADAR_CAC_FINISHED,
	140	GFP_KERNEL);
	141	}
	142	}
	143
	144	/* This function prepares channel report request command to FW for
	145	* starting radar detection.
	146	*/
	147	int mwifiex_cmd_issue_chan_report_request(struct mwifiex_private *priv,
	148	struct host_cmd_ds_command *cmd,
	149	void *data_buf)
	150	{
	151	struct host_cmd_ds_chan_rpt_req *cr_req = &cmd->params.chan_rpt_req;
	152	struct mwifiex_radar_params radar_params = (void )data_buf;
	153
	154	cmd->command = cpu_to_le16(HostCmd_CMD_CHAN_REPORT_REQUEST);
	155	cmd->size = cpu_to_le16(S_DS_GEN);
	156	le16_add_cpu(&cmd->size, sizeof(struct host_cmd_ds_chan_rpt_req));
	157
	158	cr_req->chan_desc.start_freq = cpu_to_le16(MWIFIEX_A_BAND_START_FREQ);
	159	cr_req->chan_desc.chan_num = radar_params->chandef->chan->hw_value;
	160	cr_req->chan_desc.chan_width = radar_params->chandef->width;
	161	cr_req->msec_dwell_time = cpu_to_le32(radar_params->cac_time_ms);
	162
511c8989 AP	163	if (radar_params->cac_time_ms)
	164	mwifiex_dbg(priv->adapter, MSG,
	165	"11h: issuing DFS Radar check for channel=%d\n",
	166	radar_params->chandef->chan->hw_value);
	167	else
	168	mwifiex_dbg(priv->adapter, MSG, "cancelling CAC\n");
85afb186 AP	169
	170	return 0;
	171	}
	172
511c8989 AP	173	int mwifiex_stop_radar_detection(struct mwifiex_private *priv,
	174	struct cfg80211_chan_def *chandef)
	175	{
	176	struct mwifiex_radar_params radar_params;
	177
	178	memset(&radar_params, 0, sizeof(struct mwifiex_radar_params));
	179	radar_params.chandef = chandef;
	180	radar_params.cac_time_ms = 0;
	181
	182	return mwifiex_send_cmd(priv, HostCmd_CMD_CHAN_REPORT_REQUEST,
	183	HostCmd_ACT_GEN_SET, 0, &radar_params, true);
	184	}
	185
85afb186 AP	186	/* This function is to abort ongoing CAC upon stopping AP operations
	187	* or during unload.
	188	*/
	189	void mwifiex_abort_cac(struct mwifiex_private *priv)
	190	{
	191	if (priv->wdev.cac_started) {
511c8989 AP	192	if (mwifiex_stop_radar_detection(priv, &priv->dfs_chandef))
	193	mwifiex_dbg(priv->adapter, ERROR,
	194	"failed to stop CAC in FW\n");
acebe8c1 ZL	195	mwifiex_dbg(priv->adapter, MSG,
acebe8c1 ZL	196	"Aborting delayed work for CAC.\n");
85afb186 AP	197	cancel_delayed_work_sync(&priv->dfs_cac_work);
	198	cfg80211_cac_event(priv->netdev, &priv->dfs_chandef,
	199	NL80211_RADAR_CAC_ABORTED, GFP_KERNEL);
	200	}
	201	}
0a694d68 AP	202
	203	/* This function handles channel report event from FW during CAC period.
	204	* If radar is detected during CAC, driver indicates the same to cfg80211
	205	* and also cancels ongoing delayed work.
	206	*/
	207	int mwifiex_11h_handle_chanrpt_ready(struct mwifiex_private *priv,
	208	struct sk_buff *skb)
	209	{
	210	struct host_cmd_ds_chan_rpt_event *rpt_event;
	211	struct mwifiex_ie_types_chan_rpt_data *rpt;
	212	u8 *evt_buf;
	213	u16 event_len, tlv_len;
	214
	215	rpt_event = (void *)(skb->data + sizeof(u32));
	216	event_len = skb->len - (sizeof(struct host_cmd_ds_chan_rpt_event)+
	217	sizeof(u32));
	218
	219	if (le32_to_cpu(rpt_event->result) != HostCmd_RESULT_OK) {
acebe8c1 ZL	220	mwifiex_dbg(priv->adapter, ERROR,
acebe8c1 ZL	221	"Error in channel report event\n");
0a694d68 AP	222	return -1;
	223	}
	224
	225	evt_buf = (void *)&rpt_event->tlvbuf;
	226
	227	while (event_len >= sizeof(struct mwifiex_ie_types_header)) {
	228	rpt = (void *)&rpt_event->tlvbuf;
	229	tlv_len = le16_to_cpu(rpt->header.len);
	230
	231	switch (le16_to_cpu(rpt->header.type)) {
	232	case TLV_TYPE_CHANRPT_11H_BASIC:
	233	if (rpt->map.radar) {
acebe8c1 ZL	234	mwifiex_dbg(priv->adapter, MSG,
acebe8c1 ZL	235	"RADAR Detected on channel %d!\n",
0a694d68 AP	236	priv->dfs_chandef.chan->hw_value);
	237	cancel_delayed_work_sync(&priv->dfs_cac_work);
	238	cfg80211_cac_event(priv->netdev,
	239	&priv->dfs_chandef,
	240	NL80211_RADAR_DETECTED,
	241	GFP_KERNEL);
	242	}
	243	break;
	244	default:
	245	break;
	246	}
	247
	248	evt_buf += (tlv_len + sizeof(rpt->header));
	249	event_len -= (tlv_len + sizeof(rpt->header));
	250	}
	251
	252	return 0;
	253	}
3b57c1a7 AP	254
	255	/* Handler for radar detected event from FW.*/
	256	int mwifiex_11h_handle_radar_detected(struct mwifiex_private *priv,
	257	struct sk_buff *skb)
	258	{
	259	struct mwifiex_radar_det_event *rdr_event;
	260
	261	rdr_event = (void *)(skb->data + sizeof(u32));
	262
441756b6 GB	263	mwifiex_dbg(priv->adapter, MSG,
	264	"radar detected; indicating kernel\n");
	265	if (mwifiex_stop_radar_detection(priv, &priv->dfs_chandef))
	266	mwifiex_dbg(priv->adapter, ERROR,
	267	"Failed to stop CAC in FW\n");
	268	cfg80211_radar_event(priv->adapter->wiphy, &priv->dfs_chandef,
	269	GFP_KERNEL);
	270	mwifiex_dbg(priv->adapter, MSG, "regdomain: %d\n",
	271	rdr_event->reg_domain);
	272	mwifiex_dbg(priv->adapter, MSG, "radar detection type: %d\n",
	273	rdr_event->det_type);
3b57c1a7 AP	274
	275	return 0;
	276	}
7d652034 AP	277
	278	/* This is work queue function for channel switch handling.
	279	* This function takes care of updating new channel definitin to
	280	* bss config structure, restart AP and indicate channel switch success
	281	* to cfg80211.
	282	*/
	283	void mwifiex_dfs_chan_sw_work_queue(struct work_struct *work)
	284	{
	285	struct mwifiex_uap_bss_param *bss_cfg;
8dd37c7c	286	struct delayed_work *delayed_work = to_delayed_work(work);
7d652034 AP	287	struct mwifiex_private *priv =
	288	container_of(delayed_work, struct mwifiex_private,
	289	dfs_chan_sw_work);
	290
	291	if (WARN_ON(!priv))
	292	return;
	293
	294	bss_cfg = &priv->bss_cfg;
	295	if (!bss_cfg->beacon_period) {
acebe8c1 ZL	296	mwifiex_dbg(priv->adapter, ERROR,
acebe8c1 ZL	297	"channel switch: AP already stopped\n");
7d652034 AP	298	return;
	299	}
	300
7ee38bf4	301	mwifiex_uap_set_channel(priv, bss_cfg, priv->dfs_chandef);
7d652034 AP	302
7d652034 AP	303	if (mwifiex_config_start_uap(priv, bss_cfg)) {
acebe8c1 ZL	304	mwifiex_dbg(priv->adapter, ERROR,
acebe8c1 ZL	305	"Failed to start AP after channel switch\n");
7d652034 AP	306	return;
	307	}
	308
acebe8c1 ZL	309	mwifiex_dbg(priv->adapter, MSG,
acebe8c1 ZL	310	"indicating channel switch completion to kernel\n");
7d652034 AP	311	cfg80211_ch_switch_notify(priv->netdev, &priv->dfs_chandef);
7d652034 AP	312	}