18 static void cw1200_scan_restart_delayed(struct cw1200_common *priv);
20 static int cw1200_scan_start(struct cw1200_common *priv, struct wsm_scan *scan)  in cw1200_scan_start()  argument
25 	switch (priv->join_status) {  in cw1200_scan_start()
33 	wiphy_dbg(priv->hw->wiphy, "[SCAN] hw req, type %d, %d channels, flags: 0x%x.\n",  in cw1200_scan_start()
39 	cancel_delayed_work_sync(&priv->clear_recent_scan_work);  in cw1200_scan_start()
40 	atomic_set(&priv->scan.in_progress, 1);  in cw1200_scan_start()
41 	atomic_set(&priv->recent_scan, 1);  in cw1200_scan_start()
42 	cw1200_pm_stay_awake(&priv->pm_state, msecs_to_jiffies(tmo));  in cw1200_scan_start()
43 	queue_delayed_work(priv->workqueue, &priv->scan.timeout,  in cw1200_scan_start()
45 	ret = wsm_scan(priv, scan);  in cw1200_scan_start()
47 		atomic_set(&priv->scan.in_progress, 0);  in cw1200_scan_start()
48 		cancel_delayed_work_sync(&priv->scan.timeout);  in cw1200_scan_start()
49 		cw1200_scan_restart_delayed(priv);  in cw1200_scan_start()
58 	struct cw1200_common *priv = hw->priv;  in cw1200_hw_scan()  local
65 	if (!priv->vif)  in cw1200_hw_scan()
69 	if (priv->join_status == CW1200_JOIN_STATUS_AP)  in cw1200_hw_scan()
81 	frame.skb = ieee80211_probereq_get(hw, priv->vif->addr, NULL, 0,  in cw1200_hw_scan()
90 	down(&priv->scan.lock);  in cw1200_hw_scan()
91 	mutex_lock(&priv->conf_mutex);  in cw1200_hw_scan()
93 	ret = wsm_set_template_frame(priv, &frame);  in cw1200_hw_scan()
96 		ret = wsm_set_probe_responder(priv, true);  in cw1200_hw_scan()
99 		mutex_unlock(&priv->conf_mutex);  in cw1200_hw_scan()
100 		up(&priv->scan.lock);  in cw1200_hw_scan()
105 	wsm_lock_tx(priv);  in cw1200_hw_scan()
107 	BUG_ON(priv->scan.req);  in cw1200_hw_scan()
108 	priv->scan.req = req;  in cw1200_hw_scan()
109 	priv->scan.n_ssids = 0;  in cw1200_hw_scan()
110 	priv->scan.status = 0;  in cw1200_hw_scan()
111 	priv->scan.begin = &req->channels[0];  in cw1200_hw_scan()
112 	priv->scan.curr = priv->scan.begin;  in cw1200_hw_scan()
113 	priv->scan.end = &req->channels[req->n_channels];  in cw1200_hw_scan()
114 	priv->scan.output_power = priv->output_power;  in cw1200_hw_scan()
117 		struct wsm_ssid *dst = &priv->scan.ssids[priv->scan.n_ssids];  in cw1200_hw_scan()
120 		++priv->scan.n_ssids;  in cw1200_hw_scan()
123 	mutex_unlock(&priv->conf_mutex);  in cw1200_hw_scan()
127 	queue_work(priv->workqueue, &priv->scan.work);  in cw1200_hw_scan()
133 	struct cw1200_common *priv = container_of(work, struct cw1200_common,  in cw1200_scan_work()  local
140 	bool first_run = (priv->scan.begin == priv->scan.curr &&  in cw1200_scan_work()
141 			  priv->scan.begin != priv->scan.end);  in cw1200_scan_work()
149 		if (cancel_delayed_work_sync(&priv->join_timeout) > 0)  in cw1200_scan_work()
150 			cw1200_join_timeout(&priv->join_timeout.work);  in cw1200_scan_work()
153 	mutex_lock(&priv->conf_mutex);  in cw1200_scan_work()
156 		if (priv->join_status == CW1200_JOIN_STATUS_STA &&  in cw1200_scan_work()
157 		    !(priv->powersave_mode.mode & WSM_PSM_PS)) {  in cw1200_scan_work()
158 			struct wsm_set_pm pm = priv->powersave_mode;  in cw1200_scan_work()
160 			cw1200_set_pm(priv, &pm);  in cw1200_scan_work()
161 		} else if (priv->join_status == CW1200_JOIN_STATUS_MONITOR) {  in cw1200_scan_work()
165 			cw1200_disable_listening(priv);  in cw1200_scan_work()
169 	if (!priv->scan.req || (priv->scan.curr == priv->scan.end)) {  in cw1200_scan_work()
170 		if (priv->scan.output_power != priv->output_power)  in cw1200_scan_work()
171 			wsm_set_output_power(priv, priv->output_power * 10);  in cw1200_scan_work()
172 		if (priv->join_status == CW1200_JOIN_STATUS_STA &&  in cw1200_scan_work()
173 		    !(priv->powersave_mode.mode & WSM_PSM_PS))  in cw1200_scan_work()
174 			cw1200_set_pm(priv, &priv->powersave_mode);  in cw1200_scan_work()
176 		if (priv->scan.status < 0)  in cw1200_scan_work()
177 			wiphy_warn(priv->hw->wiphy,  in cw1200_scan_work()
179 				   priv->scan.status);  in cw1200_scan_work()
180 		else if (priv->scan.req)  in cw1200_scan_work()
181 			wiphy_dbg(priv->hw->wiphy,  in cw1200_scan_work()
184 			wiphy_dbg(priv->hw->wiphy,  in cw1200_scan_work()
187 		priv->scan.req = NULL;  in cw1200_scan_work()
188 		cw1200_scan_restart_delayed(priv);  in cw1200_scan_work()
189 		wsm_unlock_tx(priv);  in cw1200_scan_work()
190 		mutex_unlock(&priv->conf_mutex);  in cw1200_scan_work()
191 		ieee80211_scan_completed(priv->hw, priv->scan.status ? 1 : 0);  in cw1200_scan_work()
192 		up(&priv->scan.lock);  in cw1200_scan_work()
195 		struct ieee80211_channel *first = *priv->scan.curr;  in cw1200_scan_work()
196 		for (it = priv->scan.curr + 1, i = 1;  in cw1200_scan_work()
197 		     it != priv->scan.end && i < WSM_SCAN_MAX_NUM_OF_CHANNELS;  in cw1200_scan_work()
210 		if (priv->scan.req->no_cck)  in cw1200_scan_work()
216 		scan.num_ssids = priv->scan.n_ssids;  in cw1200_scan_work()
217 		scan.ssids = &priv->scan.ssids[0];  in cw1200_scan_work()
218 		scan.num_channels = it - priv->scan.curr;  in cw1200_scan_work()
225 		if (priv->join_status == CW1200_JOIN_STATUS_STA) {  in cw1200_scan_work()
230 			sizeof(struct wsm_scan_ch) * (it - priv->scan.curr),  in cw1200_scan_work()
233 			priv->scan.status = -ENOMEM;  in cw1200_scan_work()
237 			scan.ch[i].number = priv->scan.curr[i]->hw_value;  in cw1200_scan_work()
238 			if (priv->scan.curr[i]->flags & IEEE80211_CHAN_NO_IR) {  in cw1200_scan_work()
247 		    priv->scan.output_power != first->max_power) {  in cw1200_scan_work()
248 			priv->scan.output_power = first->max_power;  in cw1200_scan_work()
249 			wsm_set_output_power(priv,  in cw1200_scan_work()
250 					     priv->scan.output_power * 10);  in cw1200_scan_work()
252 		priv->scan.status = cw1200_scan_start(priv, &scan);  in cw1200_scan_work()
254 		if (priv->scan.status)  in cw1200_scan_work()
256 		priv->scan.curr = it;  in cw1200_scan_work()
258 	mutex_unlock(&priv->conf_mutex);  in cw1200_scan_work()
262 	priv->scan.curr = priv->scan.end;  in cw1200_scan_work()
263 	mutex_unlock(&priv->conf_mutex);  in cw1200_scan_work()
264 	queue_work(priv->workqueue, &priv->scan.work);  in cw1200_scan_work()
268 static void cw1200_scan_restart_delayed(struct cw1200_common *priv)  in cw1200_scan_restart_delayed()  argument
271 	if (priv->join_status == CW1200_JOIN_STATUS_MONITOR) {  in cw1200_scan_restart_delayed()
272 		cw1200_enable_listening(priv);  in cw1200_scan_restart_delayed()
273 		cw1200_update_filtering(priv);  in cw1200_scan_restart_delayed()
276 	if (priv->delayed_unjoin) {  in cw1200_scan_restart_delayed()
277 		priv->delayed_unjoin = false;  in cw1200_scan_restart_delayed()
278 		if (queue_work(priv->workqueue, &priv->unjoin_work) <= 0)  in cw1200_scan_restart_delayed()
279 			wsm_unlock_tx(priv);  in cw1200_scan_restart_delayed()
280 	} else if (priv->delayed_link_loss) {  in cw1200_scan_restart_delayed()
281 			wiphy_dbg(priv->hw->wiphy, "[CQM] Requeue BSS loss.\n");  in cw1200_scan_restart_delayed()
282 			priv->delayed_link_loss = 0;  in cw1200_scan_restart_delayed()
283 			cw1200_cqm_bssloss_sm(priv, 1, 0, 0);  in cw1200_scan_restart_delayed()
287 static void cw1200_scan_complete(struct cw1200_common *priv)  in cw1200_scan_complete()  argument
289 	queue_delayed_work(priv->workqueue, &priv->clear_recent_scan_work, HZ);  in cw1200_scan_complete()
290 	if (priv->scan.direct_probe) {  in cw1200_scan_complete()
291 		wiphy_dbg(priv->hw->wiphy, "[SCAN] Direct probe complete.\n");  in cw1200_scan_complete()
292 		cw1200_scan_restart_delayed(priv);  in cw1200_scan_complete()
293 		priv->scan.direct_probe = 0;  in cw1200_scan_complete()
294 		up(&priv->scan.lock);  in cw1200_scan_complete()
295 		wsm_unlock_tx(priv);  in cw1200_scan_complete()
297 		cw1200_scan_work(&priv->scan.work);  in cw1200_scan_complete()
301 void cw1200_scan_failed_cb(struct cw1200_common *priv)  in cw1200_scan_failed_cb()  argument
303 	if (priv->mode == NL80211_IFTYPE_UNSPECIFIED)  in cw1200_scan_failed_cb()
307 	if (cancel_delayed_work_sync(&priv->scan.timeout) > 0) {  in cw1200_scan_failed_cb()
308 		priv->scan.status = -EIO;  in cw1200_scan_failed_cb()
309 		queue_delayed_work(priv->workqueue, &priv->scan.timeout, 0);  in cw1200_scan_failed_cb()
314 void cw1200_scan_complete_cb(struct cw1200_common *priv,  in cw1200_scan_complete_cb()  argument
317 	if (priv->mode == NL80211_IFTYPE_UNSPECIFIED)  in cw1200_scan_complete_cb()
321 	if (cancel_delayed_work_sync(&priv->scan.timeout) > 0) {  in cw1200_scan_complete_cb()
322 		priv->scan.status = 1;  in cw1200_scan_complete_cb()
323 		queue_delayed_work(priv->workqueue, &priv->scan.timeout, 0);  in cw1200_scan_complete_cb()
329 	struct cw1200_common *priv =  in cw1200_clear_recent_scan_work()  local
332 	atomic_xchg(&priv->recent_scan, 0);  in cw1200_clear_recent_scan_work()
337 	struct cw1200_common *priv =  in cw1200_scan_timeout()  local
339 	if (atomic_xchg(&priv->scan.in_progress, 0)) {  in cw1200_scan_timeout()
340 		if (priv->scan.status > 0) {  in cw1200_scan_timeout()
341 			priv->scan.status = 0;  in cw1200_scan_timeout()
342 		} else if (!priv->scan.status) {  in cw1200_scan_timeout()
343 			wiphy_warn(priv->hw->wiphy,  in cw1200_scan_timeout()
345 			priv->scan.status = -ETIMEDOUT;  in cw1200_scan_timeout()
346 			priv->scan.curr = priv->scan.end;  in cw1200_scan_timeout()
347 			wsm_stop_scan(priv);  in cw1200_scan_timeout()
349 		cw1200_scan_complete(priv);  in cw1200_scan_timeout()
355 	struct cw1200_common *priv =  in cw1200_probe_work()  local
357 	u8 queue_id = cw1200_queue_get_queue_id(priv->pending_frame_id);  in cw1200_probe_work()
358 	struct cw1200_queue *queue = &priv->tx_queue[queue_id];  in cw1200_probe_work()
383 	wiphy_dbg(priv->hw->wiphy, "[SCAN] Direct probe work.\n");  in cw1200_probe_work()
385 	mutex_lock(&priv->conf_mutex);  in cw1200_probe_work()
386 	if (down_trylock(&priv->scan.lock)) {  in cw1200_probe_work()
389 		queue_delayed_work(priv->workqueue, &priv->scan.probe_work,  in cw1200_probe_work()
391 		mutex_unlock(&priv->conf_mutex);  in cw1200_probe_work()
396 	if (cw1200_queue_get_skb(queue,	priv->pending_frame_id,  in cw1200_probe_work()
398 		up(&priv->scan.lock);  in cw1200_probe_work()
399 		mutex_unlock(&priv->conf_mutex);  in cw1200_probe_work()
400 		wsm_unlock_tx(priv);  in cw1200_probe_work()
405 	scan.band = (priv->channel->band == IEEE80211_BAND_5GHZ) ?  in cw1200_probe_work()
407 	if (priv->join_status == CW1200_JOIN_STATUS_STA ||  in cw1200_probe_work()
408 	    priv->join_status == CW1200_JOIN_STATUS_IBSS) {  in cw1200_probe_work()
412 	ch[0].number = priv->channel->hw_value;  in cw1200_probe_work()
441 	if (priv->join_status == CW1200_JOIN_STATUS_MONITOR)  in cw1200_probe_work()
442 		cw1200_disable_listening(priv);  in cw1200_probe_work()
443 	ret = wsm_set_template_frame(priv, &frame);  in cw1200_probe_work()
444 	priv->scan.direct_probe = 1;  in cw1200_probe_work()
446 		wsm_flush_tx(priv);  in cw1200_probe_work()
447 		ret = cw1200_scan_start(priv, &scan);  in cw1200_probe_work()
449 	mutex_unlock(&priv->conf_mutex);  in cw1200_probe_work()
454 	BUG_ON(cw1200_queue_remove(queue, priv->pending_frame_id));  in cw1200_probe_work()
457 		priv->scan.direct_probe = 0;  in cw1200_probe_work()
458 		up(&priv->scan.lock);  in cw1200_probe_work()
459 		wsm_unlock_tx(priv);  in cw1200_probe_work()