drivers/bcma/driver_chipcommon_b.c

0001 /*
0002  * Broadcom specific AMBA
0003  * ChipCommon B Unit driver
0004  *
0005  * Copyright 2014, Hauke Mehrtens <hauke@hauke-m.de>
0006  *
0007  * Licensed under the GNU/GPL. See COPYING for details.
0008  */
0009
0010 #include "bcma_private.h"
0011 #include <linux/export.h>
0012 #include <linux/bcma/bcma.h>
0013
0014 static bool bcma_wait_reg(struct bcma_bus *bus, void __iomem *addr, u32 mask,
0015               u32 value, int timeout)
0016 {
0017     unsigned long deadline = jiffies + timeout;
0018     u32 val;
0019
0020     do {
0021         val = readl(addr);
0022         if ((val & mask) == value)
0023             return true;
0024         cpu_relax();
0025         udelay(10);
0026     } while (!time_after_eq(jiffies, deadline));
0027
0028     bcma_err(bus, "Timeout waiting for register %p\n", addr);
0029
0030     return false;
0031 }
0032
0033 void bcma_chipco_b_mii_write(struct bcma_drv_cc_b *ccb, u32 offset, u32 value)
0034 {
0035     struct bcma_bus *bus = ccb->core->bus;
0036     void __iomem *mii = ccb->mii;
0037
0038     writel(offset, mii + BCMA_CCB_MII_MNG_CTL);
0039     bcma_wait_reg(bus, mii + BCMA_CCB_MII_MNG_CTL, 0x0100, 0x0000, 100);
0040     writel(value, mii + BCMA_CCB_MII_MNG_CMD_DATA);
0041     bcma_wait_reg(bus, mii + BCMA_CCB_MII_MNG_CTL, 0x0100, 0x0000, 100);
0042 }
0043 EXPORT_SYMBOL_GPL(bcma_chipco_b_mii_write);
0044
0045 int bcma_core_chipcommon_b_init(struct bcma_drv_cc_b *ccb)
0046 {
0047     if (ccb->setup_done)
0048         return 0;
0049
0050     ccb->setup_done = 1;
0051     ccb->mii = ioremap(ccb->core->addr_s[1], BCMA_CORE_SIZE);
0052     if (!ccb->mii)
0053         return -ENOMEM;
0054
0055     return 0;
0056 }
0057
0058 void bcma_core_chipcommon_b_free(struct bcma_drv_cc_b *ccb)
0059 {
0060     if (ccb->mii)
0061         iounmap(ccb->mii);
0062 }