[mirror_ubuntu-artful-kernel.git] / drivers / uwb / whci.c

/*
 * WHCI UWB Multi-interface Controller enumerator.
 *
 * Copyright (C) 2007 Cambridge Silicon Radio Ltd.
 *
 * This file is released under the GNU GPL v2.
 */
#include <linux/delay.h>
#include <linux/kernel.h>
#include <linux/pci.h>
#include <linux/dma-mapping.h>
#include <linux/slab.h>
#include <linux/uwb/whci.h>
#include <linux/uwb/umc.h>

struct whci_card {
	struct pci_dev *pci;
	void __iomem *uwbbase;
	u8 n_caps;
	struct umc_dev *devs[0];
};


/* Fix faulty HW :( */
static
u64 whci_capdata_quirks(struct whci_card *card, u64 capdata)
{
	u64 capdata_orig = capdata;
	struct pci_dev *pci_dev = card->pci;
	if (pci_dev->vendor == PCI_VENDOR_ID_INTEL
	    && (pci_dev->device == 0x0c3b || pci_dev->device == 0004)
	    && pci_dev->class == 0x0d1010) {
		switch (UWBCAPDATA_TO_CAP_ID(capdata)) {
			/* WLP capability has 0x100 bytes of aperture */
		case 0x80:
			capdata |= 0x40 << 8; break;
			/* WUSB capability has 0x80 bytes of aperture
			 * and ID is 1 */
		case 0x02:
			capdata &= ~0xffff;
			capdata |= 0x2001;
			break;
		}
	}
	if (capdata_orig != capdata)
		dev_warn(&pci_dev->dev,
			 "PCI v%04x d%04x c%06x#%02x: "
			 "corrected capdata from %016Lx to %016Lx\n",
			 pci_dev->vendor, pci_dev->device, pci_dev->class,
			 (unsigned)UWBCAPDATA_TO_CAP_ID(capdata),
			 (unsigned long long)capdata_orig,
			 (unsigned long long)capdata);
	return capdata;
}


/**
 * whci_wait_for - wait for a WHCI register to be set
 *
 * Polls (for at most @max_ms ms) until '*@reg & @mask == @result'.
 */
int whci_wait_for(struct device *dev, u32 __iomem *reg, u32 mask, u32 result,
	unsigned long max_ms, const char *tag)
{
	unsigned t = 0;
	u32 val;
	for (;;) {
		val = le_readl(reg);
		if ((val & mask) == result)
			break;
		if (t >= max_ms) {
			dev_err(dev, "%s timed out\n", tag);
			return -ETIMEDOUT;
		}
		msleep(10);
		t += 10;
	}
	return 0;
}
EXPORT_SYMBOL_GPL(whci_wait_for);


/*
 * NOTE: the capinfo and capdata registers are slightly different
 *       (size and cap-id fields). So for cap #0, we need to fill
 *       in. Size comes from the size of the register block
 *       (statically calculated); cap_id comes from nowhere, we use
 *       zero, that is reserved, for the radio controller, because
 *       none was defined at the spec level.
 */
static int whci_add_cap(struct whci_card *card, int n)
{
	struct umc_dev *umc;
	u64 capdata;
	int bar, err;

	umc = umc_device_create(&card->pci->dev, n);
	if (umc == NULL)
		return -ENOMEM;

	capdata = le_readq(card->uwbbase + UWBCAPDATA(n));

	bar = UWBCAPDATA_TO_BAR(capdata) << 1;

	capdata = whci_capdata_quirks(card, capdata);
	/* Capability 0 is the radio controller. It's size is 32
	 * bytes (WHCI0.95[2.3, T2-9]). */
	umc->version         = UWBCAPDATA_TO_VERSION(capdata);
	umc->cap_id          = n == 0 ? 0 : UWBCAPDATA_TO_CAP_ID(capdata);
	umc->bar	     = bar;
	umc->resource.start  = pci_resource_start(card->pci, bar)
		+ UWBCAPDATA_TO_OFFSET(capdata);
	umc->resource.end    = umc->resource.start
		+ (n == 0 ? 0x20 : UWBCAPDATA_TO_SIZE(capdata)) - 1;
	umc->resource.name   = dev_name(&umc->dev);
	umc->resource.flags  = card->pci->resource[bar].flags;
	umc->resource.parent = &card->pci->resource[bar];
	umc->irq             = card->pci->irq;

	err = umc_device_register(umc);
	if (err < 0)
		goto error;
	card->devs[n] = umc;
	return 0;

error:
	kfree(umc);
	return err;
}

