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