rtl8211F_led_control

hc

2024-05-11 297b60346df8beafee954a0fd7c2d64f33f3b9bc

 kernel/drivers/net/ethernet/amd/xgbe/xgbe-dev.c
..
..
@@ -524,19 +524,28 @@
524
524
 	netif_dbg(pdata, drv, pdata->netdev, "VXLAN acceleration disabled\n");
525
525
 }
526
526
 
527
+static unsigned int xgbe_get_fc_queue_count(struct xgbe_prv_data *pdata)
528
+{
529
+	unsigned int max_q_count = XGMAC_MAX_FLOW_CONTROL_QUEUES;
530
+
531
+	/* From MAC ver 30H the TFCR is per priority, instead of per queue */
532
+	if (XGMAC_GET_BITS(pdata->hw_feat.version, MAC_VR, SNPSVER) >= 0x30)
533
+		return max_q_count;
534
+	else
535
+		return min_t(unsigned int, pdata->tx_q_count, max_q_count);
536
+}
537
+
527
538
 static int xgbe_disable_tx_flow_control(struct xgbe_prv_data *pdata)
528
539
 {
529
-	unsigned int max_q_count, q_count;
530
540
 	unsigned int reg, reg_val;
531
-	unsigned int i;
541
+	unsigned int i, q_count;
532
542
 
533
543
 	/* Clear MTL flow control */
534
544
 	for (i = 0; i < pdata->rx_q_count; i++)
535
545
 		XGMAC_MTL_IOWRITE_BITS(pdata, i, MTL_Q_RQOMR, EHFC, 0);
536
546
 
537
547
 	/* Clear MAC flow control */
538
-	max_q_count = XGMAC_MAX_FLOW_CONTROL_QUEUES;
539
-	q_count = min_t(unsigned int, pdata->tx_q_count, max_q_count);
548
+	q_count = xgbe_get_fc_queue_count(pdata);
540
549
 	reg = MAC_Q0TFCR;
541
550
 	for (i = 0; i < q_count; i++) {
542
551
 		reg_val = XGMAC_IOREAD(pdata, reg);
..
..
@@ -553,9 +562,8 @@
553
562
 {
554
563
 	struct ieee_pfc *pfc = pdata->pfc;
555
564
 	struct ieee_ets *ets = pdata->ets;
556
-	unsigned int max_q_count, q_count;
557
565
 	unsigned int reg, reg_val;
558
-	unsigned int i;
566
+	unsigned int i, q_count;
559
567
 
560
568
 	/* Set MTL flow control */
561
569
 	for (i = 0; i < pdata->rx_q_count; i++) {
..
..
@@ -579,8 +587,7 @@
579
587
 	}
580
588
 
581
589
 	/* Set MAC flow control */
582
-	max_q_count = XGMAC_MAX_FLOW_CONTROL_QUEUES;
583
-	q_count = min_t(unsigned int, pdata->tx_q_count, max_q_count);
590
+	q_count = xgbe_get_fc_queue_count(pdata);
584
591
 	reg = MAC_Q0TFCR;
585
592
 	for (i = 0; i < q_count; i++) {
586
593
 		reg_val = XGMAC_IOREAD(pdata, reg);