1 // SPDX-License-Identifier: GPL-2.0 2 /* Marvell RVU Admin Function driver 3 * 4 * Copyright (C) 2018 Marvell. 5 * 6 */ 7 8 #include <linux/types.h> 9 #include <linux/module.h> 10 #include <linux/pci.h> 11 12 #include "rvu.h" 13 #include "cgx.h" 14 #include "lmac_common.h" 15 #include "rvu_reg.h" 16 #include "rvu_trace.h" 17 18 struct cgx_evq_entry { 19 struct list_head evq_node; 20 struct cgx_link_event link_event; 21 }; 22 23 #define M(_name, _id, _fn_name, _req_type, _rsp_type) \ 24 static struct _req_type __maybe_unused \ 25 *otx2_mbox_alloc_msg_ ## _fn_name(struct rvu *rvu, int devid) \ 26 { \ 27 struct _req_type *req; \ 28 \ 29 req = (struct _req_type *)otx2_mbox_alloc_msg_rsp( \ 30 &rvu->afpf_wq_info.mbox_up, devid, sizeof(struct _req_type), \ 31 sizeof(struct _rsp_type)); \ 32 if (!req) \ 33 return NULL; \ 34 req->hdr.sig = OTX2_MBOX_REQ_SIG; \ 35 req->hdr.id = _id; \ 36 trace_otx2_msg_alloc(rvu->pdev, _id, sizeof(*req)); \ 37 return req; \ 38 } 39 40 MBOX_UP_CGX_MESSAGES 41 #undef M 42 43 bool is_mac_feature_supported(struct rvu *rvu, int pf, int feature) 44 { 45 u8 cgx_id, lmac_id; 46 void *cgxd; 47 48 if (!is_pf_cgxmapped(rvu, pf)) 49 return 0; 50 51 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 52 cgxd = rvu_cgx_pdata(cgx_id, rvu); 53 54 return (cgx_features_get(cgxd) & feature); 55 } 56 57 /* Returns bitmap of mapped PFs */ 58 static u16 cgxlmac_to_pfmap(struct rvu *rvu, u8 cgx_id, u8 lmac_id) 59 { 60 return rvu->cgxlmac2pf_map[CGX_OFFSET(cgx_id) + lmac_id]; 61 } 62 63 int cgxlmac_to_pf(struct rvu *rvu, int cgx_id, int lmac_id) 64 { 65 unsigned long pfmap; 66 67 pfmap = cgxlmac_to_pfmap(rvu, cgx_id, lmac_id); 68 69 /* Assumes only one pf mapped to a cgx lmac port */ 70 if (!pfmap) 71 return -ENODEV; 72 else 73 return find_first_bit(&pfmap, 16); 74 } 75 76 static u8 cgxlmac_id_to_bmap(u8 cgx_id, u8 lmac_id) 77 { 78 return ((cgx_id & 0xF) << 4) | (lmac_id & 0xF); 79 } 80 81 void *rvu_cgx_pdata(u8 cgx_id, struct rvu *rvu) 82 { 83 if (cgx_id >= rvu->cgx_cnt_max) 84 return NULL; 85 86 return rvu->cgx_idmap[cgx_id]; 87 } 88 89 /* Return first enabled CGX instance if none are enabled then return NULL */ 90 void *rvu_first_cgx_pdata(struct rvu *rvu) 91 { 92 int first_enabled_cgx = 0; 93 void *cgxd = NULL; 94 95 for (; first_enabled_cgx < rvu->cgx_cnt_max; first_enabled_cgx++) { 96 cgxd = rvu_cgx_pdata(first_enabled_cgx, rvu); 97 if (cgxd) 98 break; 99 } 100 101 return cgxd; 102 } 103 104 /* Based on P2X connectivity find mapped NIX block for a PF */ 105 static void rvu_map_cgx_nix_block(struct rvu *rvu, int pf, 106 int cgx_id, int lmac_id) 107 { 108 struct rvu_pfvf *pfvf = &rvu->pf[pf]; 109 u8 p2x; 110 111 p2x = cgx_lmac_get_p2x(cgx_id, lmac_id); 112 /* Firmware sets P2X_SELECT as either NIX0 or NIX1 */ 113 pfvf->nix_blkaddr = BLKADDR_NIX0; 114 if (p2x == CMR_P2X_SEL_NIX1) 115 pfvf->nix_blkaddr = BLKADDR_NIX1; 116 } 117 118 static int rvu_map_cgx_lmac_pf(struct rvu *rvu) 119 { 120 struct npc_pkind *pkind = &rvu->hw->pkind; 121 int cgx_cnt_max = rvu->cgx_cnt_max; 122 int pf = PF_CGXMAP_BASE; 123 unsigned long lmac_bmap; 124 int size, free_pkind; 125 int cgx, lmac, iter; 126 int numvfs, hwvfs; 127 128 if (!cgx_cnt_max) 129 return 0; 130 131 if (cgx_cnt_max > 0xF || MAX_LMAC_PER_CGX > 0xF) 132 return -EINVAL; 133 134 /* Alloc map table 135 * An additional entry is required since PF id starts from 1 and 136 * hence entry at offset 0 is invalid. 137 */ 138 size = (cgx_cnt_max * MAX_LMAC_PER_CGX + 1) * sizeof(u8); 139 rvu->pf2cgxlmac_map = devm_kmalloc(rvu->dev, size, GFP_KERNEL); 140 if (!rvu->pf2cgxlmac_map) 141 return -ENOMEM; 142 143 /* Initialize all entries with an invalid cgx and lmac id */ 144 memset(rvu->pf2cgxlmac_map, 0xFF, size); 145 146 /* Reverse map table */ 147 rvu->cgxlmac2pf_map = devm_kzalloc(rvu->dev, 148 cgx_cnt_max * MAX_LMAC_PER_CGX * sizeof(u16), 149 GFP_KERNEL); 150 if (!rvu->cgxlmac2pf_map) 151 return -ENOMEM; 152 153 rvu->cgx_mapped_pfs = 0; 154 for (cgx = 0; cgx < cgx_cnt_max; cgx++) { 155 if (!rvu_cgx_pdata(cgx, rvu)) 156 continue; 157 lmac_bmap = cgx_get_lmac_bmap(rvu_cgx_pdata(cgx, rvu)); 158 for_each_set_bit(iter, &lmac_bmap, MAX_LMAC_PER_CGX) { 159 lmac = cgx_get_lmacid(rvu_cgx_pdata(cgx, rvu), 160 iter); 161 rvu->pf2cgxlmac_map[pf] = cgxlmac_id_to_bmap(cgx, lmac); 162 rvu->cgxlmac2pf_map[CGX_OFFSET(cgx) + lmac] = 1 << pf; 163 free_pkind = rvu_alloc_rsrc(&pkind->rsrc); 164 pkind->pfchan_map[free_pkind] = ((pf) & 0x3F) << 16; 165 rvu_map_cgx_nix_block(rvu, pf, cgx, lmac); 166 rvu->cgx_mapped_pfs++; 167 rvu_get_pf_numvfs(rvu, pf, &numvfs, &hwvfs); 168 rvu->cgx_mapped_vfs += numvfs; 169 pf++; 170 } 171 } 172 return 0; 173 } 174 175 static int rvu_cgx_send_link_info(int cgx_id, int lmac_id, struct rvu *rvu) 176 { 177 struct cgx_evq_entry *qentry; 178 unsigned long flags; 179 int err; 180 181 qentry = kmalloc(sizeof(*qentry), GFP_KERNEL); 182 if (!qentry) 183 return -ENOMEM; 184 185 /* Lock the event queue before we read the local link status */ 186 spin_lock_irqsave(&rvu->cgx_evq_lock, flags); 187 err = cgx_get_link_info(rvu_cgx_pdata(cgx_id, rvu), lmac_id, 188 &qentry->link_event.link_uinfo); 189 qentry->link_event.cgx_id = cgx_id; 190 qentry->link_event.lmac_id = lmac_id; 191 if (err) { 192 kfree(qentry); 193 goto skip_add; 194 } 195 list_add_tail(&qentry->evq_node, &rvu->cgx_evq_head); 196 skip_add: 197 spin_unlock_irqrestore(&rvu->cgx_evq_lock, flags); 198 199 /* start worker to process the events */ 200 queue_work(rvu->cgx_evh_wq, &rvu->cgx_evh_work); 201 202 return 0; 203 } 204 205 /* This is called from interrupt context and is expected to be atomic */ 206 static int cgx_lmac_postevent(struct cgx_link_event *event, void *data) 207 { 208 struct cgx_evq_entry *qentry; 209 struct rvu *rvu = data; 210 211 /* post event to the event queue */ 212 qentry = kmalloc(sizeof(*qentry), GFP_ATOMIC); 213 if (!qentry) 214 return -ENOMEM; 215 qentry->link_event = *event; 216 spin_lock(&rvu->cgx_evq_lock); 217 list_add_tail(&qentry->evq_node, &rvu->cgx_evq_head); 218 spin_unlock(&rvu->cgx_evq_lock); 219 220 /* start worker to process the events */ 221 queue_work(rvu->cgx_evh_wq, &rvu->cgx_evh_work); 222 223 return 0; 224 } 225 226 static void cgx_notify_pfs(struct cgx_link_event *event, struct rvu *rvu) 227 { 228 struct cgx_link_user_info *linfo; 229 struct cgx_link_info_msg *msg; 230 unsigned long pfmap; 231 int err, pfid; 232 233 linfo = &event->link_uinfo; 234 pfmap = cgxlmac_to_pfmap(rvu, event->cgx_id, event->lmac_id); 235 236 do { 237 pfid = find_first_bit(&pfmap, 16); 238 clear_bit(pfid, &pfmap); 239 240 /* check if notification is enabled */ 241 if (!test_bit(pfid, &rvu->pf_notify_bmap)) { 242 dev_info(rvu->dev, "cgx %d: lmac %d Link status %s\n", 243 event->cgx_id, event->lmac_id, 244 linfo->link_up ? "UP" : "DOWN"); 245 continue; 246 } 247 248 /* Send mbox message to PF */ 249 msg = otx2_mbox_alloc_msg_cgx_link_event(rvu, pfid); 250 if (!msg) 251 continue; 252 msg->link_info = *linfo; 253 otx2_mbox_msg_send(&rvu->afpf_wq_info.mbox_up, pfid); 254 err = otx2_mbox_wait_for_rsp(&rvu->afpf_wq_info.mbox_up, pfid); 255 if (err) 256 dev_warn(rvu->dev, "notification to pf %d failed\n", 257 pfid); 258 } while (pfmap); 259 } 260 261 static void cgx_evhandler_task(struct work_struct *work) 262 { 263 struct rvu *rvu = container_of(work, struct rvu, cgx_evh_work); 264 struct cgx_evq_entry *qentry; 265 struct cgx_link_event *event; 266 unsigned long flags; 267 268 do { 269 /* Dequeue an event */ 270 spin_lock_irqsave(&rvu->cgx_evq_lock, flags); 271 qentry = list_first_entry_or_null(&rvu->cgx_evq_head, 272 struct cgx_evq_entry, 273 evq_node); 274 if (qentry) 275 list_del(&qentry->evq_node); 276 spin_unlock_irqrestore(&rvu->cgx_evq_lock, flags); 277 if (!qentry) 278 break; /* nothing more to process */ 279 280 event = &qentry->link_event; 281 282 /* process event */ 283 cgx_notify_pfs(event, rvu); 284 kfree(qentry); 285 } while (1); 286 } 287 288 static int cgx_lmac_event_handler_init(struct rvu *rvu) 289 { 290 unsigned long lmac_bmap; 291 struct cgx_event_cb cb; 292 int cgx, lmac, err; 293 void *cgxd; 294 295 spin_lock_init(&rvu->cgx_evq_lock); 296 INIT_LIST_HEAD(&rvu->cgx_evq_head); 297 INIT_WORK(&rvu->cgx_evh_work, cgx_evhandler_task); 298 rvu->cgx_evh_wq = alloc_workqueue("rvu_evh_wq", 0, 0); 299 if (!rvu->cgx_evh_wq) { 300 dev_err(rvu->dev, "alloc workqueue failed"); 301 return -ENOMEM; 302 } 303 304 cb.notify_link_chg = cgx_lmac_postevent; /* link change call back */ 305 cb.data = rvu; 306 307 for (cgx = 0; cgx <= rvu->cgx_cnt_max; cgx++) { 308 cgxd = rvu_cgx_pdata(cgx, rvu); 309 if (!cgxd) 310 continue; 311 lmac_bmap = cgx_get_lmac_bmap(cgxd); 312 for_each_set_bit(lmac, &lmac_bmap, MAX_LMAC_PER_CGX) { 313 err = cgx_lmac_evh_register(&cb, cgxd, lmac); 314 if (err) 315 dev_err(rvu->dev, 316 "%d:%d handler register failed\n", 317 cgx, lmac); 318 } 319 } 320 321 return 0; 322 } 323 324 static void rvu_cgx_wq_destroy(struct rvu *rvu) 325 { 326 if (rvu->cgx_evh_wq) { 327 destroy_workqueue(rvu->cgx_evh_wq); 328 rvu->cgx_evh_wq = NULL; 329 } 330 } 331 332 int rvu_cgx_init(struct rvu *rvu) 333 { 334 int cgx, err; 335 void *cgxd; 336 337 /* CGX port id starts from 0 and are not necessarily contiguous 338 * Hence we allocate resources based on the maximum port id value. 339 */ 340 rvu->cgx_cnt_max = cgx_get_cgxcnt_max(); 341 if (!rvu->cgx_cnt_max) { 342 dev_info(rvu->dev, "No CGX devices found!\n"); 343 return -ENODEV; 344 } 345 346 rvu->cgx_idmap = devm_kzalloc(rvu->dev, rvu->cgx_cnt_max * 347 sizeof(void *), GFP_KERNEL); 348 if (!rvu->cgx_idmap) 349 return -ENOMEM; 350 351 /* Initialize the cgxdata table */ 352 for (cgx = 0; cgx < rvu->cgx_cnt_max; cgx++) 353 rvu->cgx_idmap[cgx] = cgx_get_pdata(cgx); 354 355 /* Map CGX LMAC interfaces to RVU PFs */ 356 err = rvu_map_cgx_lmac_pf(rvu); 357 if (err) 358 return err; 359 360 /* Register for CGX events */ 361 err = cgx_lmac_event_handler_init(rvu); 362 if (err) 363 return err; 364 365 mutex_init(&rvu->cgx_cfg_lock); 366 367 /* Ensure event handler registration is completed, before 368 * we turn on the links 369 */ 370 mb(); 371 372 /* Do link up for all CGX ports */ 373 for (cgx = 0; cgx <= rvu->cgx_cnt_max; cgx++) { 374 cgxd = rvu_cgx_pdata(cgx, rvu); 375 if (!cgxd) 376 continue; 377 err = cgx_lmac_linkup_start(cgxd); 378 if (err) 379 dev_err(rvu->dev, 380 "Link up process failed to start on cgx %d\n", 381 cgx); 382 } 383 384 return 0; 385 } 386 387 int rvu_cgx_exit(struct rvu *rvu) 388 { 389 unsigned long lmac_bmap; 390 int cgx, lmac; 391 void *cgxd; 392 393 for (cgx = 0; cgx <= rvu->cgx_cnt_max; cgx++) { 394 cgxd = rvu_cgx_pdata(cgx, rvu); 395 if (!cgxd) 396 continue; 397 lmac_bmap = cgx_get_lmac_bmap(cgxd); 398 for_each_set_bit(lmac, &lmac_bmap, MAX_LMAC_PER_CGX) 399 cgx_lmac_evh_unregister(cgxd, lmac); 400 } 401 402 /* Ensure event handler unregister is completed */ 403 mb(); 404 405 rvu_cgx_wq_destroy(rvu); 406 return 0; 407 } 408 409 /* Most of the CGX configuration is restricted to the mapped PF only, 410 * VF's of mapped PF and other PFs are not allowed. This fn() checks 411 * whether a PFFUNC is permitted to do the config or not. 412 */ 413 inline bool is_cgx_config_permitted(struct rvu *rvu, u16 pcifunc) 414 { 415 if ((pcifunc & RVU_PFVF_FUNC_MASK) || 416 !is_pf_cgxmapped(rvu, rvu_get_pf(pcifunc))) 417 return false; 418 return true; 419 } 420 421 void rvu_cgx_enadis_rx_bp(struct rvu *rvu, int pf, bool enable) 422 { 423 struct mac_ops *mac_ops; 424 u8 cgx_id, lmac_id; 425 void *cgxd; 426 427 if (!is_pf_cgxmapped(rvu, pf)) 428 return; 429 430 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 431 cgxd = rvu_cgx_pdata(cgx_id, rvu); 432 433 mac_ops = get_mac_ops(cgxd); 434 /* Set / clear CTL_BCK to control pause frame forwarding to NIX */ 435 if (enable) 436 mac_ops->mac_enadis_rx_pause_fwding(cgxd, lmac_id, true); 437 else 438 mac_ops->mac_enadis_rx_pause_fwding(cgxd, lmac_id, false); 439 } 440 441 int rvu_cgx_config_rxtx(struct rvu *rvu, u16 pcifunc, bool start) 442 { 443 int pf = rvu_get_pf(pcifunc); 444 struct mac_ops *mac_ops; 445 u8 cgx_id, lmac_id; 446 void *cgxd; 447 448 if (!is_cgx_config_permitted(rvu, pcifunc)) 449 return LMAC_AF_ERR_PERM_DENIED; 450 451 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 452 cgxd = rvu_cgx_pdata(cgx_id, rvu); 453 mac_ops = get_mac_ops(cgxd); 454 455 return mac_ops->mac_rx_tx_enable(cgxd, lmac_id, start); 456 } 457 458 int rvu_cgx_config_tx(void *cgxd, int lmac_id, bool enable) 459 { 460 struct mac_ops *mac_ops; 461 462 mac_ops = get_mac_ops(cgxd); 463 return mac_ops->mac_tx_enable(cgxd, lmac_id, enable); 464 } 465 466 void rvu_cgx_disable_dmac_entries(struct rvu *rvu, u16 pcifunc) 467 { 468 int pf = rvu_get_pf(pcifunc); 469 int i = 0, lmac_count = 0; 470 u8 max_dmac_filters; 471 u8 cgx_id, lmac_id; 472 void *cgx_dev; 473 474 if (!is_cgx_config_permitted(rvu, pcifunc)) 475 return; 476 477 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 478 cgx_dev = cgx_get_pdata(cgx_id); 479 lmac_count = cgx_get_lmac_cnt(cgx_dev); 480 max_dmac_filters = MAX_DMAC_ENTRIES_PER_CGX / lmac_count; 481 482 for (i = 0; i < max_dmac_filters; i++) 483 cgx_lmac_addr_del(cgx_id, lmac_id, i); 484 485 /* As cgx_lmac_addr_del does not clear entry for index 0 486 * so it needs to be done explicitly 487 */ 488 cgx_lmac_addr_reset(cgx_id, lmac_id); 489 } 490 491 int rvu_mbox_handler_cgx_start_rxtx(struct rvu *rvu, struct msg_req *req, 492 struct msg_rsp *rsp) 493 { 494 rvu_cgx_config_rxtx(rvu, req->hdr.pcifunc, true); 495 return 0; 496 } 497 498 int rvu_mbox_handler_cgx_stop_rxtx(struct rvu *rvu, struct msg_req *req, 499 struct msg_rsp *rsp) 500 { 501 rvu_cgx_config_rxtx(rvu, req->hdr.pcifunc, false); 502 return 0; 503 } 504 505 static int rvu_lmac_get_stats(struct rvu *rvu, struct msg_req *req, 506 void *rsp) 507 { 508 int pf = rvu_get_pf(req->hdr.pcifunc); 509 struct mac_ops *mac_ops; 510 int stat = 0, err = 0; 511 u64 tx_stat, rx_stat; 512 u8 cgx_idx, lmac; 513 void *cgxd; 514 515 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc)) 516 return LMAC_AF_ERR_PERM_DENIED; 517 518 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_idx, &lmac); 519 cgxd = rvu_cgx_pdata(cgx_idx, rvu); 520 mac_ops = get_mac_ops(cgxd); 521 522 /* Rx stats */ 523 while (stat < mac_ops->rx_stats_cnt) { 524 err = mac_ops->mac_get_rx_stats(cgxd, lmac, stat, &rx_stat); 525 if (err) 526 return err; 527 if (mac_ops->rx_stats_cnt == RPM_RX_STATS_COUNT) 528 ((struct rpm_stats_rsp *)rsp)->rx_stats[stat] = rx_stat; 529 else 530 ((struct cgx_stats_rsp *)rsp)->rx_stats[stat] = rx_stat; 531 stat++; 532 } 533 534 /* Tx stats */ 535 stat = 0; 536 while (stat < mac_ops->tx_stats_cnt) { 537 err = mac_ops->mac_get_tx_stats(cgxd, lmac, stat, &tx_stat); 538 if (err) 539 return err; 540 if (mac_ops->tx_stats_cnt == RPM_TX_STATS_COUNT) 541 ((struct rpm_stats_rsp *)rsp)->tx_stats[stat] = tx_stat; 542 else 543 ((struct cgx_stats_rsp *)rsp)->tx_stats[stat] = tx_stat; 544 stat++; 545 } 546 return 0; 547 } 548 549 int rvu_mbox_handler_cgx_stats(struct rvu *rvu, struct msg_req *req, 550 struct cgx_stats_rsp *rsp) 551 { 552 return rvu_lmac_get_stats(rvu, req, (void *)rsp); 553 } 554 555 int rvu_mbox_handler_rpm_stats(struct rvu *rvu, struct msg_req *req, 556 struct rpm_stats_rsp *rsp) 557 { 558 return rvu_lmac_get_stats(rvu, req, (void *)rsp); 559 } 560 561 int rvu_mbox_handler_cgx_fec_stats(struct rvu *rvu, 562 struct msg_req *req, 563 struct cgx_fec_stats_rsp *rsp) 564 { 565 int pf = rvu_get_pf(req->hdr.pcifunc); 566 u8 cgx_idx, lmac; 567 void *cgxd; 568 569 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc)) 570 return LMAC_AF_ERR_PERM_DENIED; 571 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_idx, &lmac); 572 573 cgxd = rvu_cgx_pdata(cgx_idx, rvu); 574 return cgx_get_fec_stats(cgxd, lmac, rsp); 575 } 576 577 int rvu_mbox_handler_cgx_mac_addr_set(struct rvu *rvu, 578 struct cgx_mac_addr_set_or_get *req, 579 struct cgx_mac_addr_set_or_get *rsp) 580 { 581 int pf = rvu_get_pf(req->hdr.pcifunc); 582 u8 cgx_id, lmac_id; 583 584 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc)) 585 return -EPERM; 586 587 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 588 589 cgx_lmac_addr_set(cgx_id, lmac_id, req->mac_addr); 590 591 return 0; 592 } 593 594 int rvu_mbox_handler_cgx_mac_addr_add(struct rvu *rvu, 595 struct cgx_mac_addr_add_req *req, 596 struct cgx_mac_addr_add_rsp *rsp) 597 { 598 int pf = rvu_get_pf(req->hdr.pcifunc); 599 u8 cgx_id, lmac_id; 600 int rc = 0; 601 602 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc)) 603 return -EPERM; 604 605 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 606 rc = cgx_lmac_addr_add(cgx_id, lmac_id, req->mac_addr); 607 if (rc >= 0) { 608 rsp->index = rc; 609 return 0; 610 } 611 612 return rc; 613 } 614 615 int rvu_mbox_handler_cgx_mac_addr_del(struct rvu *rvu, 616 struct cgx_mac_addr_del_req *req, 617 struct msg_rsp *rsp) 618 { 619 int pf = rvu_get_pf(req->hdr.pcifunc); 620 u8 cgx_id, lmac_id; 621 622 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc)) 623 return -EPERM; 624 625 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 626 return cgx_lmac_addr_del(cgx_id, lmac_id, req->index); 627 } 628 629 int rvu_mbox_handler_cgx_mac_max_entries_get(struct rvu *rvu, 630 struct msg_req *req, 631 struct cgx_max_dmac_entries_get_rsp 632 *rsp) 633 { 634 int pf = rvu_get_pf(req->hdr.pcifunc); 635 u8 cgx_id, lmac_id; 636 637 /* If msg is received from PFs(which are not mapped to CGX LMACs) 638 * or VF then no entries are allocated for DMAC filters at CGX level. 639 * So returning zero. 640 */ 641 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc)) { 642 rsp->max_dmac_filters = 0; 643 return 0; 644 } 645 646 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 647 rsp->max_dmac_filters = cgx_lmac_addr_max_entries_get(cgx_id, lmac_id); 648 return 0; 649 } 650 651 int rvu_mbox_handler_cgx_mac_addr_get(struct rvu *rvu, 652 struct cgx_mac_addr_set_or_get *req, 653 struct cgx_mac_addr_set_or_get *rsp) 654 { 655 int pf = rvu_get_pf(req->hdr.pcifunc); 656 u8 cgx_id, lmac_id; 657 int rc = 0, i; 658 u64 cfg; 659 660 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc)) 661 return -EPERM; 662 663 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 664 665 rsp->hdr.rc = rc; 666 cfg = cgx_lmac_addr_get(cgx_id, lmac_id); 667 /* copy 48 bit mac address to req->mac_addr */ 668 for (i = 0; i < ETH_ALEN; i++) 669 rsp->mac_addr[i] = cfg >> (ETH_ALEN - 1 - i) * 8; 670 return 0; 671 } 672 673 int rvu_mbox_handler_cgx_promisc_enable(struct rvu *rvu, struct msg_req *req, 674 struct msg_rsp *rsp) 675 { 676 u16 pcifunc = req->hdr.pcifunc; 677 int pf = rvu_get_pf(pcifunc); 678 u8 cgx_id, lmac_id; 679 680 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc)) 681 return -EPERM; 682 683 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 684 685 cgx_lmac_promisc_config(cgx_id, lmac_id, true); 686 return 0; 687 } 688 689 int rvu_mbox_handler_cgx_promisc_disable(struct rvu *rvu, struct msg_req *req, 690 struct msg_rsp *rsp) 691 { 692 int pf = rvu_get_pf(req->hdr.pcifunc); 693 u8 cgx_id, lmac_id; 694 695 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc)) 696 return -EPERM; 697 698 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 699 700 cgx_lmac_promisc_config(cgx_id, lmac_id, false); 701 return 0; 702 } 703 704 static int rvu_cgx_ptp_rx_cfg(struct rvu *rvu, u16 pcifunc, bool enable) 705 { 706 struct rvu_pfvf *pfvf = rvu_get_pfvf(rvu, pcifunc); 707 int pf = rvu_get_pf(pcifunc); 708 struct mac_ops *mac_ops; 709 u8 cgx_id, lmac_id; 710 void *cgxd; 711 712 if (!is_mac_feature_supported(rvu, pf, RVU_LMAC_FEAT_PTP)) 713 return 0; 714 715 /* This msg is expected only from PFs that are mapped to CGX LMACs, 716 * if received from other PF/VF simply ACK, nothing to do. 717 */ 718 if ((pcifunc & RVU_PFVF_FUNC_MASK) || 719 !is_pf_cgxmapped(rvu, pf)) 720 return -ENODEV; 721 722 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 723 cgxd = rvu_cgx_pdata(cgx_id, rvu); 724 725 mac_ops = get_mac_ops(cgxd); 726 mac_ops->mac_enadis_ptp_config(cgxd, lmac_id, true); 727 /* If PTP is enabled then inform NPC that packets to be 728 * parsed by this PF will have their data shifted by 8 bytes 729 * and if PTP is disabled then no shift is required 730 */ 731 if (npc_config_ts_kpuaction(rvu, pf, pcifunc, enable)) 732 return -EINVAL; 733 /* This flag is required to clean up CGX conf if app gets killed */ 734 pfvf->hw_rx_tstamp_en = enable; 735 736 return 0; 737 } 738 739 int rvu_mbox_handler_cgx_ptp_rx_enable(struct rvu *rvu, struct msg_req *req, 740 struct msg_rsp *rsp) 741 { 742 if (!is_pf_cgxmapped(rvu, rvu_get_pf(req->hdr.pcifunc))) 743 return -EPERM; 744 745 return rvu_cgx_ptp_rx_cfg(rvu, req->hdr.pcifunc, true); 746 } 747 748 int rvu_mbox_handler_cgx_ptp_rx_disable(struct rvu *rvu, struct msg_req *req, 749 struct msg_rsp *rsp) 750 { 751 return rvu_cgx_ptp_rx_cfg(rvu, req->hdr.pcifunc, false); 752 } 753 754 static int rvu_cgx_config_linkevents(struct rvu *rvu, u16 pcifunc, bool en) 755 { 756 int pf = rvu_get_pf(pcifunc); 757 u8 cgx_id, lmac_id; 758 759 if (!is_cgx_config_permitted(rvu, pcifunc)) 760 return -EPERM; 761 762 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 763 764 if (en) { 765 set_bit(pf, &rvu->pf_notify_bmap); 766 /* Send the current link status to PF */ 767 rvu_cgx_send_link_info(cgx_id, lmac_id, rvu); 768 } else { 769 clear_bit(pf, &rvu->pf_notify_bmap); 770 } 771 772 return 0; 773 } 774 775 int rvu_mbox_handler_cgx_start_linkevents(struct rvu *rvu, struct msg_req *req, 776 struct msg_rsp *rsp) 777 { 778 rvu_cgx_config_linkevents(rvu, req->hdr.pcifunc, true); 779 return 0; 780 } 781 782 int rvu_mbox_handler_cgx_stop_linkevents(struct rvu *rvu, struct msg_req *req, 783 struct msg_rsp *rsp) 784 { 785 rvu_cgx_config_linkevents(rvu, req->hdr.pcifunc, false); 786 return 0; 787 } 788 789 int rvu_mbox_handler_cgx_get_linkinfo(struct rvu *rvu, struct msg_req *req, 790 struct cgx_link_info_msg *rsp) 791 { 792 u8 cgx_id, lmac_id; 793 int pf, err; 794 795 pf = rvu_get_pf(req->hdr.pcifunc); 796 797 if (!is_pf_cgxmapped(rvu, pf)) 798 return -ENODEV; 799 800 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 801 802 err = cgx_get_link_info(rvu_cgx_pdata(cgx_id, rvu), lmac_id, 803 &rsp->link_info); 804 return err; 805 } 806 807 int rvu_mbox_handler_cgx_features_get(struct rvu *rvu, 808 struct msg_req *req, 809 struct cgx_features_info_msg *rsp) 810 { 811 int pf = rvu_get_pf(req->hdr.pcifunc); 812 u8 cgx_idx, lmac; 813 void *cgxd; 814 815 if (!is_pf_cgxmapped(rvu, pf)) 816 return 0; 817 818 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_idx, &lmac); 819 cgxd = rvu_cgx_pdata(cgx_idx, rvu); 820 rsp->lmac_features = cgx_features_get(cgxd); 821 822 return 0; 823 } 824 825 u32 rvu_cgx_get_fifolen(struct rvu *rvu) 826 { 827 struct mac_ops *mac_ops; 828 u32 fifo_len; 829 830 mac_ops = get_mac_ops(rvu_first_cgx_pdata(rvu)); 831 fifo_len = mac_ops ? mac_ops->fifo_len : 0; 832 833 return fifo_len; 834 } 835 836 static int rvu_cgx_config_intlbk(struct rvu *rvu, u16 pcifunc, bool en) 837 { 838 int pf = rvu_get_pf(pcifunc); 839 struct mac_ops *mac_ops; 840 u8 cgx_id, lmac_id; 841 842 if (!is_cgx_config_permitted(rvu, pcifunc)) 843 return -EPERM; 844 845 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 846 mac_ops = get_mac_ops(rvu_cgx_pdata(cgx_id, rvu)); 847 848 return mac_ops->mac_lmac_intl_lbk(rvu_cgx_pdata(cgx_id, rvu), 849 lmac_id, en); 850 } 851 852 int rvu_mbox_handler_cgx_intlbk_enable(struct rvu *rvu, struct msg_req *req, 853 struct msg_rsp *rsp) 854 { 855 rvu_cgx_config_intlbk(rvu, req->hdr.pcifunc, true); 856 return 0; 857 } 858 859 int rvu_mbox_handler_cgx_intlbk_disable(struct rvu *rvu, struct msg_req *req, 860 struct msg_rsp *rsp) 861 { 862 rvu_cgx_config_intlbk(rvu, req->hdr.pcifunc, false); 863 return 0; 864 } 865 866 int rvu_mbox_handler_cgx_cfg_pause_frm(struct rvu *rvu, 867 struct cgx_pause_frm_cfg *req, 868 struct cgx_pause_frm_cfg *rsp) 869 { 870 int pf = rvu_get_pf(req->hdr.pcifunc); 871 struct mac_ops *mac_ops; 872 u8 cgx_id, lmac_id; 873 void *cgxd; 874 875 if (!is_mac_feature_supported(rvu, pf, RVU_LMAC_FEAT_FC)) 876 return 0; 877 878 /* This msg is expected only from PF/VFs that are mapped to CGX LMACs, 879 * if received from other PF/VF simply ACK, nothing to do. 880 */ 881 if (!is_pf_cgxmapped(rvu, pf)) 882 return -ENODEV; 883 884 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 885 cgxd = rvu_cgx_pdata(cgx_id, rvu); 886 mac_ops = get_mac_ops(cgxd); 887 888 if (req->set) 889 mac_ops->mac_enadis_pause_frm(cgxd, lmac_id, 890 req->tx_pause, req->rx_pause); 891 else 892 mac_ops->mac_get_pause_frm_status(cgxd, lmac_id, 893 &rsp->tx_pause, 894 &rsp->rx_pause); 895 return 0; 896 } 897 898 int rvu_mbox_handler_cgx_get_phy_fec_stats(struct rvu *rvu, struct msg_req *req, 899 struct msg_rsp *rsp) 900 { 901 int pf = rvu_get_pf(req->hdr.pcifunc); 902 u8 cgx_id, lmac_id; 903 904 if (!is_pf_cgxmapped(rvu, pf)) 905 return LMAC_AF_ERR_PF_NOT_MAPPED; 906 907 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 908 return cgx_get_phy_fec_stats(rvu_cgx_pdata(cgx_id, rvu), lmac_id); 909 } 910 911 /* Finds cumulative status of NIX rx/tx counters from LF of a PF and those 912 * from its VFs as well. ie. NIX rx/tx counters at the CGX port level 913 */ 914 int rvu_cgx_nix_cuml_stats(struct rvu *rvu, void *cgxd, int lmac_id, 915 int index, int rxtxflag, u64 *stat) 916 { 917 struct rvu_block *block; 918 int blkaddr; 919 u16 pcifunc; 920 int pf, lf; 921 922 *stat = 0; 923 924 if (!cgxd || !rvu) 925 return -EINVAL; 926 927 pf = cgxlmac_to_pf(rvu, cgx_get_cgxid(cgxd), lmac_id); 928 if (pf < 0) 929 return pf; 930 931 /* Assumes LF of a PF and all of its VF belongs to the same 932 * NIX block 933 */ 934 pcifunc = pf << RVU_PFVF_PF_SHIFT; 935 blkaddr = rvu_get_blkaddr(rvu, BLKTYPE_NIX, pcifunc); 936 if (blkaddr < 0) 937 return 0; 938 block = &rvu->hw->block[blkaddr]; 939 940 for (lf = 0; lf < block->lf.max; lf++) { 941 /* Check if a lf is attached to this PF or one of its VFs */ 942 if (!((block->fn_map[lf] & ~RVU_PFVF_FUNC_MASK) == (pcifunc & 943 ~RVU_PFVF_FUNC_MASK))) 944 continue; 945 if (rxtxflag == NIX_STATS_RX) 946 *stat += rvu_read64(rvu, blkaddr, 947 NIX_AF_LFX_RX_STATX(lf, index)); 948 else 949 *stat += rvu_read64(rvu, blkaddr, 950 NIX_AF_LFX_TX_STATX(lf, index)); 951 } 952 953 return 0; 954 } 955 956 int rvu_cgx_start_stop_io(struct rvu *rvu, u16 pcifunc, bool start) 957 { 958 struct rvu_pfvf *parent_pf, *pfvf; 959 int cgx_users, err = 0; 960 961 if (!is_pf_cgxmapped(rvu, rvu_get_pf(pcifunc))) 962 return 0; 963 964 parent_pf = &rvu->pf[rvu_get_pf(pcifunc)]; 965 pfvf = rvu_get_pfvf(rvu, pcifunc); 966 967 mutex_lock(&rvu->cgx_cfg_lock); 968 969 if (start && pfvf->cgx_in_use) 970 goto exit; /* CGX is already started hence nothing to do */ 971 if (!start && !pfvf->cgx_in_use) 972 goto exit; /* CGX is already stopped hence nothing to do */ 973 974 if (start) { 975 cgx_users = parent_pf->cgx_users; 976 parent_pf->cgx_users++; 977 } else { 978 parent_pf->cgx_users--; 979 cgx_users = parent_pf->cgx_users; 980 } 981 982 /* Start CGX when first of all NIXLFs is started. 983 * Stop CGX when last of all NIXLFs is stopped. 984 */ 985 if (!cgx_users) { 986 err = rvu_cgx_config_rxtx(rvu, pcifunc & ~RVU_PFVF_FUNC_MASK, 987 start); 988 if (err) { 989 dev_err(rvu->dev, "Unable to %s CGX\n", 990 start ? "start" : "stop"); 991 /* Revert the usage count in case of error */ 992 parent_pf->cgx_users = start ? parent_pf->cgx_users - 1 993 : parent_pf->cgx_users + 1; 994 goto exit; 995 } 996 } 997 pfvf->cgx_in_use = start; 998 exit: 999 mutex_unlock(&rvu->cgx_cfg_lock); 1000 return err; 1001 } 1002 1003 int rvu_mbox_handler_cgx_set_fec_param(struct rvu *rvu, 1004 struct fec_mode *req, 1005 struct fec_mode *rsp) 1006 { 1007 int pf = rvu_get_pf(req->hdr.pcifunc); 1008 u8 cgx_id, lmac_id; 1009 1010 if (!is_pf_cgxmapped(rvu, pf)) 1011 return -EPERM; 1012 1013 if (req->fec == OTX2_FEC_OFF) 1014 req->fec = OTX2_FEC_NONE; 1015 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 1016 rsp->fec = cgx_set_fec(req->fec, cgx_id, lmac_id); 1017 return 0; 1018 } 1019 1020 int rvu_mbox_handler_cgx_get_aux_link_info(struct rvu *rvu, struct msg_req *req, 1021 struct cgx_fw_data *rsp) 1022 { 1023 int pf = rvu_get_pf(req->hdr.pcifunc); 1024 u8 cgx_id, lmac_id; 1025 1026 if (!rvu->fwdata) 1027 return -ENXIO; 1028 1029 if (!is_pf_cgxmapped(rvu, pf)) 1030 return -EPERM; 1031 1032 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 1033 1034 memcpy(&rsp->fwdata, &rvu->fwdata->cgx_fw_data[cgx_id][lmac_id], 1035 sizeof(struct cgx_lmac_fwdata_s)); 1036 return 0; 1037 } 1038 1039 int rvu_mbox_handler_cgx_set_link_mode(struct rvu *rvu, 1040 struct cgx_set_link_mode_req *req, 1041 struct cgx_set_link_mode_rsp *rsp) 1042 { 1043 int pf = rvu_get_pf(req->hdr.pcifunc); 1044 u8 cgx_idx, lmac; 1045 void *cgxd; 1046 1047 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc)) 1048 return -EPERM; 1049 1050 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_idx, &lmac); 1051 cgxd = rvu_cgx_pdata(cgx_idx, rvu); 1052 rsp->status = cgx_set_link_mode(cgxd, req->args, cgx_idx, lmac); 1053 return 0; 1054 } 1055 1056 int rvu_mbox_handler_cgx_mac_addr_reset(struct rvu *rvu, struct msg_req *req, 1057 struct msg_rsp *rsp) 1058 { 1059 int pf = rvu_get_pf(req->hdr.pcifunc); 1060 u8 cgx_id, lmac_id; 1061 1062 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc)) 1063 return LMAC_AF_ERR_PERM_DENIED; 1064 1065 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 1066 return cgx_lmac_addr_reset(cgx_id, lmac_id); 1067 } 1068 1069 int rvu_mbox_handler_cgx_mac_addr_update(struct rvu *rvu, 1070 struct cgx_mac_addr_update_req *req, 1071 struct msg_rsp *rsp) 1072 { 1073 int pf = rvu_get_pf(req->hdr.pcifunc); 1074 u8 cgx_id, lmac_id; 1075 1076 if (!is_cgx_config_permitted(rvu, req->hdr.pcifunc)) 1077 return LMAC_AF_ERR_PERM_DENIED; 1078 1079 rvu_get_cgx_lmac_id(rvu->pf2cgxlmac_map[pf], &cgx_id, &lmac_id); 1080 return cgx_lmac_addr_update(cgx_id, lmac_id, req->mac_addr, req->index); 1081 } 1082