Alexander Aring | 1201cd2 | 2014-11-02 04:18:36 +0100 | [diff] [blame] | 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 | |
Alexander Aring | d5ae67b | 2014-11-05 20:51:17 +0100 | [diff] [blame] | 16 | #include <net/rtnetlink.h> |
Alexander Aring | 1201cd2 | 2014-11-02 04:18:36 +0100 | [diff] [blame] | 17 | #include <net/cfg802154.h> |
| 18 | |
Alexander Aring | 4a9a816 | 2014-11-02 04:18:38 +0100 | [diff] [blame] | 19 | #include "ieee802154_i.h" |
Alexander Aring | ab0bd56 | 2014-11-12 03:36:55 +0100 | [diff] [blame^] | 20 | #include "driver-ops.h" |
Alexander Aring | fdd2068 | 2014-11-02 21:43:05 +0100 | [diff] [blame] | 21 | #include "cfg.h" |
Alexander Aring | 4a9a816 | 2014-11-02 04:18:38 +0100 | [diff] [blame] | 22 | |
| 23 | static struct net_device * |
| 24 | ieee802154_add_iface_deprecated(struct wpan_phy *wpan_phy, |
| 25 | const char *name, int type) |
| 26 | { |
Alexander Aring | 986a8ab | 2014-11-05 20:51:15 +0100 | [diff] [blame] | 27 | struct ieee802154_local *local = wpan_phy_priv(wpan_phy); |
Alexander Aring | d5ae67b | 2014-11-05 20:51:17 +0100 | [diff] [blame] | 28 | struct net_device *dev; |
Alexander Aring | 986a8ab | 2014-11-05 20:51:15 +0100 | [diff] [blame] | 29 | |
Alexander Aring | d5ae67b | 2014-11-05 20:51:17 +0100 | [diff] [blame] | 30 | rtnl_lock(); |
| 31 | dev = ieee802154_if_add(local, name, NULL, type); |
| 32 | rtnl_unlock(); |
| 33 | |
| 34 | return dev; |
Alexander Aring | 4a9a816 | 2014-11-02 04:18:38 +0100 | [diff] [blame] | 35 | } |
| 36 | |
| 37 | static void ieee802154_del_iface_deprecated(struct wpan_phy *wpan_phy, |
| 38 | struct net_device *dev) |
| 39 | { |
Alexander Aring | b210b18 | 2014-11-05 20:51:14 +0100 | [diff] [blame] | 40 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
| 41 | |
| 42 | ieee802154_if_remove(sdata); |
Alexander Aring | 4a9a816 | 2014-11-02 04:18:38 +0100 | [diff] [blame] | 43 | } |
| 44 | |
Alexander Aring | ab0bd56 | 2014-11-12 03:36:55 +0100 | [diff] [blame^] | 45 | static int |
| 46 | ieee802154_set_channel(struct wpan_phy *wpan_phy, const u8 page, |
| 47 | const u8 channel) |
| 48 | { |
| 49 | struct ieee802154_local *local = wpan_phy_priv(wpan_phy); |
| 50 | int ret; |
| 51 | |
| 52 | ASSERT_RTNL(); |
| 53 | |
| 54 | /* check if phy support this setting */ |
| 55 | if (!(wpan_phy->channels_supported[page] & BIT(channel))) |
| 56 | return -EINVAL; |
| 57 | |
| 58 | ret = drv_set_channel(local, page, channel); |
| 59 | if (!ret) { |
| 60 | wpan_phy->current_page = page; |
| 61 | wpan_phy->current_channel = channel; |
| 62 | } |
| 63 | |
| 64 | return ret; |
| 65 | } |
| 66 | |
Alexander Aring | 1201cd2 | 2014-11-02 04:18:36 +0100 | [diff] [blame] | 67 | const struct cfg802154_ops mac802154_config_ops = { |
Alexander Aring | 4a9a816 | 2014-11-02 04:18:38 +0100 | [diff] [blame] | 68 | .add_virtual_intf_deprecated = ieee802154_add_iface_deprecated, |
| 69 | .del_virtual_intf_deprecated = ieee802154_del_iface_deprecated, |
Alexander Aring | ab0bd56 | 2014-11-12 03:36:55 +0100 | [diff] [blame^] | 70 | .set_channel = ieee802154_set_channel, |
Alexander Aring | 1201cd2 | 2014-11-02 04:18:36 +0100 | [diff] [blame] | 71 | }; |