LXR linux/drivers/bcma/driver_chipcommon

   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
  14static 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
  33void 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}
  42EXPORT_SYMBOL_GPL(bcma_chipco_b_mii_write);
  43
  44int 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
  57void bcma_core_chipcommon_b_free(struct bcma_drv_cc_b *ccb)
  58{
  59        if (ccb->mii)
  60                iounmap(ccb->mii);
  61}
  62