1 /* 2 * Broadcom specific AMBA 3 * ChipCommon B Unit driver 4 * 5 * Copyright 2014, Hauke Mehrtens <hauke@hauke-m.de> 6 * 7 * Licensed under the GNU/GPL. See COPYING for details. 8 */ 9 10 #include "bcma_private.h" 11 #include <linux/export.h> 12 #include <linux/bcma/bcma.h> 13 14 static bool bcma_wait_reg(struct bcma_bus *bus, void __iomem *addr, u32 mask, 15 u32 value, int timeout) 16 { 17 unsigned long deadline = jiffies + timeout; 18 u32 val; 19 20 do { 21 val = readl(addr); 22 if ((val & mask) == value) 23 return true; 24 cpu_relax(); 25 udelay(10); 26 } while (!time_after_eq(jiffies, deadline)); 27 28 bcma_err(bus, "Timeout waiting for register %p\n", addr); 29 30 return false; 31 } 32 33 void bcma_chipco_b_mii_write(struct bcma_drv_cc_b *ccb, u32 offset, u32 value) 34 { 35 struct bcma_bus *bus = ccb->core->bus; 36 void __iomem *mii = ccb->mii; 37 38 writel(offset, mii + BCMA_CCB_MII_MNG_CTL); 39 bcma_wait_reg(bus, mii + BCMA_CCB_MII_MNG_CTL, 0x0100, 0x0000, 100); 40 writel(value, mii + BCMA_CCB_MII_MNG_CMD_DATA); 41 bcma_wait_reg(bus, mii + BCMA_CCB_MII_MNG_CTL, 0x0100, 0x0000, 100); 42 } 43 EXPORT_SYMBOL_GPL(bcma_chipco_b_mii_write); 44 45 int bcma_core_chipcommon_b_init(struct bcma_drv_cc_b *ccb) 46 { 47 if (ccb->setup_done) 48 return 0; 49 50 ccb->setup_done = 1; 51 ccb->mii = ioremap(ccb->core->addr_s[1], BCMA_CORE_SIZE); 52 if (!ccb->mii) 53 return -ENOMEM; 54 55 return 0; 56 } 57 58 void bcma_core_chipcommon_b_free(struct bcma_drv_cc_b *ccb) 59 { 60 if (ccb->mii) 61 iounmap(ccb->mii); 62 } 63