cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

mac_cmd.c (3930B)

      1// SPDX-License-Identifier: GPL-2.0-only
      2/*
      3 * MAC commands interface
      4 *
      5 * Copyright 2007-2012 Siemens AG
      6 *
      7 * Written by:
      8 * Sergey Lapin <slapin@ossfans.org>
      9 * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
     10 * Alexander Smirnov <alex.bluesman.smirnov@gmail.com>
     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
     24static 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, &params, changed);
     55}
     56
     57static 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	/* PHY */
     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	/* MAC */
     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, &params->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
    100static 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	/* PHY */
    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	/* MAC */
    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
    121static 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
    137struct 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};