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