Add the rt linux 4.1.3-rt3 as base

[kvmfornfv.git] / kernel / drivers / bcma / driver_chipcommon_b.c

diff --git a/kernel/drivers/bcma/driver_chipcommon_b.c b/kernel/drivers/bcma/driver_chipcommon_b.c
new file mode 100644 (file)
index 0000000..c20b5f4
--- /dev/null
+++ b/kernel/drivers/bcma/driver_chipcommon_b.c
@@ -0,0 +1,61 @@
+/*
+ * Broadcom specific AMBA
+ * ChipCommon B Unit driver
+ *
+ * Copyright 2014, Hauke Mehrtens <hauke@hauke-m.de>
+ *
+ * Licensed under the GNU/GPL. See COPYING for details.
+ */
+
+#include "bcma_private.h"
+#include <linux/export.h>
+#include <linux/bcma/bcma.h>
+
+static bool bcma_wait_reg(struct bcma_bus *bus, void __iomem *addr, u32 mask,
+                         u32 value, int timeout)
+{
+       unsigned long deadline = jiffies + timeout;
+       u32 val;
+
+       do {
+               val = readl(addr);
+               if ((val & mask) == value)
+                       return true;
+               cpu_relax();
+               udelay(10);
+       } while (!time_after_eq(jiffies, deadline));
+
+       bcma_err(bus, "Timeout waiting for register %p\n", addr);
+
+       return false;
+}
+
+void bcma_chipco_b_mii_write(struct bcma_drv_cc_b *ccb, u32 offset, u32 value)
+{
+       struct bcma_bus *bus = ccb->core->bus;
+
+       writel(offset, ccb->mii + 0x00);
+       bcma_wait_reg(bus, ccb->mii + 0x00, 0x0100, 0x0000, 100);
+       writel(value, ccb->mii + 0x04);
+       bcma_wait_reg(bus, ccb->mii + 0x00, 0x0100, 0x0000, 100);
+}
+EXPORT_SYMBOL_GPL(bcma_chipco_b_mii_write);
+
+int bcma_core_chipcommon_b_init(struct bcma_drv_cc_b *ccb)
+{
+       if (ccb->setup_done)
+               return 0;
+
+       ccb->setup_done = 1;
+       ccb->mii = ioremap_nocache(ccb->core->addr_s[1], BCMA_CORE_SIZE);
+       if (!ccb->mii)
+               return -ENOMEM;
+
+       return 0;
+}
+
+void bcma_core_chipcommon_b_free(struct bcma_drv_cc_b *ccb)
+{
+       if (ccb->mii)
+               iounmap(ccb->mii);
+}