net/mac802154/scan.c

44 static int mac802154_scan_cleanup_locked(struct ieee802154_local *local,
49 	struct wpan_phy *wpan_phy = local->phy;
54 	clear_bit(IEEE802154_IS_SCANNING, &local->ongoing);
55 	cancel_delayed_work(&local->scan_work);
56 	request = rcu_replace_pointer(local->scan_req, NULL, 1);
69 	ieee802154_mlme_op_post(local);
72 	drv_set_channel(local, wpan_phy->current_page,
76 	drv_stop(local);
79 	drv_start(local, sdata->required_filtering, &local->addr_filt);
84 int mac802154_abort_scan_locked(struct ieee802154_local *local,
89 	if (!mac802154_is_scanning(local))
92 	return mac802154_scan_cleanup_locked(local, sdata, true);
105 static void mac802154_flush_queued_beacons(struct ieee802154_local *local)
109 	list_for_each_entry_safe(mac_pkt, tmp, &local->rx_beacon_list, node) {
117 mac802154_scan_get_next_channel(struct ieee802154_local *local,
127 static int mac802154_scan_find_next_chan(struct ieee802154_local *local,
131 	mac802154_scan_get_next_channel(local, scan_req, channel);
138 static int mac802154_scan_prepare_beacon_req(struct ieee802154_local *local)
140 	memset(&local->scan_beacon_req, 0, sizeof(local->scan_beacon_req));
141 	local->scan_beacon_req.mhr.fc.type = IEEE802154_FC_TYPE_MAC_CMD;
142 	local->scan_beacon_req.mhr.fc.dest_addr_mode = IEEE802154_SHORT_ADDRESSING;
143 	local->scan_beacon_req.mhr.fc.version = IEEE802154_2003_STD;
144 	local->scan_beacon_req.mhr.fc.source_addr_mode = IEEE802154_NO_ADDRESSING;
145 	local->scan_beacon_req.mhr.dest.mode = IEEE802154_ADDR_SHORT;
146 	local->scan_beacon_req.mhr.dest.pan_id = cpu_to_le16(IEEE802154_PANID_BROADCAST);
147 	local->scan_beacon_req.mhr.dest.short_addr = cpu_to_le16(IEEE802154_ADDR_BROADCAST);
148 	local->scan_beacon_req.mac_pl.cmd_id = IEEE802154_CMD_BEACON_REQ;
153 static int mac802154_transmit_beacon_req(struct ieee802154_local *local,
165 	ret = ieee802154_mac_cmd_push(skb, &local->scan_beacon_req, NULL, 0);
171 	return ieee802154_mlme_tx(local, sdata, skb);
176 	struct ieee802154_local *local =
190 	drv_stop(local);
192 	mac802154_flush_queued_beacons(local);
195 	scan_req = rcu_dereference(local->scan_req);
204 	if (local->suspended || !ieee802154_sdata_running(sdata)) {
206 		queue_delayed_work(local->mac_wq, &local->scan_work,
215 	page = local->scan_page;
216 	channel = local->scan_channel;
218 		ret = mac802154_scan_find_next_chan(local, scan_req, page, &channel);
229 	ret = drv_set_channel(local, page, channel);
237 	local->scan_page = page;
238 	local->scan_channel = channel;
241 	ret = drv_start(local, IEEE802154_FILTERING_3_SCAN, &local->addr_filt);
250 		ret = mac802154_transmit_beacon_req(local, sdata);
262 	queue_delayed_work(local->mac_wq, &local->scan_work, scan_duration);
267 	mac802154_scan_cleanup_locked(local, sdata, false);
274 	struct ieee802154_local *local = sdata->local;
278 	if (mac802154_is_scanning(local))
286 	rcu_assign_pointer(local->scan_req, request);
291 	ieee802154_mlme_op_pre(local);
294 	local->scan_page = request->page;
295 	local->scan_channel = -1;
296 	set_bit(IEEE802154_IS_SCANNING, &local->ongoing);
298 		mac802154_scan_prepare_beacon_req(local);
302 	queue_delayed_work(local->mac_wq, &local->scan_work, 0);
307 int mac802154_process_beacon(struct ieee802154_local *local,
336 	scan_req = rcu_dereference(local->scan_req);
344 static int mac802154_transmit_beacon(struct ieee802154_local *local,
353 	local->beacon.mhr.seq = atomic_inc_return(&wpan_dev->bsn) & 0xFF;
360 	beacon_req = rcu_dereference(local->beacon_req);
372 	ret = ieee802154_beacon_push(skb, &local->beacon);
396 	return ieee802154_mlme_tx(local, sdata, skb);
401 	struct ieee802154_local *local =
410 	beacon_req = rcu_dereference(local->beacon_req);
419 	if (local->suspended || !ieee802154_sdata_running(sdata)) {
421 		queue_delayed_work(local->mac_wq, &local->beacon_work,
432 	ret = mac802154_transmit_beacon(local, wpan_dev);
438 		queue_delayed_work(local->mac_wq, &local->beacon_work,
439 				   local->beacon_interval);
442 int mac802154_stop_beacons_locked(struct ieee802154_local *local,
450 	if (!mac802154_is_beaconing(local))
453 	clear_bit(IEEE802154_IS_BEACONING, &local->ongoing);
454 	cancel_delayed_work(&local->beacon_work);
455 	request = rcu_replace_pointer(local->beacon_req, NULL, 1);
468 	struct ieee802154_local *local = sdata->local;
473 	if (mac802154_is_beaconing(local))
474 		mac802154_stop_beacons_locked(local, sdata);
477 	rcu_assign_pointer(local->beacon_req, request);
479 	set_bit(IEEE802154_IS_BEACONING, &local->ongoing);
481 	memset(&local->beacon, 0, sizeof(local->beacon));
482 	local->beacon.mhr.fc.type = IEEE802154_FC_TYPE_BEACON;
483 	local->beacon.mhr.fc.security_enabled = 0;
484 	local->beacon.mhr.fc.frame_pending = 0;
485 	local->beacon.mhr.fc.ack_request = 0;
486 	local->beacon.mhr.fc.intra_pan = 0;
487 	local->beacon.mhr.fc.dest_addr_mode = IEEE802154_NO_ADDRESSING;
488 	local->beacon.mhr.fc.version = IEEE802154_2003_STD;
489 	local->beacon.mhr.fc.source_addr_mode = IEEE802154_EXTENDED_ADDRESSING;
491 	local->beacon.mhr.source.mode = IEEE802154_ADDR_LONG;
492 	local->beacon.mhr.source.pan_id = request->wpan_dev->pan_id;
493 	local->beacon.mhr.source.extended_addr = request->wpan_dev->extended_addr;
494 	local->beacon.mac_pl.beacon_order = request->interval;
496 		local->beacon.mac_pl.superframe_order = request->interval;
497 	local->beacon.mac_pl.final_cap_slot = 0xf;
498 	local->beacon.mac_pl.battery_life_ext = 0;
499 	local->beacon.mac_pl.pan_coordinator = !wpan_dev->parent;
500 	local->beacon.mac_pl.assoc_permit = 1;
506 	local->beacon_interval =
509 	queue_delayed_work(local->mac_wq, &local->beacon_work, 0);
520 	struct ieee802154_local *local = sdata->local;
564 	local->assoc_dev = coord;
565 	reinit_completion(&local->assoc_done);
566 	set_bit(IEEE802154_IS_ASSOCIATING, &local->ongoing);
568 	ret = ieee802154_mlme_tx_one_locked(local, sdata, skb);
577 	ret = wait_for_completion_killable_timeout(&local->assoc_done, 10 * HZ);
585 	if (local->assoc_status != IEEE802154_ASSOCIATION_SUCCESSFUL) {
586 		if (local->assoc_status == IEEE802154_PAN_AT_CAPACITY)
593 			 local->assoc_status == IEEE802154_PAN_AT_CAPACITY ?
598 	*short_addr = local->assoc_addr;
601 	clear_bit(IEEE802154_IS_ASSOCIATING, &local->ongoing);
602 	local->assoc_dev = NULL;
613 	struct ieee802154_local *local = sdata->local;
625 		     src->extended_addr != local->assoc_dev->extended_addr))
629 	local->assoc_addr = resp_pl.short_addr;
630 	local->assoc_status = resp_pl.status;
634 		local->assoc_status, &deaddr, local->assoc_addr);
636 	complete(&local->assoc_done);
647 	struct ieee802154_local *local = sdata->local;
688 	ret = ieee802154_mlme_tx_one_locked(local, sdata, skb);
708 	struct ieee802154_local *local = sdata->local;
743 	ret = ieee802154_mlme_tx_locked(local, sdata, skb);