drivers/net/dsa/sja1105/sja1105_devlink.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /* Copyright (c) 2018-2019, Vladimir Oltean <olteanv@gmail.com>
   3  * Copyright 2020 NXP Semiconductors
   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  */
  14 static 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
  35 static int
  36 sja1105_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
  55 static 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
  61 enum sja1105_region_id {
  62         SJA1105_REGION_STATIC_CONFIG = 0,
  63 };
  64
  65 struct sja1105_region {
  66         const struct devlink_region_ops *ops;
  67         size_t (*get_size)(struct sja1105_private *priv);
  68 };
  69
  70 static 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
  77 static 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
 107 static 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
 118 static int sja1105_best_effort_vlan_filtering_get(struct sja1105_private *priv,
 119                                                   bool *be_vlan)
 120 {
 121         *be_vlan = priv->best_effort_vlan_filtering;
 122
 123         return 0;
 124 }
 125
 126 static int sja1105_best_effort_vlan_filtering_set(struct sja1105_private *priv,
 127                                                   bool be_vlan)
 128 {
 129         struct dsa_switch *ds = priv->ds;
 130         bool vlan_filtering;
 131         int port;
 132         int rc;
 133
 134         priv->best_effort_vlan_filtering = be_vlan;
 135
 136         rtnl_lock();
 137         for (port = 0; port < ds->num_ports; port++) {
 138                 struct switchdev_trans trans;
 139                 struct dsa_port *dp;
 140
 141                 if (!dsa_is_user_port(ds, port))
 142                         continue;
 143
 144                 dp = dsa_to_port(ds, port);
 145                 vlan_filtering = dsa_port_is_vlan_filtering(dp);
 146
 147                 trans.ph_prepare = true;
 148                 rc = sja1105_vlan_filtering(ds, port, vlan_filtering, &trans);
 149                 if (rc)
 150                         break;
 151
 152                 trans.ph_prepare = false;
 153                 rc = sja1105_vlan_filtering(ds, port, vlan_filtering, &trans);
 154                 if (rc)
 155                         break;
 156         }
 157         rtnl_unlock();
 158
 159         return rc;
 160 }
 161
 162 enum sja1105_devlink_param_id {
 163         SJA1105_DEVLINK_PARAM_ID_BASE = DEVLINK_PARAM_GENERIC_ID_MAX,
 164         SJA1105_DEVLINK_PARAM_ID_BEST_EFFORT_VLAN_FILTERING,
 165 };
 166
 167 int sja1105_devlink_param_get(struct dsa_switch *ds, u32 id,
 168                               struct devlink_param_gset_ctx *ctx)
 169 {
 170         struct sja1105_private *priv = ds->priv;
 171         int err;
 172
 173         switch (id) {
 174         case SJA1105_DEVLINK_PARAM_ID_BEST_EFFORT_VLAN_FILTERING:
 175                 err = sja1105_best_effort_vlan_filtering_get(priv,
 176                                                              &ctx->val.vbool);
 177                 break;
 178         default:
 179                 err = -EOPNOTSUPP;
 180                 break;
 181         }
 182
 183         return err;
 184 }
 185
 186 int sja1105_devlink_param_set(struct dsa_switch *ds, u32 id,
 187                               struct devlink_param_gset_ctx *ctx)
 188 {
 189         struct sja1105_private *priv = ds->priv;
 190         int err;
 191
 192         switch (id) {
 193         case SJA1105_DEVLINK_PARAM_ID_BEST_EFFORT_VLAN_FILTERING:
 194                 err = sja1105_best_effort_vlan_filtering_set(priv,
 195                                                              ctx->val.vbool);
 196                 break;
 197         default:
 198                 err = -EOPNOTSUPP;
 199                 break;
 200         }
 201
 202         return err;
 203 }
 204
 205 static const struct devlink_param sja1105_devlink_params[] = {
 206         DSA_DEVLINK_PARAM_DRIVER(SJA1105_DEVLINK_PARAM_ID_BEST_EFFORT_VLAN_FILTERING,
 207                                  "best_effort_vlan_filtering",
 208                                  DEVLINK_PARAM_TYPE_BOOL,
 209                                  BIT(DEVLINK_PARAM_CMODE_RUNTIME)),
 210 };
 211
 212 static int sja1105_setup_devlink_params(struct dsa_switch *ds)
 213 {
 214         return dsa_devlink_params_register(ds, sja1105_devlink_params,
 215                                            ARRAY_SIZE(sja1105_devlink_params));
 216 }
 217
 218 static void sja1105_teardown_devlink_params(struct dsa_switch *ds)
 219 {
 220         dsa_devlink_params_unregister(ds, sja1105_devlink_params,
 221                                       ARRAY_SIZE(sja1105_devlink_params));
 222 }
 223
 224 int sja1105_devlink_info_get(struct dsa_switch *ds,
 225                              struct devlink_info_req *req,
 226                              struct netlink_ext_ack *extack)
 227 {
 228         struct sja1105_private *priv = ds->priv;
 229         int rc;
 230
 231         rc = devlink_info_driver_name_put(req, "sja1105");
 232         if (rc)
 233                 return rc;
 234
 235         rc = devlink_info_version_fixed_put(req,
 236                                             DEVLINK_INFO_VERSION_GENERIC_ASIC_ID,
 237                                             priv->info->name);
 238         return rc;
 239 }
 240
 241 int sja1105_devlink_setup(struct dsa_switch *ds)
 242 {
 243         int rc;
 244
 245         rc = sja1105_setup_devlink_params(ds);
 246         if (rc)
 247                 return rc;
 248
 249         rc = sja1105_setup_devlink_regions(ds);
 250         if (rc < 0) {
 251                 sja1105_teardown_devlink_params(ds);
 252                 return rc;
 253         }
 254
 255         return 0;
 256 }
 257
 258 void sja1105_devlink_teardown(struct dsa_switch *ds)
 259 {
 260         sja1105_teardown_devlink_params(ds);
 261         sja1105_teardown_devlink_regions(ds);
 262 }