static void whci_del_cap(struct whci_card *card, int n)
{
	struct umc_dev *umc = card->devs[n];

	if (umc != NULL)
		umc_device_unregister(umc);
}

static int whci_n_caps(struct pci_dev *pci)
{
	void __iomem *uwbbase;
	u64 capinfo;

	uwbbase = pci_iomap(pci, 0, 8);
	if (!uwbbase)
		return -ENOMEM;
	capinfo = le_readq(uwbbase + UWBCAPINFO);
	pci_iounmap(pci, uwbbase);

	return UWBCAPINFO_TO_N_CAPS(capinfo);
}

static int whci_probe(struct pci_dev *pci, const struct pci_device_id *id)
{
	struct whci_card *card;
	int err, n_caps, n;

	err = pci_enable_device(pci);
	if (err < 0)
		goto error;
	pci_enable_msi(pci);
	pci_set_master(pci);
	err = -ENXIO;
	if (!pci_set_dma_mask(pci, DMA_BIT_MASK(64)))
		pci_set_consistent_dma_mask(pci, DMA_BIT_MASK(64));
	else if (!pci_set_dma_mask(pci, DMA_BIT_MASK(32)))
		pci_set_consistent_dma_mask(pci, DMA_BIT_MASK(32));
	else
		goto error_dma;

	err = n_caps = whci_n_caps(pci);
	if (n_caps < 0)
		goto error_ncaps;

	err = -ENOMEM;
	card = kzalloc(sizeof(struct whci_card)
		       + sizeof(struct whci_dev *) * (n_caps + 1),
		       GFP_KERNEL);
	if (card == NULL)
		goto error_kzalloc;
	card->pci = pci;
	card->n_caps = n_caps;

	err = -EBUSY;
	if (!request_mem_region(pci_resource_start(pci, 0),
				UWBCAPDATA_SIZE(card->n_caps),
				"whci (capability data)"))
		goto error_request_memregion;
	err = -ENOMEM;
	card->uwbbase = pci_iomap(pci, 0, UWBCAPDATA_SIZE(card->n_caps));
	if (!card->uwbbase)
		goto error_iomap;

	/* Add each capability. */
	for (n = 0; n <= card->n_caps; n++) {
		err = whci_add_cap(card, n);
		if (err < 0 && n == 0) {
			dev_err(&pci->dev, "cannot bind UWB radio controller:"
				" %d\n", err);
			goto error_bind;
		}
		if (err < 0)
			dev_warn(&pci->dev, "warning: cannot bind capability "
				 "#%u: %d\n", n, err);
	}
	pci_set_drvdata(pci, card);
	return 0;

error_bind:
	pci_iounmap(pci, card->uwbbase);
error_iomap:
	release_mem_region(pci_resource_start(pci, 0), UWBCAPDATA_SIZE(card->n_caps));
error_request_memregion:
	kfree(card);
error_kzalloc:
error_ncaps:
error_dma:
	pci_disable_msi(pci);
	pci_disable_device(pci);
error:
	return err;
}

static void whci_remove(struct pci_dev *pci)
{
	struct whci_card *card = pci_get_drvdata(pci);
	int n;

	pci_set_drvdata(pci, NULL);
	/* Unregister each capability in reverse (so the master device
	 * is unregistered last). */
	for (n = card->n_caps; n >= 0 ; n--)
		whci_del_cap(card, n);
	pci_iounmap(pci, card->uwbbase);
	release_mem_region(pci_resource_start(pci, 0), UWBCAPDATA_SIZE(card->n_caps));
	kfree(card);
	pci_disable_msi(pci);
	pci_disable_device(pci);
}

static struct pci_device_id whci_id_table[] = {
	{ PCI_DEVICE_CLASS(PCI_CLASS_WIRELESS_WHCI, ~0) },
	{ 0 },
};
MODULE_DEVICE_TABLE(pci, whci_id_table);


static struct pci_driver whci_driver = {
	.name     = "whci",
	.id_table = whci_id_table,
	.probe    = whci_probe,
	.remove   = whci_remove,
};

static int __init whci_init(void)
{
	return pci_register_driver(&whci_driver);
}

static void __exit whci_exit(void)
{
	pci_unregister_driver(&whci_driver);
}

module_init(whci_init);
module_exit(whci_exit);

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