| 1 | |
| 2 | |
| 3 | * MAC commands interface
|
| 4 | *
|
| 5 | * Copyright 2007-2012 Siemens AG
|
| 6 | *
|
| 7 | * Written by:
|
| 8 | * Sergey Lapin <[email protected]>
|
| 9 | * Dmitry Eremin-Solenikov <[email protected]>
|
| 10 | * Alexander Smirnov <[email protected]>
|
| 11 |
|
| 12 |
|
| 13 | #include <linux/skbuff.h>
|
| 14 | #include <linux/if_arp.h>
|
| 15 | #include <linux/ieee802154.h>
|
| 16 |
|
| 17 | #include <net/ieee802154_netdev.h>
|
| 18 | #include <net/cfg802154.h>
|
| 19 | #include <net/mac802154.h>
|
| 20 |
|
| 21 | #include "ieee802154_i.h"
|
| 22 | #include "driver-ops.h"
|
| 23 |
|
| 24 | static int mac802154_mlme_start_req(struct net_device *dev,
|
| 25 | struct ieee802154_addr *addr,
|
| 26 | u8 channel, u8 page,
|
| 27 | u8 bcn_ord, u8 sf_ord,
|
| 28 | u8 pan_coord, u8 blx,
|
| 29 | u8 coord_realign)
|
| 30 | {
|
| 31 | struct ieee802154_llsec_params params;
|
| 32 | int changed = 0;
|
| 33 |
|
| 34 | ASSERT_RTNL();
|
| 35 |
|
| 36 | BUG_ON(addr->mode != IEEE802154_ADDR_SHORT);
|
| 37 |
|
| 38 | dev->ieee802154_ptr->pan_id = addr->pan_id;
|
| 39 | dev->ieee802154_ptr->short_addr = addr->short_addr;
|
| 40 | mac802154_dev_set_page_channel(dev, page, channel);
|
| 41 |
|
| 42 | params.pan_id = addr->pan_id;
|
| 43 | changed |= IEEE802154_LLSEC_PARAM_PAN_ID;
|
| 44 |
|
| 45 | params.hwaddr = ieee802154_devaddr_from_raw(dev->dev_addr);
|
| 46 | changed |= IEEE802154_LLSEC_PARAM_HWADDR;
|
| 47 |
|
| 48 | params.coord_hwaddr = params.hwaddr;
|
| 49 | changed |= IEEE802154_LLSEC_PARAM_COORD_HWADDR;
|
| 50 |
|
| 51 | params.coord_shortaddr = addr->short_addr;
|
| 52 | changed |= IEEE802154_LLSEC_PARAM_COORD_SHORTADDR;
|
| 53 |
|
| 54 | return mac802154_set_params(dev, ¶ms, changed);
|
| 55 | }
|
| 56 |
|
| 57 | static int mac802154_set_mac_params(struct net_device *dev,
|
| 58 | const struct ieee802154_mac_params *params)
|
| 59 | {
|
| 60 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
|
| 61 | struct ieee802154_local *local = sdata->local;
|
| 62 | struct wpan_dev *wpan_dev = &sdata->wpan_dev;
|
| 63 | int ret;
|
| 64 |
|
| 65 | ASSERT_RTNL();
|
| 66 |
|
| 67 |
|
| 68 | wpan_dev->wpan_phy->transmit_power = params->transmit_power;
|
| 69 | wpan_dev->wpan_phy->cca = params->cca;
|
| 70 | wpan_dev->wpan_phy->cca_ed_level = params->cca_ed_level;
|
| 71 |
|
| 72 |
|
| 73 | wpan_dev->min_be = params->min_be;
|
| 74 | wpan_dev->max_be = params->max_be;
|
| 75 | wpan_dev->csma_retries = params->csma_retries;
|
| 76 | wpan_dev->frame_retries = params->frame_retries;
|
| 77 | wpan_dev->lbt = params->lbt;
|
| 78 |
|
| 79 | if (local->hw.phy->flags & WPAN_PHY_FLAG_TXPOWER) {
|
| 80 | ret = drv_set_tx_power(local, params->transmit_power);
|
| 81 | if (ret < 0)
|
| 82 | return ret;
|
| 83 | }
|
| 84 |
|
| 85 | if (local->hw.phy->flags & WPAN_PHY_FLAG_CCA_MODE) {
|
| 86 | ret = drv_set_cca_mode(local, ¶ms->cca);
|
| 87 | if (ret < 0)
|
| 88 | return ret;
|
| 89 | }
|
| 90 |
|
| 91 | if (local->hw.phy->flags & WPAN_PHY_FLAG_CCA_ED_LEVEL) {
|
| 92 | ret = drv_set_cca_ed_level(local, params->cca_ed_level);
|
| 93 | if (ret < 0)
|
| 94 | return ret;
|
| 95 | }
|
| 96 |
|
| 97 | return 0;
|
| 98 | }
|
| 99 |
|
| 100 | static void mac802154_get_mac_params(struct net_device *dev,
|
| 101 | struct ieee802154_mac_params *params)
|
| 102 | {
|
| 103 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
|
| 104 | struct wpan_dev *wpan_dev = &sdata->wpan_dev;
|
| 105 |
|
| 106 | ASSERT_RTNL();
|
| 107 |
|
| 108 |
|
| 109 | params->transmit_power = wpan_dev->wpan_phy->transmit_power;
|
| 110 | params->cca = wpan_dev->wpan_phy->cca;
|
| 111 | params->cca_ed_level = wpan_dev->wpan_phy->cca_ed_level;
|
| 112 |
|
| 113 |
|
| 114 | params->min_be = wpan_dev->min_be;
|
| 115 | params->max_be = wpan_dev->max_be;
|
| 116 | params->csma_retries = wpan_dev->csma_retries;
|
| 117 | params->frame_retries = wpan_dev->frame_retries;
|
| 118 | params->lbt = wpan_dev->lbt;
|
| 119 | }
|
| 120 |
|
| 121 | static const struct ieee802154_llsec_ops mac802154_llsec_ops = {
|
| 122 | .get_params = mac802154_get_params,
|
| 123 | .set_params = mac802154_set_params,
|
| 124 | .add_key = mac802154_add_key,
|
| 125 | .del_key = mac802154_del_key,
|
| 126 | .add_dev = mac802154_add_dev,
|
| 127 | .del_dev = mac802154_del_dev,
|
| 128 | .add_devkey = mac802154_add_devkey,
|
| 129 | .del_devkey = mac802154_del_devkey,
|
| 130 | .add_seclevel = mac802154_add_seclevel,
|
| 131 | .del_seclevel = mac802154_del_seclevel,
|
| 132 | .lock_table = mac802154_lock_table,
|
| 133 | .get_table = mac802154_get_table,
|
| 134 | .unlock_table = mac802154_unlock_table,
|
| 135 | };
|
| 136 |
|
| 137 | struct ieee802154_mlme_ops mac802154_mlme_wpan = {
|
| 138 | .start_req = mac802154_mlme_start_req,
|
| 139 |
|
| 140 | .llsec = &mac802154_llsec_ops,
|
| 141 |
|
| 142 | .set_mac_params = mac802154_set_mac_params,
|
| 143 | .get_mac_params = mac802154_get_mac_params,
|
| 144 | };
|