projects / linux-2.6-block.git / blame
| Commit | Line | Data |
|---|---|---|
| 1716bcf3 HM |
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 | ||
| 37 | writel(offset, ccb->mii + 0x00); | |
| 38 | bcma_wait_reg(bus, ccb->mii + 0x00, 0x0100, 0x0000, 100); | |
| 39 | writel(value, ccb->mii + 0x04); | |
| 40 | bcma_wait_reg(bus, ccb->mii + 0x00, 0x0100, 0x0000, 100); | |
| 41 | } | |
| 42 | EXPORT_SYMBOL_GPL(bcma_chipco_b_mii_write); | |
| 43 | ||
| 44 | int bcma_core_chipcommon_b_init(struct bcma_drv_cc_b *ccb) | |
| 45 | { | |
| 46 | if (ccb->setup_done) | |
| 47 | return 0; | |
| 48 | ||
| 49 | ccb->setup_done = 1; | |
| 50 | ccb->mii = ioremap_nocache(ccb->core->addr_s[1], BCMA_CORE_SIZE); | |
| 51 | if (!ccb->mii) | |
| 52 | return -ENOMEM; | |
| 53 | ||
| 54 | return 0; | |
| 55 | } | |
| 56 | ||
| 57 | void bcma_core_chipcommon_b_free(struct bcma_drv_cc_b *ccb) | |
| 58 | { | |
| 59 | if (ccb->mii) | |
| 60 | iounmap(ccb->mii); | |
| 61 | } |