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