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 99 kfree(priv->regions); 100 return PTR_ERR(region); 101 } 102 103 priv->regions[i] = region; 104 } 105 106 return 0; 107} 108 109static void sja1105_teardown_devlink_regions(struct dsa_switch *ds) 110{ 111 int i, num_regions = ARRAY_SIZE(sja1105_regions); 112 struct sja1105_private *priv = ds->priv; 113 114 for (i = 0; i < num_regions; i++) 115 dsa_devlink_region_destroy(priv->regions[i]); 116 117 kfree(priv->regions); 118} 119 120int sja1105_devlink_info_get(struct dsa_switch *ds, 121 struct devlink_info_req *req, 122 struct netlink_ext_ack *extack) 123{ 124 struct sja1105_private *priv = ds->priv; 125 126 return devlink_info_version_fixed_put(req, 127 DEVLINK_INFO_VERSION_GENERIC_ASIC_ID, 128 priv->info->name); 129} 130 131int sja1105_devlink_setup(struct dsa_switch *ds) 132{ 133 return sja1105_setup_devlink_regions(ds); 134} 135 136void sja1105_devlink_teardown(struct dsa_switch *ds) 137{ 138 sja1105_teardown_devlink_regions(ds); 139} 140