blkcg: fix blkg_alloc() failure path
[linux-2.6.git] / drivers / bcma / core.c
blobbc6e89212ad3813d901745dce2d31f1ff2f13977
1 /*
2 * Broadcom specific AMBA
3 * Core ops
5 * Licensed under the GNU/GPL. See COPYING for details.
6 */
8 #include "bcma_private.h"
9 #include <linux/export.h>
10 #include <linux/bcma/bcma.h>
12 bool bcma_core_is_enabled(struct bcma_device *core)
14 if ((bcma_aread32(core, BCMA_IOCTL) & (BCMA_IOCTL_CLK | BCMA_IOCTL_FGC))
15 != BCMA_IOCTL_CLK)
16 return false;
17 if (bcma_aread32(core, BCMA_RESET_CTL) & BCMA_RESET_CTL_RESET)
18 return false;
19 return true;
21 EXPORT_SYMBOL_GPL(bcma_core_is_enabled);
23 void bcma_core_disable(struct bcma_device *core, u32 flags)
25 if (bcma_aread32(core, BCMA_RESET_CTL) & BCMA_RESET_CTL_RESET)
26 return;
28 bcma_awrite32(core, BCMA_IOCTL, flags);
29 bcma_aread32(core, BCMA_IOCTL);
30 udelay(10);
32 bcma_awrite32(core, BCMA_RESET_CTL, BCMA_RESET_CTL_RESET);
33 bcma_aread32(core, BCMA_RESET_CTL);
34 udelay(1);
36 EXPORT_SYMBOL_GPL(bcma_core_disable);
38 int bcma_core_enable(struct bcma_device *core, u32 flags)
40 bcma_core_disable(core, flags);
42 bcma_awrite32(core, BCMA_IOCTL, (BCMA_IOCTL_CLK | BCMA_IOCTL_FGC | flags));
43 bcma_aread32(core, BCMA_IOCTL);
45 bcma_awrite32(core, BCMA_RESET_CTL, 0);
46 udelay(1);
48 bcma_awrite32(core, BCMA_IOCTL, (BCMA_IOCTL_CLK | flags));
49 bcma_aread32(core, BCMA_IOCTL);
50 udelay(1);
52 return 0;
54 EXPORT_SYMBOL_GPL(bcma_core_enable);
56 void bcma_core_set_clockmode(struct bcma_device *core,
57 enum bcma_clkmode clkmode)
59 u16 i;
61 WARN_ON(core->id.id != BCMA_CORE_CHIPCOMMON &&
62 core->id.id != BCMA_CORE_PCIE &&
63 core->id.id != BCMA_CORE_80211);
65 switch (clkmode) {
66 case BCMA_CLKMODE_FAST:
67 bcma_set32(core, BCMA_CLKCTLST, BCMA_CLKCTLST_FORCEHT);
68 udelay(64);
69 for (i = 0; i < 1500; i++) {
70 if (bcma_read32(core, BCMA_CLKCTLST) &
71 BCMA_CLKCTLST_HAVEHT) {
72 i = 0;
73 break;
75 udelay(10);
77 if (i)
78 pr_err("HT force timeout\n");
79 break;
80 case BCMA_CLKMODE_DYNAMIC:
81 bcma_set32(core, BCMA_CLKCTLST, ~BCMA_CLKCTLST_FORCEHT);
82 break;
85 EXPORT_SYMBOL_GPL(bcma_core_set_clockmode);
87 void bcma_core_pll_ctl(struct bcma_device *core, u32 req, u32 status, bool on)
89 u16 i;
91 WARN_ON(req & ~BCMA_CLKCTLST_EXTRESREQ);
92 WARN_ON(status & ~BCMA_CLKCTLST_EXTRESST);
94 if (on) {
95 bcma_set32(core, BCMA_CLKCTLST, req);
96 for (i = 0; i < 10000; i++) {
97 if ((bcma_read32(core, BCMA_CLKCTLST) & status) ==
98 status) {
99 i = 0;
100 break;
102 udelay(10);
104 if (i)
105 pr_err("PLL enable timeout\n");
106 } else {
107 pr_warn("Disabling PLL not supported yet!\n");
110 EXPORT_SYMBOL_GPL(bcma_core_pll_ctl);
112 u32 bcma_core_dma_translation(struct bcma_device *core)
114 switch (core->bus->hosttype) {
115 case BCMA_HOSTTYPE_SOC:
116 return 0;
117 case BCMA_HOSTTYPE_PCI:
118 if (bcma_aread32(core, BCMA_IOST) & BCMA_IOST_DMA64)
119 return BCMA_DMA_TRANSLATION_DMA64_CMT;
120 else
121 return BCMA_DMA_TRANSLATION_DMA32_CMT;
122 default:
123 pr_err("DMA translation unknown for host %d\n",
124 core->bus->hosttype);
126 return BCMA_DMA_TRANSLATION_NONE;
128 EXPORT_SYMBOL(bcma_core_dma_translation);