1 /* This program is free software; you can redistribute it and/or modify 2 * it under the terms of the GNU General Public License version 2 3 * as published by the Free Software Foundation. 4 * 5 * This program is distributed in the hope that it will be useful, 6 * but WITHOUT ANY WARRANTY; without even the implied warranty of 7 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 8 * GNU General Public License for more details. 9 * 10 * Authors: 11 * Alexander Aring <aar@pengutronix.de> 12 * 13 * Based on: net/mac80211/cfg.c 14 */ 15 16 #include <net/rtnetlink.h> 17 #include <net/cfg802154.h> 18 19 #include "ieee802154_i.h" 20 #include "driver-ops.h" 21 #include "cfg.h" 22 23 static struct net_device * 24 ieee802154_add_iface_deprecated(struct wpan_phy *wpan_phy, 25 const char *name, 26 unsigned char name_assign_type, int type) 27 { 28 struct ieee802154_local *local = wpan_phy_priv(wpan_phy); 29 struct net_device *dev; 30 31 rtnl_lock(); 32 dev = ieee802154_if_add(local, name, name_assign_type, type, 33 cpu_to_le64(0x0000000000000000ULL)); 34 rtnl_unlock(); 35 36 return dev; 37 } 38 39 static void ieee802154_del_iface_deprecated(struct wpan_phy *wpan_phy, 40 struct net_device *dev) 41 { 42 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); 43 44 ieee802154_if_remove(sdata); 45 } 46 47 static int 48 ieee802154_add_iface(struct wpan_phy *phy, const char *name, 49 unsigned char name_assign_type, 50 enum nl802154_iftype type, __le64 extended_addr) 51 { 52 struct ieee802154_local *local = wpan_phy_priv(phy); 53 struct net_device *err; 54 55 err = ieee802154_if_add(local, name, name_assign_type, type, 56 extended_addr); 57 return PTR_ERR_OR_ZERO(err); 58 } 59 60 static int 61 ieee802154_del_iface(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev) 62 { 63 ieee802154_if_remove(IEEE802154_WPAN_DEV_TO_SUB_IF(wpan_dev)); 64 65 return 0; 66 } 67 68 static int 69 ieee802154_set_channel(struct wpan_phy *wpan_phy, u8 page, u8 channel) 70 { 71 struct ieee802154_local *local = wpan_phy_priv(wpan_phy); 72 int ret; 73 74 ASSERT_RTNL(); 75 76 if (wpan_phy->current_page == page && 77 wpan_phy->current_channel == channel) 78 return 0; 79 80 ret = drv_set_channel(local, page, channel); 81 if (!ret) { 82 wpan_phy->current_page = page; 83 wpan_phy->current_channel = channel; 84 } 85 86 return ret; 87 } 88 89 static int 90 ieee802154_set_cca_mode(struct wpan_phy *wpan_phy, 91 const struct wpan_phy_cca *cca) 92 { 93 struct ieee802154_local *local = wpan_phy_priv(wpan_phy); 94 int ret; 95 96 ASSERT_RTNL(); 97 98 if (wpan_phy_cca_cmp(&wpan_phy->cca, cca)) 99 return 0; 100 101 ret = drv_set_cca_mode(local, cca); 102 if (!ret) 103 wpan_phy->cca = *cca; 104 105 return ret; 106 } 107 108 static int 109 ieee802154_set_cca_ed_level(struct wpan_phy *wpan_phy, s32 ed_level) 110 { 111 struct ieee802154_local *local = wpan_phy_priv(wpan_phy); 112 int ret; 113 114 ASSERT_RTNL(); 115 116 if (wpan_phy->cca_ed_level == ed_level) 117 return 0; 118 119 ret = drv_set_cca_ed_level(local, ed_level); 120 if (!ret) 121 wpan_phy->cca_ed_level = ed_level; 122 123 return ret; 124 } 125 126 static int 127 ieee802154_set_tx_power(struct wpan_phy *wpan_phy, s32 power) 128 { 129 struct ieee802154_local *local = wpan_phy_priv(wpan_phy); 130 int ret; 131 132 ASSERT_RTNL(); 133 134 if (wpan_phy->transmit_power == power) 135 return 0; 136 137 ret = drv_set_tx_power(local, power); 138 if (!ret) 139 wpan_phy->transmit_power = power; 140 141 return ret; 142 } 143 144 static int 145 ieee802154_set_pan_id(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev, 146 __le16 pan_id) 147 { 148 ASSERT_RTNL(); 149 150 if (wpan_dev->pan_id == pan_id) 151 return 0; 152 153 wpan_dev->pan_id = pan_id; 154 return 0; 155 } 156 157 static int 158 ieee802154_set_backoff_exponent(struct wpan_phy *wpan_phy, 159 struct wpan_dev *wpan_dev, 160 u8 min_be, u8 max_be) 161 { 162 ASSERT_RTNL(); 163 164 if (wpan_dev->min_be == min_be && 165 wpan_dev->max_be == max_be) 166 return 0; 167 168 wpan_dev->min_be = min_be; 169 wpan_dev->max_be = max_be; 170 return 0; 171 } 172 173 static int 174 ieee802154_set_short_addr(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev, 175 __le16 short_addr) 176 { 177 ASSERT_RTNL(); 178 179 if (wpan_dev->short_addr == short_addr) 180 return 0; 181 182 wpan_dev->short_addr = short_addr; 183 return 0; 184 } 185 186 static int 187 ieee802154_set_max_csma_backoffs(struct wpan_phy *wpan_phy, 188 struct wpan_dev *wpan_dev, 189 u8 max_csma_backoffs) 190 { 191 ASSERT_RTNL(); 192 193 if (wpan_dev->csma_retries == max_csma_backoffs) 194 return 0; 195 196 wpan_dev->csma_retries = max_csma_backoffs; 197 return 0; 198 } 199 200 static int 201 ieee802154_set_max_frame_retries(struct wpan_phy *wpan_phy, 202 struct wpan_dev *wpan_dev, 203 s8 max_frame_retries) 204 { 205 ASSERT_RTNL(); 206 207 if (wpan_dev->frame_retries == max_frame_retries) 208 return 0; 209 210 wpan_dev->frame_retries = max_frame_retries; 211 return 0; 212 } 213 214 static int 215 ieee802154_set_lbt_mode(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev, 216 bool mode) 217 { 218 ASSERT_RTNL(); 219 220 if (wpan_dev->lbt == mode) 221 return 0; 222 223 wpan_dev->lbt = mode; 224 return 0; 225 } 226 227 const struct cfg802154_ops mac802154_config_ops = { 228 .add_virtual_intf_deprecated = ieee802154_add_iface_deprecated, 229 .del_virtual_intf_deprecated = ieee802154_del_iface_deprecated, 230 .add_virtual_intf = ieee802154_add_iface, 231 .del_virtual_intf = ieee802154_del_iface, 232 .set_channel = ieee802154_set_channel, 233 .set_cca_mode = ieee802154_set_cca_mode, 234 .set_cca_ed_level = ieee802154_set_cca_ed_level, 235 .set_tx_power = ieee802154_set_tx_power, 236 .set_pan_id = ieee802154_set_pan_id, 237 .set_short_addr = ieee802154_set_short_addr, 238 .set_backoff_exponent = ieee802154_set_backoff_exponent, 239 .set_max_csma_backoffs = ieee802154_set_max_csma_backoffs, 240 .set_max_frame_retries = ieee802154_set_max_frame_retries, 241 .set_lbt_mode = ieee802154_set_lbt_mode, 242 }; 243