writel(XGMAC_INT_DEFAULT_EN, ioaddr + XGMAC_INT_EN);
 }
 
+static void xgmac_phylink_get_caps(struct stmmac_priv *priv)
+{
+       priv->phylink_config.mac_capabilities |= MAC_2500FD | MAC_5000FD |
+                                                MAC_10000FD | MAC_25000FD |
+                                                MAC_40000FD | MAC_50000FD |
+                                                MAC_100000FD;
+}
+
 static void dwxgmac2_set_mac(void __iomem *ioaddr, bool enable)
 {
        u32 tx = readl(ioaddr + XGMAC_TX_CONFIG);
 
 const struct stmmac_ops dwxgmac210_ops = {
        .core_init = dwxgmac2_core_init,
+       .phylink_get_caps = xgmac_phylink_get_caps,
        .set_mac = dwxgmac2_set_mac,
        .rx_ipc = dwxgmac2_rx_ipc,
        .rx_queue_enable = dwxgmac2_rx_queue_enable,
 
 const struct stmmac_ops dwxlgmac2_ops = {
        .core_init = dwxgmac2_core_init,
+       .phylink_get_caps = xgmac_phylink_get_caps,
        .set_mac = dwxgmac2_set_mac,
        .rx_ipc = dwxgmac2_rx_ipc,
        .rx_queue_enable = dwxlgmac2_rx_queue_enable,
 
        /* Get the MAC specific capabilities */
        stmmac_mac_phylink_get_caps(priv);
 
-       if (priv->plat->has_xgmac) {
-               priv->phylink_config.mac_capabilities |= MAC_2500FD;
-               priv->phylink_config.mac_capabilities |= MAC_5000FD;
-               priv->phylink_config.mac_capabilities |= MAC_10000FD;
-               priv->phylink_config.mac_capabilities |= MAC_25000FD;
-               priv->phylink_config.mac_capabilities |= MAC_40000FD;
-               priv->phylink_config.mac_capabilities |= MAC_50000FD;
-               priv->phylink_config.mac_capabilities |= MAC_100000FD;
-       }
-
        /* Half-Duplex can only work with single queue */
        if (priv->plat->tx_queues_to_use > 1)
                priv->phylink_config.mac_capabilities &=