net/mac802154/mac_cmd.c

   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         mac802154_dev_set_pan_id(dev, addr->pan_id);
  47         mac802154_dev_set_short_addr(dev, 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_mode = params->cca_mode;
  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.flags & IEEE802154_HW_TXPOWER) {
  95                 ret = drv_set_tx_power(local, params->transmit_power);
  96                 if (ret < 0)
  97                         return ret;
  98         }
  99
 100         if (local->hw.flags & IEEE802154_HW_CCA_MODE) {
 101                 ret = drv_set_cca_mode(local, params->cca_mode);
 102                 if (ret < 0)
 103                         return ret;
 104         }
 105
 106         if (local->hw.flags & IEEE802154_HW_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_mode = wpan_dev->wpan_phy->cca_mode;
 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         .get_pan_id = mac802154_dev_get_pan_id,
 155         .get_short_addr = mac802154_dev_get_short_addr,
 156         .get_dsn = mac802154_dev_get_dsn,
 157
 158         .llsec = &mac802154_llsec_ops,
 159
 160         .set_mac_params = mac802154_set_mac_params,
 161         .get_mac_params = mac802154_get_mac_params,
 162 };