With device tree clock is provided via CCF. For non device tree
use a maximum clock value to not overclock the PHY. The non device
tree usage will go away after platform is converted to DT.

Signed-off-by: Thomas Bogendoerfer <tsbog...@alpha.franken.de>
---
 drivers/net/ethernet/korina.c | 19 +++++++++++++------
 1 file changed, 13 insertions(+), 6 deletions(-)

diff --git a/drivers/net/ethernet/korina.c b/drivers/net/ethernet/korina.c
index 7646ccc9d7e8..62bb691c8354 100644
--- a/drivers/net/ethernet/korina.c
+++ b/drivers/net/ethernet/korina.c
@@ -57,14 +57,13 @@
 #include <linux/ethtool.h>
 #include <linux/crc32.h>
 #include <linux/pgtable.h>
+#include <linux/clk.h>
 
 #include <asm/bootinfo.h>
 #include <asm/bitops.h>
 #include <asm/io.h>
 #include <asm/dma.h>
 
-#include <asm/mach-rc32434/rb.h>
-#include <asm/mach-rc32434/rc32434.h>
 #include <asm/mach-rc32434/eth.h>
 #include <asm/mach-rc32434/dma_v.h>
 
@@ -146,10 +145,9 @@ struct korina_private {
        struct work_struct restart_task;
        struct net_device *dev;
        struct device *dmadev;
+       int mii_clock_freq;
 };
 
-extern unsigned int idt_cpu_freq;
-
 static dma_addr_t korina_tx_dma(struct korina_private *lp, int idx)
 {
        return lp->td_dma + (idx * sizeof(struct dma_desc));
@@ -897,8 +895,8 @@ static int korina_init(struct net_device *dev)
 
        /* Management Clock Prescaler Divisor
         * Clock independent setting */
-       writel(((idt_cpu_freq) / MII_CLOCK + 1) & ~1,
-                       &lp->eth_regs->ethmcp);
+       writel(((lp->mii_clock_freq) / MII_CLOCK + 1) & ~1,
+              &lp->eth_regs->ethmcp);
        writel(0, &lp->eth_regs->miimcfg);
 
        /* don't transmit until fifo contains 48b */
@@ -1058,6 +1056,7 @@ static int korina_probe(struct platform_device *pdev)
        u8 *mac_addr = dev_get_platdata(&pdev->dev);
        struct korina_private *lp;
        struct net_device *dev;
+       struct clk *clk;
        void __iomem *p;
        int rc;
 
@@ -1079,6 +1078,14 @@ static int korina_probe(struct platform_device *pdev)
                        eth_hw_addr_random(dev);
        }
 
+       clk = devm_clk_get(&pdev->dev, NULL);
+       if (!IS_ERR(clk)) {
+               clk_prepare_enable(clk);
+               lp->mii_clock_freq = clk_get_rate(clk);
+       } else {
+               lp->mii_clock_freq = 200000000; /* max possible input clk */
+       }
+
        lp->rx_irq = platform_get_irq_byname(pdev, "korina_rx");
        lp->tx_irq = platform_get_irq_byname(pdev, "korina_tx");
 
-- 
2.29.2

Reply via email to