1 --- a/drivers/net/ethernet/stmicro/stmmac/dwmac-ipq806x.c
2 +++ b/drivers/net/ethernet/stmicro/stmmac/dwmac-ipq806x.c
4 #define NSS_COMMON_CLK_DIV_SGMII_100 4
5 #define NSS_COMMON_CLK_DIV_SGMII_10 49
7 +#define QSGMII_PCS_ALL_CH_CTL 0x80
8 +#define QSGMII_PCS_CH_SPEED_FORCE 0x2
9 +#define QSGMII_PCS_CH_SPEED_10 0x0
10 +#define QSGMII_PCS_CH_SPEED_100 0x4
11 +#define QSGMII_PCS_CH_SPEED_1000 0x8
12 +#define QSGMII_PCS_CH_SPEED_MASK (QSGMII_PCS_CH_SPEED_FORCE | \
13 + QSGMII_PCS_CH_SPEED_10 | \
14 + QSGMII_PCS_CH_SPEED_100 | \
15 + QSGMII_PCS_CH_SPEED_1000)
16 +#define QSGMII_PCS_CH_SPEED_SHIFT(x) (x * 4)
18 #define QSGMII_PCS_CAL_LCKDT_CTL 0x120
19 #define QSGMII_PCS_CAL_LCKDT_CTL_RST BIT(19)
21 @@ -241,6 +252,36 @@ static void ipq806x_gmac_fix_mac_speed(v
22 ipq806x_gmac_set_speed(gmac, speed);
26 +ipq806x_gmac_get_qsgmii_pcs_speed_val(struct platform_device *pdev) {
27 + struct device_node *fixed_link_node;
29 + int fixed_link_speed;
31 + if (!of_phy_is_fixed_link(pdev->dev.of_node))
34 + fixed_link_node = of_get_child_by_name(pdev->dev.of_node, "fixed-link");
35 + if (!fixed_link_node)
38 + rv = of_property_read_u32(fixed_link_node, "speed", &fixed_link_speed);
39 + of_node_put(fixed_link_node);
43 + switch (fixed_link_speed) {
45 + return QSGMII_PCS_CH_SPEED_FORCE | QSGMII_PCS_CH_SPEED_1000;
47 + return QSGMII_PCS_CH_SPEED_FORCE | QSGMII_PCS_CH_SPEED_100;
49 + return QSGMII_PCS_CH_SPEED_FORCE | QSGMII_PCS_CH_SPEED_10;
55 static int ipq806x_gmac_probe(struct platform_device *pdev)
57 struct plat_stmmacenet_data *plat_dat;
58 @@ -249,6 +290,7 @@ static int ipq806x_gmac_probe(struct pla
59 struct ipq806x_gmac *gmac;
62 + int qsgmii_pcs_speed;
64 val = stmmac_get_platform_resources(pdev, &stmmac_res);
66 @@ -345,6 +387,17 @@ static int ipq806x_gmac_probe(struct pla
67 0x1ul << QSGMII_PHY_RX_INPUT_EQU_OFFSET |
68 0x2ul << QSGMII_PHY_CDR_PI_SLEW_OFFSET |
69 0xCul << QSGMII_PHY_TX_DRV_AMP_OFFSET);
71 + qsgmii_pcs_speed = ipq806x_gmac_get_qsgmii_pcs_speed_val(pdev);
72 + if (qsgmii_pcs_speed != -1) {
75 + QSGMII_PCS_ALL_CH_CTL,
76 + QSGMII_PCS_CH_SPEED_MASK <<
77 + QSGMII_PCS_CH_SPEED_SHIFT(gmac->id),
79 + QSGMII_PCS_CH_SPEED_SHIFT(gmac->id));
83 plat_dat->has_gmac = true;