1/*
2 * WHCI UWB Multi-interface Controller enumerator.
3 *
4 * Copyright (C) 2007 Cambridge Silicon Radio Ltd.
5 *
6 * This file is released under the GNU GPL v2.
7 */
8#include <linux/delay.h>
9#include <linux/kernel.h>
10#include <linux/module.h>
11#include <linux/pci.h>
12#include <linux/dma-mapping.h>
13#include <linux/slab.h>
14#include <linux/uwb/whci.h>
15#include <linux/uwb/umc.h>
16
17struct whci_card {
18	struct pci_dev *pci;
19	void __iomem *uwbbase;
20	u8 n_caps;
21	struct umc_dev *devs[0];
22};
23
24
25/* Fix faulty HW :( */
26static
27u64 whci_capdata_quirks(struct whci_card *card, u64 capdata)
28{
29	u64 capdata_orig = capdata;
30	struct pci_dev *pci_dev = card->pci;
31	if (pci_dev->vendor == PCI_VENDOR_ID_INTEL
32	    && (pci_dev->device == 0x0c3b || pci_dev->device == 0004)
33	    && pci_dev->class == 0x0d1010) {
34		switch (UWBCAPDATA_TO_CAP_ID(capdata)) {
35			/* WLP capability has 0x100 bytes of aperture */
36		case 0x80:
37			capdata |= 0x40 << 8; break;
38			/* WUSB capability has 0x80 bytes of aperture
39			 * and ID is 1 */
40		case 0x02:
41			capdata &= ~0xffff;
42			capdata |= 0x2001;
43			break;
44		}
45	}
46	if (capdata_orig != capdata)
47		dev_warn(&pci_dev->dev,
48			 "PCI v%04x d%04x c%06x#%02x: "
49			 "corrected capdata from %016Lx to %016Lx\n",
50			 pci_dev->vendor, pci_dev->device, pci_dev->class,
51			 (unsigned)UWBCAPDATA_TO_CAP_ID(capdata),
52			 (unsigned long long)capdata_orig,
53			 (unsigned long long)capdata);
54	return capdata;
55}
56
57
58/**
59 * whci_wait_for - wait for a WHCI register to be set
60 *
61 * Polls (for at most @max_ms ms) until '*@reg & @mask == @result'.
62 */
63int whci_wait_for(struct device *dev, u32 __iomem *reg, u32 mask, u32 result,
64	unsigned long max_ms, const char *tag)
65{
66	unsigned t = 0;
67	u32 val;
68	for (;;) {
69		val = le_readl(reg);
70		if ((val & mask) == result)
71			break;
72		if (t >= max_ms) {
73			dev_err(dev, "%s timed out\n", tag);
74			return -ETIMEDOUT;
75		}
76		msleep(10);
77		t += 10;
78	}
79	return 0;
80}
81EXPORT_SYMBOL_GPL(whci_wait_for);
82
83
84/*
85 * NOTE: the capinfo and capdata registers are slightly different
86 *       (size and cap-id fields). So for cap #0, we need to fill
87 *       in. Size comes from the size of the register block
88 *       (statically calculated); cap_id comes from nowhere, we use
89 *       zero, that is reserved, for the radio controller, because
90 *       none was defined at the spec level.
91 */
92static int whci_add_cap(struct whci_card *card, int n)
93{
94	struct umc_dev *umc;
95	u64 capdata;
96	int bar, err;
97
98	umc = umc_device_create(&card->pci->dev, n);
99	if (umc == NULL)
100		return -ENOMEM;
101
102	capdata = le_readq(card->uwbbase + UWBCAPDATA(n));
103
104	bar = UWBCAPDATA_TO_BAR(capdata) << 1;
105
106	capdata = whci_capdata_quirks(card, capdata);
107	/* Capability 0 is the radio controller. It's size is 32
108	 * bytes (WHCI0.95[2.3, T2-9]). */
109	umc->version         = UWBCAPDATA_TO_VERSION(capdata);
110	umc->cap_id          = n == 0 ? 0 : UWBCAPDATA_TO_CAP_ID(capdata);
111	umc->bar	     = bar;
112	umc->resource.start  = pci_resource_start(card->pci, bar)
113		+ UWBCAPDATA_TO_OFFSET(capdata);
114	umc->resource.end    = umc->resource.start
115		+ (n == 0 ? 0x20 : UWBCAPDATA_TO_SIZE(capdata)) - 1;
116	umc->resource.name   = dev_name(&umc->dev);
117	umc->resource.flags  = card->pci->resource[bar].flags;
118	umc->resource.parent = &card->pci->resource[bar];
119	umc->irq             = card->pci->irq;
120
121	err = umc_device_register(umc);
122	if (err < 0)
123		goto error;
124	card->devs[n] = umc;
125	return 0;
126
127error:
128	kfree(umc);
129	return err;
130}
131
132static void whci_del_cap(struct whci_card *card, int n)
133{
134	struct umc_dev *umc = card->devs[n];
135
136	if (umc != NULL)
137		umc_device_unregister(umc);
138}
139
140static int whci_n_caps(struct pci_dev *pci)
141{
142	void __iomem *uwbbase;
143	u64 capinfo;
144
145	uwbbase = pci_iomap(pci, 0, 8);
146	if (!uwbbase)
147		return -ENOMEM;
148	capinfo = le_readq(uwbbase + UWBCAPINFO);
149	pci_iounmap(pci, uwbbase);
150
151	return UWBCAPINFO_TO_N_CAPS(capinfo);
152}
153
154static int whci_probe(struct pci_dev *pci, const struct pci_device_id *id)
155{
156	struct whci_card *card;
157	int err, n_caps, n;
158
159	err = pci_enable_device(pci);
160	if (err < 0)
161		goto error;
162	pci_enable_msi(pci);
163	pci_set_master(pci);
164	err = -ENXIO;
165	if (!pci_set_dma_mask(pci, DMA_BIT_MASK(64)))
166		pci_set_consistent_dma_mask(pci, DMA_BIT_MASK(64));
167	else if (!pci_set_dma_mask(pci, DMA_BIT_MASK(32)))
168		pci_set_consistent_dma_mask(pci, DMA_BIT_MASK(32));
169	else
170		goto error_dma;
171
172	err = n_caps = whci_n_caps(pci);
173	if (n_caps < 0)
174		goto error_ncaps;
175
176	err = -ENOMEM;
177	card = kzalloc(sizeof(struct whci_card)
178		       + sizeof(struct whci_dev *) * (n_caps + 1),
179		       GFP_KERNEL);
180	if (card == NULL)
181		goto error_kzalloc;
182	card->pci = pci;
183	card->n_caps = n_caps;
184
185	err = -EBUSY;
186	if (!request_mem_region(pci_resource_start(pci, 0),
187				UWBCAPDATA_SIZE(card->n_caps),
188				"whci (capability data)"))
189		goto error_request_memregion;
190	err = -ENOMEM;
191	card->uwbbase = pci_iomap(pci, 0, UWBCAPDATA_SIZE(card->n_caps));
192	if (!card->uwbbase)
193		goto error_iomap;
194
195	/* Add each capability. */
196	for (n = 0; n <= card->n_caps; n++) {
197		err = whci_add_cap(card, n);
198		if (err < 0 && n == 0) {
199			dev_err(&pci->dev, "cannot bind UWB radio controller:"
200				" %d\n", err);
201			goto error_bind;
202		}
203		if (err < 0)
204			dev_warn(&pci->dev, "warning: cannot bind capability "
205				 "#%u: %d\n", n, err);
206	}
207	pci_set_drvdata(pci, card);
208	return 0;
209
210error_bind:
211	pci_iounmap(pci, card->uwbbase);
212error_iomap:
213	release_mem_region(pci_resource_start(pci, 0), UWBCAPDATA_SIZE(card->n_caps));
214error_request_memregion:
215	kfree(card);
216error_kzalloc:
217error_ncaps:
218error_dma:
219	pci_disable_msi(pci);
220	pci_disable_device(pci);
221error:
222	return err;
223}
224
225static void whci_remove(struct pci_dev *pci)
226{
227	struct whci_card *card = pci_get_drvdata(pci);
228	int n;
229
230	pci_set_drvdata(pci, NULL);
231	/* Unregister each capability in reverse (so the master device
232	 * is unregistered last). */
233	for (n = card->n_caps; n >= 0 ; n--)
234		whci_del_cap(card, n);
235	pci_iounmap(pci, card->uwbbase);
236	release_mem_region(pci_resource_start(pci, 0), UWBCAPDATA_SIZE(card->n_caps));
237	kfree(card);
238	pci_disable_msi(pci);
239	pci_disable_device(pci);
240}
241
242static struct pci_device_id whci_id_table[] = {
243	{ PCI_DEVICE_CLASS(PCI_CLASS_WIRELESS_WHCI, ~0) },
244	{ 0 },
245};
246MODULE_DEVICE_TABLE(pci, whci_id_table);
247
248
249static struct pci_driver whci_driver = {
250	.name     = "whci",
251	.id_table = whci_id_table,
252	.probe    = whci_probe,
253	.remove   = whci_remove,
254};
255
256static int __init whci_init(void)
257{
258	return pci_register_driver(&whci_driver);
259}
260
261static void __exit whci_exit(void)
262{
263	pci_unregister_driver(&whci_driver);
264}
265
266module_init(whci_init);
267module_exit(whci_exit);
268
269MODULE_DESCRIPTION("WHCI UWB Multi-interface Controller enumerator");
270MODULE_AUTHOR("Cambridge Silicon Radio Ltd.");
271MODULE_LICENSE("GPL");
272