1 // SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause) 2 /* Copyright (C) 2017-2018 Netronome Systems, Inc. */ 3 4 #include <linux/rtnetlink.h> 5 #include <net/devlink.h> 6 7 #include "nfpcore/nfp.h" 8 #include "nfpcore/nfp_nsp.h" 9 #include "nfp_app.h" 10 #include "nfp_main.h" 11 #include "nfp_port.h" 12 13 static int 14 nfp_devlink_fill_eth_port(struct nfp_port *port, 15 struct nfp_eth_table_port *copy) 16 { 17 struct nfp_eth_table_port *eth_port; 18 19 eth_port = __nfp_port_get_eth_port(port); 20 if (!eth_port) 21 return -EINVAL; 22 23 memcpy(copy, eth_port, sizeof(*eth_port)); 24 25 return 0; 26 } 27 28 static int 29 nfp_devlink_fill_eth_port_from_id(struct nfp_pf *pf, unsigned int port_index, 30 struct nfp_eth_table_port *copy) 31 { 32 struct nfp_port *port; 33 34 port = nfp_port_from_id(pf, NFP_PORT_PHYS_PORT, port_index); 35 36 return nfp_devlink_fill_eth_port(port, copy); 37 } 38 39 static int 40 nfp_devlink_set_lanes(struct nfp_pf *pf, unsigned int idx, unsigned int lanes) 41 { 42 struct nfp_nsp *nsp; 43 int ret; 44 45 nsp = nfp_eth_config_start(pf->cpp, idx); 46 if (IS_ERR(nsp)) 47 return PTR_ERR(nsp); 48 49 ret = __nfp_eth_set_split(nsp, lanes); 50 if (ret) { 51 nfp_eth_config_cleanup_end(nsp); 52 return ret; 53 } 54 55 ret = nfp_eth_config_commit_end(nsp); 56 if (ret < 0) 57 return ret; 58 if (ret) /* no change */ 59 return 0; 60 61 return nfp_net_refresh_port_table_sync(pf); 62 } 63 64 static int 65 nfp_devlink_port_split(struct devlink *devlink, unsigned int port_index, 66 unsigned int count, struct netlink_ext_ack *extack) 67 { 68 struct nfp_pf *pf = devlink_priv(devlink); 69 struct nfp_eth_table_port eth_port; 70 unsigned int lanes; 71 int ret; 72 73 mutex_lock(&pf->lock); 74 75 rtnl_lock(); 76 ret = nfp_devlink_fill_eth_port_from_id(pf, port_index, ð_port); 77 rtnl_unlock(); 78 if (ret) 79 goto out; 80 81 if (eth_port.port_lanes % count) { 82 ret = -EINVAL; 83 goto out; 84 } 85 86 /* Special case the 100G CXP -> 2x40G split */ 87 lanes = eth_port.port_lanes / count; 88 if (eth_port.lanes == 10 && count == 2) 89 lanes = 8 / count; 90 91 ret = nfp_devlink_set_lanes(pf, eth_port.index, lanes); 92 out: 93 mutex_unlock(&pf->lock); 94 95 return ret; 96 } 97 98 static int 99 nfp_devlink_port_unsplit(struct devlink *devlink, unsigned int port_index, 100 struct netlink_ext_ack *extack) 101 { 102 struct nfp_pf *pf = devlink_priv(devlink); 103 struct nfp_eth_table_port eth_port; 104 unsigned int lanes; 105 int ret; 106 107 mutex_lock(&pf->lock); 108 109 rtnl_lock(); 110 ret = nfp_devlink_fill_eth_port_from_id(pf, port_index, ð_port); 111 rtnl_unlock(); 112 if (ret) 113 goto out; 114 115 if (!eth_port.is_split) { 116 ret = -EINVAL; 117 goto out; 118 } 119 120 /* Special case the 100G CXP -> 2x40G unsplit */ 121 lanes = eth_port.port_lanes; 122 if (eth_port.port_lanes == 8) 123 lanes = 10; 124 125 ret = nfp_devlink_set_lanes(pf, eth_port.index, lanes); 126 out: 127 mutex_unlock(&pf->lock); 128 129 return ret; 130 } 131 132 static int 133 nfp_devlink_sb_pool_get(struct devlink *devlink, unsigned int sb_index, 134 u16 pool_index, struct devlink_sb_pool_info *pool_info) 135 { 136 struct nfp_pf *pf = devlink_priv(devlink); 137 138 return nfp_shared_buf_pool_get(pf, sb_index, pool_index, pool_info); 139 } 140 141 static int 142 nfp_devlink_sb_pool_set(struct devlink *devlink, unsigned int sb_index, 143 u16 pool_index, 144 u32 size, enum devlink_sb_threshold_type threshold_type, 145 struct netlink_ext_ack *extack) 146 { 147 struct nfp_pf *pf = devlink_priv(devlink); 148 149 return nfp_shared_buf_pool_set(pf, sb_index, pool_index, 150 size, threshold_type); 151 } 152 153 static int nfp_devlink_eswitch_mode_get(struct devlink *devlink, u16 *mode) 154 { 155 struct nfp_pf *pf = devlink_priv(devlink); 156 157 return nfp_app_eswitch_mode_get(pf->app, mode); 158 } 159 160 static int nfp_devlink_eswitch_mode_set(struct devlink *devlink, u16 mode, 161 struct netlink_ext_ack *extack) 162 { 163 struct nfp_pf *pf = devlink_priv(devlink); 164 int ret; 165 166 mutex_lock(&pf->lock); 167 ret = nfp_app_eswitch_mode_set(pf->app, mode); 168 mutex_unlock(&pf->lock); 169 170 return ret; 171 } 172 173 static const struct nfp_devlink_versions_simple { 174 const char *key; 175 const char *hwinfo; 176 } nfp_devlink_versions_hwinfo[] = { 177 { DEVLINK_INFO_VERSION_GENERIC_BOARD_ID, "assembly.partno", }, 178 { DEVLINK_INFO_VERSION_GENERIC_BOARD_REV, "assembly.revision", }, 179 { DEVLINK_INFO_VERSION_GENERIC_BOARD_MANUFACTURE, "assembly.vendor", }, 180 { "board.model", /* code name */ "assembly.model", }, 181 }; 182 183 static int 184 nfp_devlink_versions_get_hwinfo(struct nfp_pf *pf, struct devlink_info_req *req) 185 { 186 unsigned int i; 187 int err; 188 189 for (i = 0; i < ARRAY_SIZE(nfp_devlink_versions_hwinfo); i++) { 190 const struct nfp_devlink_versions_simple *info; 191 const char *val; 192 193 info = &nfp_devlink_versions_hwinfo[i]; 194 195 val = nfp_hwinfo_lookup(pf->hwinfo, info->hwinfo); 196 if (!val) 197 continue; 198 199 err = devlink_info_version_fixed_put(req, info->key, val); 200 if (err) 201 return err; 202 } 203 204 return 0; 205 } 206 207 static const struct nfp_devlink_versions { 208 enum nfp_nsp_versions id; 209 const char *key; 210 } nfp_devlink_versions_nsp[] = { 211 { NFP_VERSIONS_BUNDLE, DEVLINK_INFO_VERSION_GENERIC_FW_BUNDLE_ID, }, 212 { NFP_VERSIONS_BSP, DEVLINK_INFO_VERSION_GENERIC_FW_MGMT, }, 213 { NFP_VERSIONS_CPLD, "fw.cpld", }, 214 { NFP_VERSIONS_APP, DEVLINK_INFO_VERSION_GENERIC_FW_APP, }, 215 { NFP_VERSIONS_UNDI, DEVLINK_INFO_VERSION_GENERIC_FW_UNDI, }, 216 { NFP_VERSIONS_NCSI, DEVLINK_INFO_VERSION_GENERIC_FW_NCSI, }, 217 { NFP_VERSIONS_CFGR, "chip.init", }, 218 }; 219 220 static int 221 nfp_devlink_versions_get_nsp(struct devlink_info_req *req, bool flash, 222 const u8 *buf, unsigned int size) 223 { 224 unsigned int i; 225 int err; 226 227 for (i = 0; i < ARRAY_SIZE(nfp_devlink_versions_nsp); i++) { 228 const struct nfp_devlink_versions *info; 229 const char *version; 230 231 info = &nfp_devlink_versions_nsp[i]; 232 233 version = nfp_nsp_versions_get(info->id, flash, buf, size); 234 if (IS_ERR(version)) { 235 if (PTR_ERR(version) == -ENOENT) 236 continue; 237 else 238 return PTR_ERR(version); 239 } 240 241 if (flash) 242 err = devlink_info_version_stored_put(req, info->key, 243 version); 244 else 245 err = devlink_info_version_running_put(req, info->key, 246 version); 247 if (err) 248 return err; 249 } 250 251 return 0; 252 } 253 254 static int 255 nfp_devlink_info_get(struct devlink *devlink, struct devlink_info_req *req, 256 struct netlink_ext_ack *extack) 257 { 258 struct nfp_pf *pf = devlink_priv(devlink); 259 const char *sn, *vendor, *part; 260 struct nfp_nsp *nsp; 261 char *buf = NULL; 262 int err; 263 264 err = devlink_info_driver_name_put(req, "nfp"); 265 if (err) 266 return err; 267 268 vendor = nfp_hwinfo_lookup(pf->hwinfo, "assembly.vendor"); 269 part = nfp_hwinfo_lookup(pf->hwinfo, "assembly.partno"); 270 sn = nfp_hwinfo_lookup(pf->hwinfo, "assembly.serial"); 271 if (vendor && part && sn) { 272 char *buf; 273 274 buf = kmalloc(strlen(vendor) + strlen(part) + strlen(sn) + 1, 275 GFP_KERNEL); 276 if (!buf) 277 return -ENOMEM; 278 279 buf[0] = '\0'; 280 strcat(buf, vendor); 281 strcat(buf, part); 282 strcat(buf, sn); 283 284 err = devlink_info_serial_number_put(req, buf); 285 kfree(buf); 286 if (err) 287 return err; 288 } 289 290 nsp = nfp_nsp_open(pf->cpp); 291 if (IS_ERR(nsp)) { 292 NL_SET_ERR_MSG_MOD(extack, "can't access NSP"); 293 return PTR_ERR(nsp); 294 } 295 296 if (nfp_nsp_has_versions(nsp)) { 297 buf = kzalloc(NFP_NSP_VERSION_BUFSZ, GFP_KERNEL); 298 if (!buf) { 299 err = -ENOMEM; 300 goto err_close_nsp; 301 } 302 303 err = nfp_nsp_versions(nsp, buf, NFP_NSP_VERSION_BUFSZ); 304 if (err) 305 goto err_free_buf; 306 307 err = nfp_devlink_versions_get_nsp(req, false, 308 buf, NFP_NSP_VERSION_BUFSZ); 309 if (err) 310 goto err_free_buf; 311 312 err = nfp_devlink_versions_get_nsp(req, true, 313 buf, NFP_NSP_VERSION_BUFSZ); 314 if (err) 315 goto err_free_buf; 316 317 kfree(buf); 318 } 319 320 nfp_nsp_close(nsp); 321 322 return nfp_devlink_versions_get_hwinfo(pf, req); 323 324 err_free_buf: 325 kfree(buf); 326 err_close_nsp: 327 nfp_nsp_close(nsp); 328 return err; 329 } 330 331 static int 332 nfp_devlink_flash_update(struct devlink *devlink, const char *path, 333 const char *component, struct netlink_ext_ack *extack) 334 { 335 if (component) 336 return -EOPNOTSUPP; 337 return nfp_flash_update_common(devlink_priv(devlink), path, extack); 338 } 339 340 const struct devlink_ops nfp_devlink_ops = { 341 .port_split = nfp_devlink_port_split, 342 .port_unsplit = nfp_devlink_port_unsplit, 343 .sb_pool_get = nfp_devlink_sb_pool_get, 344 .sb_pool_set = nfp_devlink_sb_pool_set, 345 .eswitch_mode_get = nfp_devlink_eswitch_mode_get, 346 .eswitch_mode_set = nfp_devlink_eswitch_mode_set, 347 .info_get = nfp_devlink_info_get, 348 .flash_update = nfp_devlink_flash_update, 349 }; 350 351 int nfp_devlink_port_register(struct nfp_app *app, struct nfp_port *port) 352 { 353 struct devlink_port_attrs attrs = {}; 354 struct nfp_eth_table_port eth_port; 355 struct devlink *devlink; 356 const u8 *serial; 357 int serial_len; 358 int ret; 359 360 rtnl_lock(); 361 ret = nfp_devlink_fill_eth_port(port, ð_port); 362 rtnl_unlock(); 363 if (ret) 364 return ret; 365 366 attrs.split = eth_port.is_split; 367 attrs.splittable = !attrs.split; 368 attrs.flavour = DEVLINK_PORT_FLAVOUR_PHYSICAL; 369 attrs.phys.port_number = eth_port.label_port; 370 attrs.phys.split_subport_number = eth_port.label_subport; 371 serial_len = nfp_cpp_serial(port->app->cpp, &serial); 372 memcpy(attrs.switch_id.id, serial, serial_len); 373 attrs.switch_id.id_len = serial_len; 374 devlink_port_attrs_set(&port->dl_port, &attrs); 375 376 devlink = priv_to_devlink(app->pf); 377 378 return devlink_port_register(devlink, &port->dl_port, port->eth_id); 379 } 380 381 void nfp_devlink_port_unregister(struct nfp_port *port) 382 { 383 devlink_port_unregister(&port->dl_port); 384 } 385 386 void nfp_devlink_port_type_eth_set(struct nfp_port *port) 387 { 388 devlink_port_type_eth_set(&port->dl_port, port->netdev); 389 } 390 391 void nfp_devlink_port_type_clear(struct nfp_port *port) 392 { 393 devlink_port_type_clear(&port->dl_port); 394 } 395 396 struct devlink_port *nfp_devlink_get_devlink_port(struct net_device *netdev) 397 { 398 struct nfp_port *port; 399 400 port = nfp_port_from_netdev(netdev); 401 if (!port) 402 return NULL; 403 404 return &port->dl_port; 405 } 406