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

sja1105_devlink.c (3779B)

      1// SPDX-License-Identifier: GPL-2.0
      2/* Copyright (c) 2018-2019, Vladimir Oltean <olteanv@gmail.com>
      3 * Copyright 2020 NXP
      4 */
      5#include "sja1105.h"
      6
      7/* Since devlink regions have a fixed size and the static config has a variable
      8 * size, we need to calculate the maximum possible static config size by
      9 * creating a dummy config with all table entries populated to the max, and get
     10 * its packed length. This is done dynamically as opposed to simply hardcoding
     11 * a number, since currently not all static config tables are implemented, so
     12 * we are avoiding a possible code desynchronization.
     13 */
     14static size_t sja1105_static_config_get_max_size(struct sja1105_private *priv)
     15{
     16	struct sja1105_static_config config;
     17	enum sja1105_blk_idx blk_idx;
     18	int rc;
     19
     20	rc = sja1105_static_config_init(&config,
     21					priv->info->static_ops,
     22					priv->info->device_id);
     23	if (rc)
     24		return 0;
     25
     26	for (blk_idx = 0; blk_idx < BLK_IDX_MAX; blk_idx++) {
     27		struct sja1105_table *table = &config.tables[blk_idx];
     28
     29		table->entry_count = table->ops->max_entry_count;
     30	}
     31
     32	return sja1105_static_config_get_length(&config);
     33}
     34
     35static int
     36sja1105_region_static_config_snapshot(struct devlink *dl,
     37				      const struct devlink_region_ops *ops,
     38				      struct netlink_ext_ack *extack,
     39				      u8 **data)
     40{
     41	struct dsa_switch *ds = dsa_devlink_to_ds(dl);
     42	struct sja1105_private *priv = ds->priv;
     43	size_t max_len, len;
     44
     45	len = sja1105_static_config_get_length(&priv->static_config);
     46	max_len = sja1105_static_config_get_max_size(priv);
     47
     48	*data = kcalloc(max_len, sizeof(u8), GFP_KERNEL);
     49	if (!*data)
     50		return -ENOMEM;
     51
     52	return static_config_buf_prepare_for_upload(priv, *data, len);
     53}
     54
     55static struct devlink_region_ops sja1105_region_static_config_ops = {
     56	.name = "static-config",
     57	.snapshot = sja1105_region_static_config_snapshot,
     58	.destructor = kfree,
     59};
     60
     61enum sja1105_region_id {
     62	SJA1105_REGION_STATIC_CONFIG = 0,
     63};
     64
     65struct sja1105_region {
     66	const struct devlink_region_ops *ops;
     67	size_t (*get_size)(struct sja1105_private *priv);
     68};
     69
     70static struct sja1105_region sja1105_regions[] = {
     71	[SJA1105_REGION_STATIC_CONFIG] = {
     72		.ops = &sja1105_region_static_config_ops,
     73		.get_size = sja1105_static_config_get_max_size,
     74	},
     75};
     76
     77static int sja1105_setup_devlink_regions(struct dsa_switch *ds)
     78{
     79	int i, num_regions = ARRAY_SIZE(sja1105_regions);
     80	struct sja1105_private *priv = ds->priv;
     81	const struct devlink_region_ops *ops;
     82	struct devlink_region *region;
     83	u64 size;
     84
     85	priv->regions = kcalloc(num_regions, sizeof(struct devlink_region *),
     86				GFP_KERNEL);
     87	if (!priv->regions)
     88		return -ENOMEM;
     89
     90	for (i = 0; i < num_regions; i++) {
     91		size = sja1105_regions[i].get_size(priv);
     92		ops = sja1105_regions[i].ops;
     93
     94		region = dsa_devlink_region_create(ds, ops, 1, size);
     95		if (IS_ERR(region)) {
     96			while (i-- >= 0)
     97				dsa_devlink_region_destroy(priv->regions[i]);
     98			return PTR_ERR(region);
     99		}
    100
    101		priv->regions[i] = region;
    102	}
    103
    104	return 0;
    105}
    106
    107static void sja1105_teardown_devlink_regions(struct dsa_switch *ds)
    108{
    109	int i, num_regions = ARRAY_SIZE(sja1105_regions);
    110	struct sja1105_private *priv = ds->priv;
    111
    112	for (i = 0; i < num_regions; i++)
    113		dsa_devlink_region_destroy(priv->regions[i]);
    114
    115	kfree(priv->regions);
    116}
    117
    118int sja1105_devlink_info_get(struct dsa_switch *ds,
    119			     struct devlink_info_req *req,
    120			     struct netlink_ext_ack *extack)
    121{
    122	struct sja1105_private *priv = ds->priv;
    123	int rc;
    124
    125	rc = devlink_info_driver_name_put(req, "sja1105");
    126	if (rc)
    127		return rc;
    128
    129	rc = devlink_info_version_fixed_put(req,
    130					    DEVLINK_INFO_VERSION_GENERIC_ASIC_ID,
    131					    priv->info->name);
    132	return rc;
    133}
    134
    135int sja1105_devlink_setup(struct dsa_switch *ds)
    136{
    137	return sja1105_setup_devlink_regions(ds);
    138}
    139
    140void sja1105_devlink_teardown(struct dsa_switch *ds)
    141{
    142	sja1105_teardown_devlink_regions(ds);
    143}