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