xref: /openbmc/linux/drivers/uio/uio_fsl_elbc_gpcm.c (revision 7ae9fb1b7ecbb5d85d07857943f677fd1a559b18)
1bce5c2eaSStephen Hemminger // SPDX-License-Identifier: GPL-2.0
2fbc4a8a8SJohn Ogness /* uio_fsl_elbc_gpcm: UIO driver for eLBC/GPCM peripherals
3fbc4a8a8SJohn Ogness 
4fbc4a8a8SJohn Ogness    Copyright (C) 2014 Linutronix GmbH
5fbc4a8a8SJohn Ogness      Author: John Ogness <john.ogness@linutronix.de>
6fbc4a8a8SJohn Ogness 
7fbc4a8a8SJohn Ogness    This driver provides UIO access to memory of a peripheral connected
8fbc4a8a8SJohn Ogness    to the Freescale enhanced local bus controller (eLBC) interface
9fbc4a8a8SJohn Ogness    using the general purpose chip-select mode (GPCM).
10fbc4a8a8SJohn Ogness 
11fbc4a8a8SJohn Ogness    Here is an example of the device tree entries:
12fbc4a8a8SJohn Ogness 
13fbc4a8a8SJohn Ogness 	localbus@ffe05000 {
14fbc4a8a8SJohn Ogness 		ranges = <0x2 0x0 0x0 0xff810000 0x10000>;
15fbc4a8a8SJohn Ogness 
16fbc4a8a8SJohn Ogness 		dpm@2,0 {
17fbc4a8a8SJohn Ogness 			compatible = "fsl,elbc-gpcm-uio";
18fbc4a8a8SJohn Ogness 			reg = <0x2 0x0 0x10000>;
19fbc4a8a8SJohn Ogness 			elbc-gpcm-br = <0xff810800>;
20fbc4a8a8SJohn Ogness 			elbc-gpcm-or = <0xffff09f7>;
21fbc4a8a8SJohn Ogness 			interrupt-parent = <&mpic>;
22fbc4a8a8SJohn Ogness 			interrupts = <4 1>;
23fbc4a8a8SJohn Ogness 			device_type = "netx5152";
24fbc4a8a8SJohn Ogness 			uio_name = "netx_custom";
25fbc4a8a8SJohn Ogness 			netx5152,init-win0-offset = <0x0>;
26fbc4a8a8SJohn Ogness 		};
27fbc4a8a8SJohn Ogness 	};
28fbc4a8a8SJohn Ogness 
29fbc4a8a8SJohn Ogness    Only the entries reg (to identify bank) and elbc-gpcm-* (initial BR/OR
30fbc4a8a8SJohn Ogness    values) are required. The entries interrupt*, device_type, and uio_name
31fbc4a8a8SJohn Ogness    are optional (as well as any type-specific options such as
32fbc4a8a8SJohn Ogness    netx5152,init-win0-offset). As long as no interrupt handler is needed,
33fbc4a8a8SJohn Ogness    this driver can be used without any type-specific implementation.
34fbc4a8a8SJohn Ogness 
35fbc4a8a8SJohn Ogness    The netx5152 type has been tested to work with the netX 51/52 hardware
36fbc4a8a8SJohn Ogness    from Hilscher using the Hilscher userspace netX stack.
37fbc4a8a8SJohn Ogness 
38fbc4a8a8SJohn Ogness    The netx5152 type should serve as a model to add new type-specific
39fbc4a8a8SJohn Ogness    devices as needed.
40fbc4a8a8SJohn Ogness */
41fbc4a8a8SJohn Ogness 
42fbc4a8a8SJohn Ogness #include <linux/module.h>
43fbc4a8a8SJohn Ogness #include <linux/device.h>
44fbc4a8a8SJohn Ogness #include <linux/string.h>
45fbc4a8a8SJohn Ogness #include <linux/slab.h>
46fbc4a8a8SJohn Ogness #include <linux/platform_device.h>
47fbc4a8a8SJohn Ogness #include <linux/uio_driver.h>
48fbc4a8a8SJohn Ogness #include <linux/of_address.h>
49fbc4a8a8SJohn Ogness #include <linux/of_irq.h>
50fbc4a8a8SJohn Ogness 
51fbc4a8a8SJohn Ogness #include <asm/fsl_lbc.h>
52fbc4a8a8SJohn Ogness 
53fbc4a8a8SJohn Ogness #define MAX_BANKS 8
54fbc4a8a8SJohn Ogness 
55fbc4a8a8SJohn Ogness struct fsl_elbc_gpcm {
56fbc4a8a8SJohn Ogness 	struct device *dev;
57fbc4a8a8SJohn Ogness 	struct fsl_lbc_regs __iomem *lbc;
58fbc4a8a8SJohn Ogness 	u32 bank;
59fbc4a8a8SJohn Ogness 	const char *name;
60fbc4a8a8SJohn Ogness 
61fbc4a8a8SJohn Ogness 	void (*init)(struct uio_info *info);
62fbc4a8a8SJohn Ogness 	void (*shutdown)(struct uio_info *info, bool init_err);
63fbc4a8a8SJohn Ogness 	irqreturn_t (*irq_handler)(int irq, struct uio_info *info);
64fbc4a8a8SJohn Ogness };
65fbc4a8a8SJohn Ogness 
66fbc4a8a8SJohn Ogness static ssize_t reg_show(struct device *dev, struct device_attribute *attr,
67fbc4a8a8SJohn Ogness 			char *buf);
68fbc4a8a8SJohn Ogness static ssize_t reg_store(struct device *dev, struct device_attribute *attr,
69fbc4a8a8SJohn Ogness 			 const char *buf, size_t count);
70fbc4a8a8SJohn Ogness 
7119f8d67fSYueHaibing static DEVICE_ATTR(reg_br, 0664, reg_show, reg_store);
7219f8d67fSYueHaibing static DEVICE_ATTR(reg_or, 0664, reg_show, reg_store);
73fbc4a8a8SJohn Ogness 
740682e005SGreg Kroah-Hartman static struct attribute *uio_fsl_elbc_gpcm_attrs[] = {
750682e005SGreg Kroah-Hartman 	&dev_attr_reg_br.attr,
760682e005SGreg Kroah-Hartman 	&dev_attr_reg_or.attr,
770682e005SGreg Kroah-Hartman 	NULL,
780682e005SGreg Kroah-Hartman };
790682e005SGreg Kroah-Hartman ATTRIBUTE_GROUPS(uio_fsl_elbc_gpcm);
800682e005SGreg Kroah-Hartman 
reg_show(struct device * dev,struct device_attribute * attr,char * buf)81fbc4a8a8SJohn Ogness static ssize_t reg_show(struct device *dev, struct device_attribute *attr,
82fbc4a8a8SJohn Ogness 			char *buf)
83fbc4a8a8SJohn Ogness {
8424438e46SWolfram Sang 	struct uio_info *info = dev_get_drvdata(dev);
85fbc4a8a8SJohn Ogness 	struct fsl_elbc_gpcm *priv = info->priv;
86fbc4a8a8SJohn Ogness 	struct fsl_lbc_bank *bank = &priv->lbc->bank[priv->bank];
87fbc4a8a8SJohn Ogness 
88fbc4a8a8SJohn Ogness 	if (attr == &dev_attr_reg_br) {
89fbc4a8a8SJohn Ogness 		return scnprintf(buf, PAGE_SIZE, "0x%08x\n",
90fbc4a8a8SJohn Ogness 				 in_be32(&bank->br));
91fbc4a8a8SJohn Ogness 
92fbc4a8a8SJohn Ogness 	} else if (attr == &dev_attr_reg_or) {
93fbc4a8a8SJohn Ogness 		return scnprintf(buf, PAGE_SIZE, "0x%08x\n",
94fbc4a8a8SJohn Ogness 				 in_be32(&bank->or));
95fbc4a8a8SJohn Ogness 	}
96fbc4a8a8SJohn Ogness 
97fbc4a8a8SJohn Ogness 	return 0;
98fbc4a8a8SJohn Ogness }
99fbc4a8a8SJohn Ogness 
reg_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)100fbc4a8a8SJohn Ogness static ssize_t reg_store(struct device *dev, struct device_attribute *attr,
101fbc4a8a8SJohn Ogness 			 const char *buf, size_t count)
102fbc4a8a8SJohn Ogness {
10324438e46SWolfram Sang 	struct uio_info *info = dev_get_drvdata(dev);
104fbc4a8a8SJohn Ogness 	struct fsl_elbc_gpcm *priv = info->priv;
105fbc4a8a8SJohn Ogness 	struct fsl_lbc_bank *bank = &priv->lbc->bank[priv->bank];
106fbc4a8a8SJohn Ogness 	unsigned long val;
107fbc4a8a8SJohn Ogness 	u32 reg_br_cur;
108fbc4a8a8SJohn Ogness 	u32 reg_or_cur;
109fbc4a8a8SJohn Ogness 	u32 reg_new;
110fbc4a8a8SJohn Ogness 
111fbc4a8a8SJohn Ogness 	/* parse use input */
112fbc4a8a8SJohn Ogness 	if (kstrtoul(buf, 0, &val) != 0)
113fbc4a8a8SJohn Ogness 		return -EINVAL;
114fbc4a8a8SJohn Ogness 	reg_new = (u32)val;
115fbc4a8a8SJohn Ogness 
116fbc4a8a8SJohn Ogness 	/* read current values */
117fbc4a8a8SJohn Ogness 	reg_br_cur = in_be32(&bank->br);
118fbc4a8a8SJohn Ogness 	reg_or_cur = in_be32(&bank->or);
119fbc4a8a8SJohn Ogness 
120fbc4a8a8SJohn Ogness 	if (attr == &dev_attr_reg_br) {
121fbc4a8a8SJohn Ogness 		/* not allowed to change effective base address */
122fbc4a8a8SJohn Ogness 		if ((reg_br_cur & reg_or_cur & BR_BA) !=
123fbc4a8a8SJohn Ogness 		    (reg_new & reg_or_cur & BR_BA)) {
124fbc4a8a8SJohn Ogness 			return -EINVAL;
125fbc4a8a8SJohn Ogness 		}
126fbc4a8a8SJohn Ogness 
127fbc4a8a8SJohn Ogness 		/* not allowed to change mode */
128fbc4a8a8SJohn Ogness 		if ((reg_new & BR_MSEL) != BR_MS_GPCM)
129fbc4a8a8SJohn Ogness 			return -EINVAL;
130fbc4a8a8SJohn Ogness 
131fbc4a8a8SJohn Ogness 		/* write new value (force valid) */
132fbc4a8a8SJohn Ogness 		out_be32(&bank->br, reg_new | BR_V);
133fbc4a8a8SJohn Ogness 
134fbc4a8a8SJohn Ogness 	} else if (attr == &dev_attr_reg_or) {
135fbc4a8a8SJohn Ogness 		/* not allowed to change access mask */
136fbc4a8a8SJohn Ogness 		if ((reg_or_cur & OR_GPCM_AM) != (reg_new & OR_GPCM_AM))
137fbc4a8a8SJohn Ogness 			return -EINVAL;
138fbc4a8a8SJohn Ogness 
139fbc4a8a8SJohn Ogness 		/* write new value */
140fbc4a8a8SJohn Ogness 		out_be32(&bank->or, reg_new);
141fbc4a8a8SJohn Ogness 
142fbc4a8a8SJohn Ogness 	} else {
143fbc4a8a8SJohn Ogness 		return -EINVAL;
144fbc4a8a8SJohn Ogness 	}
145fbc4a8a8SJohn Ogness 
146fbc4a8a8SJohn Ogness 	return count;
147fbc4a8a8SJohn Ogness }
148fbc4a8a8SJohn Ogness 
149fbc4a8a8SJohn Ogness #ifdef CONFIG_UIO_FSL_ELBC_GPCM_NETX5152
150fbc4a8a8SJohn Ogness #define DPM_HOST_WIN0_OFFSET	0xff00
151fbc4a8a8SJohn Ogness #define DPM_HOST_INT_STAT0	0xe0
152fbc4a8a8SJohn Ogness #define DPM_HOST_INT_EN0	0xf0
153fbc4a8a8SJohn Ogness #define DPM_HOST_INT_MASK	0xe600ffff
154fbc4a8a8SJohn Ogness #define DPM_HOST_INT_GLOBAL_EN	0x80000000
155fbc4a8a8SJohn Ogness 
netx5152_irq_handler(int irq,struct uio_info * info)156fbc4a8a8SJohn Ogness static irqreturn_t netx5152_irq_handler(int irq, struct uio_info *info)
157fbc4a8a8SJohn Ogness {
158fbc4a8a8SJohn Ogness 	void __iomem *reg_int_en = info->mem[0].internal_addr +
159fbc4a8a8SJohn Ogness 					DPM_HOST_WIN0_OFFSET +
160fbc4a8a8SJohn Ogness 					DPM_HOST_INT_EN0;
161fbc4a8a8SJohn Ogness 	void __iomem *reg_int_stat = info->mem[0].internal_addr +
162fbc4a8a8SJohn Ogness 					DPM_HOST_WIN0_OFFSET +
163fbc4a8a8SJohn Ogness 					DPM_HOST_INT_STAT0;
164fbc4a8a8SJohn Ogness 
165fbc4a8a8SJohn Ogness 	/* check if an interrupt is enabled and active */
166fbc4a8a8SJohn Ogness 	if ((ioread32(reg_int_en) & ioread32(reg_int_stat) &
167fbc4a8a8SJohn Ogness 	     DPM_HOST_INT_MASK) == 0) {
168fbc4a8a8SJohn Ogness 		return IRQ_NONE;
169fbc4a8a8SJohn Ogness 	}
170fbc4a8a8SJohn Ogness 
171fbc4a8a8SJohn Ogness 	/* disable interrupts */
172fbc4a8a8SJohn Ogness 	iowrite32(ioread32(reg_int_en) & ~DPM_HOST_INT_GLOBAL_EN, reg_int_en);
173fbc4a8a8SJohn Ogness 
174fbc4a8a8SJohn Ogness 	return IRQ_HANDLED;
175fbc4a8a8SJohn Ogness }
176fbc4a8a8SJohn Ogness 
netx5152_init(struct uio_info * info)177fbc4a8a8SJohn Ogness static void netx5152_init(struct uio_info *info)
178fbc4a8a8SJohn Ogness {
179fbc4a8a8SJohn Ogness 	unsigned long win0_offset = DPM_HOST_WIN0_OFFSET;
180fbc4a8a8SJohn Ogness 	struct fsl_elbc_gpcm *priv = info->priv;
181fbc4a8a8SJohn Ogness 	const void *prop;
182fbc4a8a8SJohn Ogness 
183fbc4a8a8SJohn Ogness 	/* get an optional initial win0 offset */
184fbc4a8a8SJohn Ogness 	prop = of_get_property(priv->dev->of_node,
185fbc4a8a8SJohn Ogness 			       "netx5152,init-win0-offset", NULL);
186fbc4a8a8SJohn Ogness 	if (prop)
187fbc4a8a8SJohn Ogness 		win0_offset = of_read_ulong(prop, 1);
188fbc4a8a8SJohn Ogness 
189fbc4a8a8SJohn Ogness 	/* disable interrupts */
190fbc4a8a8SJohn Ogness 	iowrite32(0, info->mem[0].internal_addr + win0_offset +
191fbc4a8a8SJohn Ogness 		     DPM_HOST_INT_EN0);
192fbc4a8a8SJohn Ogness }
193fbc4a8a8SJohn Ogness 
netx5152_shutdown(struct uio_info * info,bool init_err)194fbc4a8a8SJohn Ogness static void netx5152_shutdown(struct uio_info *info, bool init_err)
195fbc4a8a8SJohn Ogness {
196fbc4a8a8SJohn Ogness 	if (init_err)
197fbc4a8a8SJohn Ogness 		return;
198fbc4a8a8SJohn Ogness 
199fbc4a8a8SJohn Ogness 	/* disable interrupts */
200fbc4a8a8SJohn Ogness 	iowrite32(0, info->mem[0].internal_addr + DPM_HOST_WIN0_OFFSET +
201fbc4a8a8SJohn Ogness 		     DPM_HOST_INT_EN0);
202fbc4a8a8SJohn Ogness }
203fbc4a8a8SJohn Ogness #endif
204fbc4a8a8SJohn Ogness 
setup_periph(struct fsl_elbc_gpcm * priv,const char * type)205fbc4a8a8SJohn Ogness static void setup_periph(struct fsl_elbc_gpcm *priv,
206fbc4a8a8SJohn Ogness 				   const char *type)
207fbc4a8a8SJohn Ogness {
208fbc4a8a8SJohn Ogness #ifdef CONFIG_UIO_FSL_ELBC_GPCM_NETX5152
209fbc4a8a8SJohn Ogness 	if (strcmp(type, "netx5152") == 0) {
210fbc4a8a8SJohn Ogness 		priv->irq_handler = netx5152_irq_handler;
211fbc4a8a8SJohn Ogness 		priv->init = netx5152_init;
212fbc4a8a8SJohn Ogness 		priv->shutdown = netx5152_shutdown;
213fbc4a8a8SJohn Ogness 		priv->name = "netX 51/52";
214fbc4a8a8SJohn Ogness 		return;
215fbc4a8a8SJohn Ogness 	}
216fbc4a8a8SJohn Ogness #endif
217fbc4a8a8SJohn Ogness }
218fbc4a8a8SJohn Ogness 
check_of_data(struct fsl_elbc_gpcm * priv,struct resource * res,u32 reg_br,u32 reg_or)219fbc4a8a8SJohn Ogness static int check_of_data(struct fsl_elbc_gpcm *priv,
220fbc4a8a8SJohn Ogness 				   struct resource *res,
221fbc4a8a8SJohn Ogness 				   u32 reg_br, u32 reg_or)
222fbc4a8a8SJohn Ogness {
223fbc4a8a8SJohn Ogness 	/* check specified bank */
224fbc4a8a8SJohn Ogness 	if (priv->bank >= MAX_BANKS) {
225fbc4a8a8SJohn Ogness 		dev_err(priv->dev, "invalid bank\n");
226fbc4a8a8SJohn Ogness 		return -ENODEV;
227fbc4a8a8SJohn Ogness 	}
228fbc4a8a8SJohn Ogness 
229fbc4a8a8SJohn Ogness 	/* check specified mode (BR_MS_GPCM is 0) */
230fbc4a8a8SJohn Ogness 	if ((reg_br & BR_MSEL) != BR_MS_GPCM) {
231fbc4a8a8SJohn Ogness 		dev_err(priv->dev, "unsupported mode\n");
232fbc4a8a8SJohn Ogness 		return -ENODEV;
233fbc4a8a8SJohn Ogness 	}
234fbc4a8a8SJohn Ogness 
235fbc4a8a8SJohn Ogness 	/* check specified mask vs. resource size */
236fbc4a8a8SJohn Ogness 	if ((~(reg_or & OR_GPCM_AM) + 1) != resource_size(res)) {
237fbc4a8a8SJohn Ogness 		dev_err(priv->dev, "address mask / size mismatch\n");
238fbc4a8a8SJohn Ogness 		return -ENODEV;
239fbc4a8a8SJohn Ogness 	}
240fbc4a8a8SJohn Ogness 
241fbc4a8a8SJohn Ogness 	/* check specified address */
242fbc4a8a8SJohn Ogness 	if ((reg_br & reg_or & BR_BA) != fsl_lbc_addr(res->start)) {
243fbc4a8a8SJohn Ogness 		dev_err(priv->dev, "base address mismatch\n");
244fbc4a8a8SJohn Ogness 		return -ENODEV;
245fbc4a8a8SJohn Ogness 	}
246fbc4a8a8SJohn Ogness 
247fbc4a8a8SJohn Ogness 	return 0;
248fbc4a8a8SJohn Ogness }
249fbc4a8a8SJohn Ogness 
get_of_data(struct fsl_elbc_gpcm * priv,struct device_node * node,struct resource * res,u32 * reg_br,u32 * reg_or,unsigned int * irq,char ** name)250fbc4a8a8SJohn Ogness static int get_of_data(struct fsl_elbc_gpcm *priv, struct device_node *node,
251fbc4a8a8SJohn Ogness 		       struct resource *res, u32 *reg_br,
252fbc4a8a8SJohn Ogness 		       u32 *reg_or, unsigned int *irq, char **name)
253fbc4a8a8SJohn Ogness {
254fbc4a8a8SJohn Ogness 	const char *dt_name;
255fbc4a8a8SJohn Ogness 	const char *type;
256fbc4a8a8SJohn Ogness 	int ret;
257fbc4a8a8SJohn Ogness 
258fbc4a8a8SJohn Ogness 	/* get the memory resource */
259fbc4a8a8SJohn Ogness 	ret = of_address_to_resource(node, 0, res);
260fbc4a8a8SJohn Ogness 	if (ret) {
261fbc4a8a8SJohn Ogness 		dev_err(priv->dev, "failed to get resource\n");
262fbc4a8a8SJohn Ogness 		return ret;
263fbc4a8a8SJohn Ogness 	}
264fbc4a8a8SJohn Ogness 
265fbc4a8a8SJohn Ogness 	/* get the bank number */
266fbc4a8a8SJohn Ogness 	ret = of_property_read_u32(node, "reg", &priv->bank);
267fbc4a8a8SJohn Ogness 	if (ret) {
268fbc4a8a8SJohn Ogness 		dev_err(priv->dev, "failed to get bank number\n");
269fbc4a8a8SJohn Ogness 		return ret;
270fbc4a8a8SJohn Ogness 	}
271fbc4a8a8SJohn Ogness 
272fbc4a8a8SJohn Ogness 	/* get BR value to set */
273fbc4a8a8SJohn Ogness 	ret = of_property_read_u32(node, "elbc-gpcm-br", reg_br);
274fbc4a8a8SJohn Ogness 	if (ret) {
275fbc4a8a8SJohn Ogness 		dev_err(priv->dev, "missing elbc-gpcm-br value\n");
276fbc4a8a8SJohn Ogness 		return ret;
277fbc4a8a8SJohn Ogness 	}
278fbc4a8a8SJohn Ogness 
279fbc4a8a8SJohn Ogness 	/* get OR value to set */
280fbc4a8a8SJohn Ogness 	ret = of_property_read_u32(node, "elbc-gpcm-or", reg_or);
281fbc4a8a8SJohn Ogness 	if (ret) {
282fbc4a8a8SJohn Ogness 		dev_err(priv->dev, "missing elbc-gpcm-or value\n");
283fbc4a8a8SJohn Ogness 		return ret;
284fbc4a8a8SJohn Ogness 	}
285fbc4a8a8SJohn Ogness 
286fbc4a8a8SJohn Ogness 	/* get optional peripheral type */
287fbc4a8a8SJohn Ogness 	priv->name = "generic";
288fbc4a8a8SJohn Ogness 	if (of_property_read_string(node, "device_type", &type) == 0)
289fbc4a8a8SJohn Ogness 		setup_periph(priv, type);
290fbc4a8a8SJohn Ogness 
291fbc4a8a8SJohn Ogness 	/* get optional irq value */
292fbc4a8a8SJohn Ogness 	*irq = irq_of_parse_and_map(node, 0);
293fbc4a8a8SJohn Ogness 
294fbc4a8a8SJohn Ogness 	/* sanity check device tree data */
295fbc4a8a8SJohn Ogness 	ret = check_of_data(priv, res, *reg_br, *reg_or);
296fbc4a8a8SJohn Ogness 	if (ret)
297fbc4a8a8SJohn Ogness 		return ret;
298fbc4a8a8SJohn Ogness 
299fbc4a8a8SJohn Ogness 	/* get optional uio name */
300fbc4a8a8SJohn Ogness 	if (of_property_read_string(node, "uio_name", &dt_name) != 0)
301fbc4a8a8SJohn Ogness 		dt_name = "eLBC_GPCM";
302d57801c4SAlexandru Ardelean 	*name = devm_kstrdup(priv->dev, dt_name, GFP_KERNEL);
303fbc4a8a8SJohn Ogness 	if (!*name)
304fbc4a8a8SJohn Ogness 		return -ENOMEM;
305fbc4a8a8SJohn Ogness 
306fbc4a8a8SJohn Ogness 	return 0;
307fbc4a8a8SJohn Ogness }
308fbc4a8a8SJohn Ogness 
uio_fsl_elbc_gpcm_probe(struct platform_device * pdev)309fbc4a8a8SJohn Ogness static int uio_fsl_elbc_gpcm_probe(struct platform_device *pdev)
310fbc4a8a8SJohn Ogness {
311fbc4a8a8SJohn Ogness 	struct device_node *node = pdev->dev.of_node;
312fbc4a8a8SJohn Ogness 	struct fsl_elbc_gpcm *priv;
313fbc4a8a8SJohn Ogness 	struct uio_info *info;
314fbc4a8a8SJohn Ogness 	char *uio_name = NULL;
315fbc4a8a8SJohn Ogness 	struct resource res;
316fbc4a8a8SJohn Ogness 	unsigned int irq;
317fbc4a8a8SJohn Ogness 	u32 reg_br_cur;
318fbc4a8a8SJohn Ogness 	u32 reg_or_cur;
319fbc4a8a8SJohn Ogness 	u32 reg_br_new;
320fbc4a8a8SJohn Ogness 	u32 reg_or_new;
321fbc4a8a8SJohn Ogness 	int ret;
322fbc4a8a8SJohn Ogness 
323fbc4a8a8SJohn Ogness 	if (!fsl_lbc_ctrl_dev || !fsl_lbc_ctrl_dev->regs)
324fbc4a8a8SJohn Ogness 		return -ENODEV;
325fbc4a8a8SJohn Ogness 
326fbc4a8a8SJohn Ogness 	/* allocate private data */
327d57801c4SAlexandru Ardelean 	priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
328fbc4a8a8SJohn Ogness 	if (!priv)
329fbc4a8a8SJohn Ogness 		return -ENOMEM;
330fbc4a8a8SJohn Ogness 	priv->dev = &pdev->dev;
331fbc4a8a8SJohn Ogness 	priv->lbc = fsl_lbc_ctrl_dev->regs;
332fbc4a8a8SJohn Ogness 
333fbc4a8a8SJohn Ogness 	/* get device tree data */
334fbc4a8a8SJohn Ogness 	ret = get_of_data(priv, node, &res, &reg_br_new, &reg_or_new,
335fbc4a8a8SJohn Ogness 			  &irq, &uio_name);
336fbc4a8a8SJohn Ogness 	if (ret)
337d57801c4SAlexandru Ardelean 		return ret;
338fbc4a8a8SJohn Ogness 
339fbc4a8a8SJohn Ogness 	/* allocate UIO structure */
340d57801c4SAlexandru Ardelean 	info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL);
341d57801c4SAlexandru Ardelean 	if (!info)
342d57801c4SAlexandru Ardelean 		return -ENOMEM;
343fbc4a8a8SJohn Ogness 
344fbc4a8a8SJohn Ogness 	/* get current BR/OR values */
345fbc4a8a8SJohn Ogness 	reg_br_cur = in_be32(&priv->lbc->bank[priv->bank].br);
346fbc4a8a8SJohn Ogness 	reg_or_cur = in_be32(&priv->lbc->bank[priv->bank].or);
347fbc4a8a8SJohn Ogness 
348fbc4a8a8SJohn Ogness 	/* if bank already configured, make sure it matches */
349fbc4a8a8SJohn Ogness 	if ((reg_br_cur & BR_V)) {
350fbc4a8a8SJohn Ogness 		if ((reg_br_cur & BR_MSEL) != BR_MS_GPCM ||
351fbc4a8a8SJohn Ogness 		    (reg_br_cur & reg_or_cur & BR_BA)
352fbc4a8a8SJohn Ogness 		     != fsl_lbc_addr(res.start)) {
353fbc4a8a8SJohn Ogness 			dev_err(priv->dev,
354fbc4a8a8SJohn Ogness 				"bank in use by another peripheral\n");
355d57801c4SAlexandru Ardelean 			return -ENODEV;
356fbc4a8a8SJohn Ogness 		}
357fbc4a8a8SJohn Ogness 
358fbc4a8a8SJohn Ogness 		/* warn if behavior settings changing */
359fbc4a8a8SJohn Ogness 		if ((reg_br_cur & ~(BR_BA | BR_V)) !=
360fbc4a8a8SJohn Ogness 		    (reg_br_new & ~(BR_BA | BR_V))) {
361fbc4a8a8SJohn Ogness 			dev_warn(priv->dev,
362fbc4a8a8SJohn Ogness 				 "modifying BR settings: 0x%08x -> 0x%08x",
363fbc4a8a8SJohn Ogness 				 reg_br_cur, reg_br_new);
364fbc4a8a8SJohn Ogness 		}
365fbc4a8a8SJohn Ogness 		if ((reg_or_cur & ~OR_GPCM_AM) != (reg_or_new & ~OR_GPCM_AM)) {
366fbc4a8a8SJohn Ogness 			dev_warn(priv->dev,
367fbc4a8a8SJohn Ogness 				 "modifying OR settings: 0x%08x -> 0x%08x",
368fbc4a8a8SJohn Ogness 				 reg_or_cur, reg_or_new);
369fbc4a8a8SJohn Ogness 		}
370fbc4a8a8SJohn Ogness 	}
371fbc4a8a8SJohn Ogness 
372fbc4a8a8SJohn Ogness 	/* configure the bank (force base address and GPCM) */
373fbc4a8a8SJohn Ogness 	reg_br_new &= ~(BR_BA | BR_MSEL);
374fbc4a8a8SJohn Ogness 	reg_br_new |= fsl_lbc_addr(res.start) | BR_MS_GPCM | BR_V;
375fbc4a8a8SJohn Ogness 	out_be32(&priv->lbc->bank[priv->bank].or, reg_or_new);
376fbc4a8a8SJohn Ogness 	out_be32(&priv->lbc->bank[priv->bank].br, reg_br_new);
377fbc4a8a8SJohn Ogness 
378fbc4a8a8SJohn Ogness 	/* map the memory resource */
379fbc4a8a8SJohn Ogness 	info->mem[0].internal_addr = ioremap(res.start, resource_size(&res));
380fbc4a8a8SJohn Ogness 	if (!info->mem[0].internal_addr) {
381fbc4a8a8SJohn Ogness 		dev_err(priv->dev, "failed to map chip region\n");
382d57801c4SAlexandru Ardelean 		return -ENODEV;
383fbc4a8a8SJohn Ogness 	}
384fbc4a8a8SJohn Ogness 
385fbc4a8a8SJohn Ogness 	/* set all UIO data */
386d57801c4SAlexandru Ardelean 	info->mem[0].name = devm_kasprintf(&pdev->dev, GFP_KERNEL, "%pOFn", node);
387fbc4a8a8SJohn Ogness 	info->mem[0].addr = res.start;
388fbc4a8a8SJohn Ogness 	info->mem[0].size = resource_size(&res);
389fbc4a8a8SJohn Ogness 	info->mem[0].memtype = UIO_MEM_PHYS;
390fbc4a8a8SJohn Ogness 	info->priv = priv;
391fbc4a8a8SJohn Ogness 	info->name = uio_name;
392fbc4a8a8SJohn Ogness 	info->version = "0.0.1";
393*e4803160SChristophe Leroy 	if (irq) {
394fbc4a8a8SJohn Ogness 		if (priv->irq_handler) {
395fbc4a8a8SJohn Ogness 			info->irq = irq;
396fbc4a8a8SJohn Ogness 			info->irq_flags = IRQF_SHARED;
397fbc4a8a8SJohn Ogness 			info->handler = priv->irq_handler;
398fbc4a8a8SJohn Ogness 		} else {
399*e4803160SChristophe Leroy 			irq = 0;
400fbc4a8a8SJohn Ogness 			dev_warn(priv->dev, "ignoring irq, no handler\n");
401fbc4a8a8SJohn Ogness 		}
402fbc4a8a8SJohn Ogness 	}
403fbc4a8a8SJohn Ogness 
404fbc4a8a8SJohn Ogness 	if (priv->init)
405fbc4a8a8SJohn Ogness 		priv->init(info);
406fbc4a8a8SJohn Ogness 
407fbc4a8a8SJohn Ogness 	/* register UIO device */
408fbc4a8a8SJohn Ogness 	if (uio_register_device(priv->dev, info) != 0) {
409fbc4a8a8SJohn Ogness 		dev_err(priv->dev, "UIO registration failed\n");
410fbc4a8a8SJohn Ogness 		ret = -ENODEV;
411fbc4a8a8SJohn Ogness 		goto out_err2;
412fbc4a8a8SJohn Ogness 	}
413fbc4a8a8SJohn Ogness 
414fbc4a8a8SJohn Ogness 	/* store private data */
415fbc4a8a8SJohn Ogness 	platform_set_drvdata(pdev, info);
416fbc4a8a8SJohn Ogness 
417fbc4a8a8SJohn Ogness 	dev_info(priv->dev,
418fbc4a8a8SJohn Ogness 		 "eLBC/GPCM device (%s) at 0x%llx, bank %d, irq=%d\n",
419fbc4a8a8SJohn Ogness 		 priv->name, (unsigned long long)res.start, priv->bank,
420*e4803160SChristophe Leroy 		 irq ? : -1);
421fbc4a8a8SJohn Ogness 
422fbc4a8a8SJohn Ogness 	return 0;
423fbc4a8a8SJohn Ogness out_err2:
424fbc4a8a8SJohn Ogness 	if (priv->shutdown)
425fbc4a8a8SJohn Ogness 		priv->shutdown(info, true);
426fbc4a8a8SJohn Ogness 	iounmap(info->mem[0].internal_addr);
427fbc4a8a8SJohn Ogness 	return ret;
428fbc4a8a8SJohn Ogness }
429fbc4a8a8SJohn Ogness 
uio_fsl_elbc_gpcm_remove(struct platform_device * pdev)430fbc4a8a8SJohn Ogness static int uio_fsl_elbc_gpcm_remove(struct platform_device *pdev)
431fbc4a8a8SJohn Ogness {
432fbc4a8a8SJohn Ogness 	struct uio_info *info = platform_get_drvdata(pdev);
433fbc4a8a8SJohn Ogness 	struct fsl_elbc_gpcm *priv = info->priv;
434fbc4a8a8SJohn Ogness 
435fbc4a8a8SJohn Ogness 	platform_set_drvdata(pdev, NULL);
436fbc4a8a8SJohn Ogness 	uio_unregister_device(info);
437fbc4a8a8SJohn Ogness 	if (priv->shutdown)
438fbc4a8a8SJohn Ogness 		priv->shutdown(info, false);
439fbc4a8a8SJohn Ogness 	iounmap(info->mem[0].internal_addr);
440fbc4a8a8SJohn Ogness 
441fbc4a8a8SJohn Ogness 	return 0;
442fbc4a8a8SJohn Ogness 
443fbc4a8a8SJohn Ogness }
444fbc4a8a8SJohn Ogness 
445fbc4a8a8SJohn Ogness static const struct of_device_id uio_fsl_elbc_gpcm_match[] = {
446fbc4a8a8SJohn Ogness 	{ .compatible = "fsl,elbc-gpcm-uio", },
447fbc4a8a8SJohn Ogness 	{}
448fbc4a8a8SJohn Ogness };
4490049ef9cSLuis de Bethencourt MODULE_DEVICE_TABLE(of, uio_fsl_elbc_gpcm_match);
450fbc4a8a8SJohn Ogness 
451fbc4a8a8SJohn Ogness static struct platform_driver uio_fsl_elbc_gpcm_driver = {
452fbc4a8a8SJohn Ogness 	.driver = {
453fbc4a8a8SJohn Ogness 		.name = "fsl,elbc-gpcm-uio",
454fbc4a8a8SJohn Ogness 		.of_match_table = uio_fsl_elbc_gpcm_match,
4550682e005SGreg Kroah-Hartman 		.dev_groups = uio_fsl_elbc_gpcm_groups,
456fbc4a8a8SJohn Ogness 	},
457fbc4a8a8SJohn Ogness 	.probe = uio_fsl_elbc_gpcm_probe,
458fbc4a8a8SJohn Ogness 	.remove = uio_fsl_elbc_gpcm_remove,
459fbc4a8a8SJohn Ogness };
460d12f569cSVaishali Thakkar module_platform_driver(uio_fsl_elbc_gpcm_driver);
461fbc4a8a8SJohn Ogness 
462fbc4a8a8SJohn Ogness MODULE_LICENSE("GPL");
463fbc4a8a8SJohn Ogness MODULE_AUTHOR("John Ogness <john.ogness@linutronix.de>");
464fbc4a8a8SJohn Ogness MODULE_DESCRIPTION("Freescale Enhanced Local Bus Controller GPCM driver");
465