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