LXR linux/drivers/net/dsa/sja1105/sja1105

   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}
 144