1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * MAC commands interface
4  *
5  * Copyright 2007-2012 Siemens AG
6  *
7  * Written by:
8  * Sergey Lapin <slapin@ossfans.org>
9  * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
10  * Alexander Smirnov <alex.bluesman.smirnov@gmail.com>
11  */
12 
13 #include <linux/skbuff.h>
14 #include <linux/if_arp.h>
15 #include <linux/ieee802154.h>
16 
17 #include <net/ieee802154_netdev.h>
18 #include <net/cfg802154.h>
19 #include <net/mac802154.h>
20 
21 #include "ieee802154_i.h"
22 #include "driver-ops.h"
23 
mac802154_mlme_start_req(struct net_device * dev,struct ieee802154_addr * addr,u8 channel,u8 page,u8 bcn_ord,u8 sf_ord,u8 pan_coord,u8 blx,u8 coord_realign)24 static int mac802154_mlme_start_req(struct net_device *dev,
25 				    struct ieee802154_addr *addr,
26 				    u8 channel, u8 page,
27 				    u8 bcn_ord, u8 sf_ord,
28 				    u8 pan_coord, u8 blx,
29 				    u8 coord_realign)
30 {
31 	struct ieee802154_llsec_params params;
32 	int changed = 0;
33 
34 	ASSERT_RTNL();
35 
36 	BUG_ON(addr->mode != IEEE802154_ADDR_SHORT);
37 
38 	dev->ieee802154_ptr->pan_id = addr->pan_id;
39 	dev->ieee802154_ptr->short_addr = addr->short_addr;
40 	mac802154_dev_set_page_channel(dev, page, channel);
41 
42 	params.pan_id = addr->pan_id;
43 	changed |= IEEE802154_LLSEC_PARAM_PAN_ID;
44 
45 	params.hwaddr = ieee802154_devaddr_from_raw(dev->dev_addr);
46 	changed |= IEEE802154_LLSEC_PARAM_HWADDR;
47 
48 	params.coord_hwaddr = params.hwaddr;
49 	changed |= IEEE802154_LLSEC_PARAM_COORD_HWADDR;
50 
51 	params.coord_shortaddr = addr->short_addr;
52 	changed |= IEEE802154_LLSEC_PARAM_COORD_SHORTADDR;
53 
54 	return mac802154_set_params(dev, &params, changed);
55 }
56 
mac802154_set_mac_params(struct net_device * dev,const struct ieee802154_mac_params * params)57 static int mac802154_set_mac_params(struct net_device *dev,
58 				    const struct ieee802154_mac_params *params)
59 {
60 	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
61 	struct ieee802154_local *local = sdata->local;
62 	struct wpan_dev *wpan_dev = &sdata->wpan_dev;
63 	int ret;
64 
65 	ASSERT_RTNL();
66 
67 	/* PHY */
68 	wpan_dev->wpan_phy->transmit_power = params->transmit_power;
69 	wpan_dev->wpan_phy->cca = params->cca;
70 	wpan_dev->wpan_phy->cca_ed_level = params->cca_ed_level;
71 
72 	/* MAC */
73 	wpan_dev->min_be = params->min_be;
74 	wpan_dev->max_be = params->max_be;
75 	wpan_dev->csma_retries = params->csma_retries;
76 	wpan_dev->frame_retries = params->frame_retries;
77 	wpan_dev->lbt = params->lbt;
78 
79 	if (local->hw.phy->flags & WPAN_PHY_FLAG_TXPOWER) {
80 		ret = drv_set_tx_power(local, params->transmit_power);
81 		if (ret < 0)
82 			return ret;
83 	}
84 
85 	if (local->hw.phy->flags & WPAN_PHY_FLAG_CCA_MODE) {
86 		ret = drv_set_cca_mode(local, &params->cca);
87 		if (ret < 0)
88 			return ret;
89 	}
90 
91 	if (local->hw.phy->flags & WPAN_PHY_FLAG_CCA_ED_LEVEL) {
92 		ret = drv_set_cca_ed_level(local, params->cca_ed_level);
93 		if (ret < 0)
94 			return ret;
95 	}
96 
97 	return 0;
98 }
99 
mac802154_get_mac_params(struct net_device * dev,struct ieee802154_mac_params * params)100 static void mac802154_get_mac_params(struct net_device *dev,
101 				     struct ieee802154_mac_params *params)
102 {
103 	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
104 	struct wpan_dev *wpan_dev = &sdata->wpan_dev;
105 
106 	ASSERT_RTNL();
107 
108 	/* PHY */
109 	params->transmit_power = wpan_dev->wpan_phy->transmit_power;
110 	params->cca = wpan_dev->wpan_phy->cca;
111 	params->cca_ed_level = wpan_dev->wpan_phy->cca_ed_level;
112 
113 	/* MAC */
114 	params->min_be = wpan_dev->min_be;
115 	params->max_be = wpan_dev->max_be;
116 	params->csma_retries = wpan_dev->csma_retries;
117 	params->frame_retries = wpan_dev->frame_retries;
118 	params->lbt = wpan_dev->lbt;
119 }
120 
121 static const struct ieee802154_llsec_ops mac802154_llsec_ops = {
122 	.get_params = mac802154_get_params,
123 	.set_params = mac802154_set_params,
124 	.add_key = mac802154_add_key,
125 	.del_key = mac802154_del_key,
126 	.add_dev = mac802154_add_dev,
127 	.del_dev = mac802154_del_dev,
128 	.add_devkey = mac802154_add_devkey,
129 	.del_devkey = mac802154_del_devkey,
130 	.add_seclevel = mac802154_add_seclevel,
131 	.del_seclevel = mac802154_del_seclevel,
132 	.lock_table = mac802154_lock_table,
133 	.get_table = mac802154_get_table,
134 	.unlock_table = mac802154_unlock_table,
135 };
136 
137 struct ieee802154_mlme_ops mac802154_mlme_wpan = {
138 	.start_req = mac802154_mlme_start_req,
139 
140 	.llsec = &mac802154_llsec_ops,
141 
142 	.set_mac_params = mac802154_set_mac_params,
143 	.get_mac_params = mac802154_get_mac_params,
144 };
145