add wifi6 8852be driver

hc

2024-12-19 9370bb92b2d16684ee45cf24e879c93c509162da

 kernel/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c
..
..
@@ -1101,6 +1101,7 @@
1101
1101
 	}
1102
1102
 }
1103
1103
 
1104
+#if 0
1104
1105
 static void rtl8211F_led_control(struct phy_device *phydev)
1105
1106
 {
1106
1107
 	printk("ben debug:rtl8211F_led_control...1 \n");
..
..
@@ -1117,6 +1118,37 @@
1117
1118
 //     	phy_write(phydev, 16, 0x6C0A); 
1118
1119
 	printk("ben debug:rtl8211F_led_control...2 \n");
1119
1120
 }
1121
+#endif
1122
+#define RTL_8211F_PHY_ID        0x001cc916
1123
+#define RTL_8211F_PHY_ID_MASK   0x001fffff
1124
+#define RTL_8211F_PAGE_SELECT   0x1f
1125
+#define RTL_8211F_LCR_ADDR      0x10
1126
+
1127
+#define GREEN_LED 0 
1128
+#define YELLOW0_LED 1 
1129
+#define YELLOW1_LED 2 
1130
+			      
1131
+static int rtl8211F_led_control(struct phy_device *phydev)
1132
+{
1133
+	unsigned int temp;
1134
+
1135
+        printk("<<<<<<ben test led ctrl start... %s\n",__FUNCTION__);
1136
+        if(!phydev) return 0;
1137
+        if(phydev->phy_id!=0x001cc916) return 0; /* only for 8211E*/
1138
+
1139
+	phy_write(phydev, 31, 0xd04);
1140
+	temp = 0x02 << (5 * GREEN_LED); 
1141
+	temp |= 0x08 << (5 * YELLOW0_LED); 
1142
+
1143
+	temp |= 0x1b << (5 * YELLOW1_LED); 
1144
+	phy_write(phydev, 0x10, temp);
1145
+
1146
+	temp = 1 << (YELLOW1_LED + 1); 
1147
+	phy_write(phydev, 0x11, 0x00);
1148
+	phy_write(phydev, 31, 0);
1149
+
1150
+	return 0;
1151
+}
1120
1152
 
1121
1153
 /**
1122
1154
  * stmmac_init_phy - PHY initialization
..
..
@@ -1132,29 +1164,43 @@
1132
1164
 	struct device_node *node;
1133
1165
 	int ret;
1134
1166
 
1167
+
1168
+	printk("ben stmmac_init_phy  .. \n");
1169
+	mdelay(2000);
1170
+	printk("ben stmmac_init_phy delay .. \n");
1135
1171
 	if (priv->plat->integrated_phy_power)
1136
1172
 		ret = priv->plat->integrated_phy_power(priv->plat->bsp_priv, true);
1137
1173
 
1138
1174
 	node = priv->plat->phylink_node;
1139
1175
 
1140
1176
 	if (node)
1177
+	{
1178
+		//printk("ben ttt.. \n");	
1141
1179
 		ret = phylink_of_phy_connect(priv->phylink, node, 0);
1180
+		//printk("ben ttt:%d \n", ret);
1181
+	}	
1142
1182
 
1143
1183
 	/* Some DT bindings do not set-up the PHY handle. Let's try to
1144
1184
 	 * manually parse it
1145
1185
 	 */
1186
+	//printk("ben:stmmac_init_phy..1 \n");
1146
1187
 	if (!node || ret) {
1188
+	//if (1) {
1147
1189
 		int addr = priv->plat->phy_addr;
1148
1190
 		struct phy_device *phydev;
1149
1191
 
1192
+		//printk("ben:stmmac_init_phy..2 \n");
1150
1193
 		phydev = mdiobus_get_phy(priv->mii, addr);
1151
1194
 		if (!phydev) {
1152
1195
 			netdev_err(priv->dev, "no phy at addr %d\n", addr);
1153
1196
 			return -ENODEV;
1154
1197
 		}
1155
1198
 
1156
-		rtl8211F_led_control(phydev);
1199
+		//rtl8211F_led_control(phydev);
1200
+		
1201
+		//printk("ben:stmmac_init_phy..3 \n");
1157
1202
 		ret = phylink_connect_phy(priv->phylink, phydev);
1203
+		//rtl8211F_led_control(phydev);
1158
1204
 	}
1159
1205
 
1160
1206
 	if (!priv->plat->pmt) {
..
..
@@ -2884,6 +2930,7 @@
2884
2930
 	u32 chan;
2885
2931
 	int ret;
2886
2932
 
2933
+	//printk("ben:stmmac_open.. \n");
2887
2934
 	ret = pm_runtime_get_sync(priv->device);
2888
2935
 	if (ret < 0) {
2889
2936
 		pm_runtime_put_noidle(priv->device);
..
..
@@ -2957,6 +3004,12 @@
2957
3004
 			goto init_error;
2958
3005
 		}
2959
3006
 	}
3007
+
3008
+
3009
+	#if 1
3010
+	printk("ben -------bootup add 2s delay time.\n");
3011
+	mdelay(2500);
3012
+	#endif
2960
3013
 
2961
3014
 	ret = stmmac_hw_setup(dev, true);
2962
3015
 	if (ret < 0) {
..
..
@@ -5246,6 +5299,9 @@
5246
5299
 	 */
5247
5300
 	pm_runtime_put(device);
5248
5301
 
5302
+	//add
5303
+	phy_register_fixup_for_uid(RTL_8211F_PHY_ID, RTL_8211F_PHY_ID_MASK, rtl8211F_led_control);
5304
+
5249
5305
 	return ret;
5250
5306
 
5251
5307
 error_netdev_register:
..
..
@@ -5457,6 +5513,12 @@
5457
5513
 	stmmac_free_tx_skbufs(priv);
5458
5514
 	stmmac_clear_descriptors(priv);
5459
5515
 
5516
+#if 1
5517
+	printk("ben -------resume add 2s delay time.\n");	
5518
+	mdelay(2000);
5519
+
5520
+#endif
5521
+
5460
5522
 	stmmac_hw_setup(ndev, false);
5461
5523
 	stmmac_init_coalesce(priv);
5462
5524
 	stmmac_set_rx_mode(ndev);