net/mac802154/mac_cmd.c

0001 // SPDX-License-Identifier: GPL-2.0-only
0002 /*
0003  * MAC commands interface
0004  *
0005  * Copyright 2007-2012 Siemens AG
0006  *
0007  * Written by:
0008  * Sergey Lapin <slapin@ossfans.org>
0009  * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
0010  * Alexander Smirnov <alex.bluesman.smirnov@gmail.com>
0011  */
0012
0013 #include <linux/skbuff.h>
0014 #include <linux/if_arp.h>
0015 #include <linux/ieee802154.h>
0016
0017 #include <net/ieee802154_netdev.h>
0018 #include <net/cfg802154.h>
0019 #include <net/mac802154.h>
0020
0021 #include "ieee802154_i.h"
0022 #include "driver-ops.h"
0023
0024 static int mac802154_mlme_start_req(struct net_device *dev,
0025                     struct ieee802154_addr *addr,
0026                     u8 channel, u8 page,
0027                     u8 bcn_ord, u8 sf_ord,
0028                     u8 pan_coord, u8 blx,
0029                     u8 coord_realign)
0030 {
0031     struct ieee802154_llsec_params params;
0032     int changed = 0;
0033
0034     ASSERT_RTNL();
0035
0036     BUG_ON(addr->mode != IEEE802154_ADDR_SHORT);
0037
0038     dev->ieee802154_ptr->pan_id = addr->pan_id;
0039     dev->ieee802154_ptr->short_addr = addr->short_addr;
0040     mac802154_dev_set_page_channel(dev, page, channel);
0041
0042     params.pan_id = addr->pan_id;
0043     changed |= IEEE802154_LLSEC_PARAM_PAN_ID;
0044
0045     params.hwaddr = ieee802154_devaddr_from_raw(dev->dev_addr);
0046     changed |= IEEE802154_LLSEC_PARAM_HWADDR;
0047
0048     params.coord_hwaddr = params.hwaddr;
0049     changed |= IEEE802154_LLSEC_PARAM_COORD_HWADDR;
0050
0051     params.coord_shortaddr = addr->short_addr;
0052     changed |= IEEE802154_LLSEC_PARAM_COORD_SHORTADDR;
0053
0054     return mac802154_set_params(dev, &params, changed);
0055 }
0056
0057 static int mac802154_set_mac_params(struct net_device *dev,
0058                     const struct ieee802154_mac_params *params)
0059 {
0060     struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
0061     struct ieee802154_local *local = sdata->local;
0062     struct wpan_dev *wpan_dev = &sdata->wpan_dev;
0063     int ret;
0064
0065     ASSERT_RTNL();
0066
0067     /* PHY */
0068     wpan_dev->wpan_phy->transmit_power = params->transmit_power;
0069     wpan_dev->wpan_phy->cca = params->cca;
0070     wpan_dev->wpan_phy->cca_ed_level = params->cca_ed_level;
0071
0072     /* MAC */
0073     wpan_dev->min_be = params->min_be;
0074     wpan_dev->max_be = params->max_be;
0075     wpan_dev->csma_retries = params->csma_retries;
0076     wpan_dev->frame_retries = params->frame_retries;
0077     wpan_dev->lbt = params->lbt;
0078
0079     if (local->hw.phy->flags & WPAN_PHY_FLAG_TXPOWER) {
0080         ret = drv_set_tx_power(local, params->transmit_power);
0081         if (ret < 0)
0082             return ret;
0083     }
0084
0085     if (local->hw.phy->flags & WPAN_PHY_FLAG_CCA_MODE) {
0086         ret = drv_set_cca_mode(local, &params->cca);
0087         if (ret < 0)
0088             return ret;
0089     }
0090
0091     if (local->hw.phy->flags & WPAN_PHY_FLAG_CCA_ED_LEVEL) {
0092         ret = drv_set_cca_ed_level(local, params->cca_ed_level);
0093         if (ret < 0)
0094             return ret;
0095     }
0096
0097     return 0;
0098 }
0099
0100 static void mac802154_get_mac_params(struct net_device *dev,
0101                      struct ieee802154_mac_params *params)
0102 {
0103     struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
0104     struct wpan_dev *wpan_dev = &sdata->wpan_dev;
0105
0106     ASSERT_RTNL();
0107
0108     /* PHY */
0109     params->transmit_power = wpan_dev->wpan_phy->transmit_power;
0110     params->cca = wpan_dev->wpan_phy->cca;
0111     params->cca_ed_level = wpan_dev->wpan_phy->cca_ed_level;
0112
0113     /* MAC */
0114     params->min_be = wpan_dev->min_be;
0115     params->max_be = wpan_dev->max_be;
0116     params->csma_retries = wpan_dev->csma_retries;
0117     params->frame_retries = wpan_dev->frame_retries;
0118     params->lbt = wpan_dev->lbt;
0119 }
0120
0121 static const struct ieee802154_llsec_ops mac802154_llsec_ops = {
0122     .get_params = mac802154_get_params,
0123     .set_params = mac802154_set_params,
0124     .add_key = mac802154_add_key,
0125     .del_key = mac802154_del_key,
0126     .add_dev = mac802154_add_dev,
0127     .del_dev = mac802154_del_dev,
0128     .add_devkey = mac802154_add_devkey,
0129     .del_devkey = mac802154_del_devkey,
0130     .add_seclevel = mac802154_add_seclevel,
0131     .del_seclevel = mac802154_del_seclevel,
0132     .lock_table = mac802154_lock_table,
0133     .get_table = mac802154_get_table,
0134     .unlock_table = mac802154_unlock_table,
0135 };
0136
0137 struct ieee802154_mlme_ops mac802154_mlme_wpan = {
0138     .start_req = mac802154_mlme_start_req,
0139
0140     .llsec = &mac802154_llsec_ops,
0141
0142     .set_mac_params = mac802154_set_mac_params,
0143     .get_mac_params = mac802154_get_mac_params,
0144 };