86 static int xps2_recv(struct xps2data *drvdata, u8 *byte)  in xps2_recv()  argument
92 	sr = in_be32(drvdata->base_address + XPS2_STATUS_OFFSET);  in xps2_recv()
94 		*byte = in_be32(drvdata->base_address + XPS2_RX_DATA_OFFSET);  in xps2_recv()
106 	struct xps2data *drvdata = dev_id;  in xps2_interrupt()  local
112 	intr_sr = in_be32(drvdata->base_address + XPS2_IPISR_OFFSET);  in xps2_interrupt()
113 	out_be32(drvdata->base_address + XPS2_IPISR_OFFSET, intr_sr);  in xps2_interrupt()
117 		dev_warn(drvdata->dev, "receive overrun error\n");  in xps2_interrupt()
120 		drvdata->flags |= SERIO_PARITY;  in xps2_interrupt()
123 		drvdata->flags |= SERIO_TIMEOUT;  in xps2_interrupt()
126 		status = xps2_recv(drvdata, &c);  in xps2_interrupt()
130 			dev_err(drvdata->dev,  in xps2_interrupt()
133 			serio_interrupt(drvdata->serio, c, drvdata->flags);  in xps2_interrupt()
134 			drvdata->flags = 0;  in xps2_interrupt()
157 	struct xps2data *drvdata = pserio->port_data;  in sxps2_write()  local
160 	guard(spinlock_irqsave)(&drvdata->lock);  in sxps2_write()
163 	sr = in_be32(drvdata->base_address + XPS2_STATUS_OFFSET);  in sxps2_write()
167 	out_be32(drvdata->base_address + XPS2_TX_DATA_OFFSET, c);  in sxps2_write()
179 	struct xps2data *drvdata = pserio->port_data;  in sxps2_open()  local
183 	error = request_irq(drvdata->irq, &xps2_interrupt, 0,  in sxps2_open()
184 				DRIVER_NAME, drvdata);  in sxps2_open()
186 		dev_err(drvdata->dev,  in sxps2_open()
187 			"Couldn't allocate interrupt %d\n", drvdata->irq);  in sxps2_open()
192 	out_be32(drvdata->base_address + XPS2_GIER_OFFSET, XPS2_GIER_GIE_MASK);  in sxps2_open()
193 	out_be32(drvdata->base_address + XPS2_IPIER_OFFSET, XPS2_IPIXR_RX_ALL);  in sxps2_open()
194 	(void)xps2_recv(drvdata, &c);  in sxps2_open()
207 	struct xps2data *drvdata = pserio->port_data;  in sxps2_close()  local
210 	out_be32(drvdata->base_address + XPS2_GIER_OFFSET, 0x00);  in sxps2_close()
211 	out_be32(drvdata->base_address + XPS2_IPIER_OFFSET, 0x00);  in sxps2_close()
212 	free_irq(drvdata->irq, drvdata);  in sxps2_close()
227 	struct xps2data *drvdata;  in xps2_of_probe()  local
250 	drvdata = kzalloc(sizeof(*drvdata), GFP_KERNEL);  in xps2_of_probe()
252 	if (!drvdata || !serio) {  in xps2_of_probe()
257 	spin_lock_init(&drvdata->lock);  in xps2_of_probe()
258 	drvdata->irq = irq;  in xps2_of_probe()
259 	drvdata->serio = serio;  in xps2_of_probe()
260 	drvdata->dev = dev;  in xps2_of_probe()
272 	drvdata->base_address = ioremap(phys_addr, remap_size);  in xps2_of_probe()
273 	if (drvdata->base_address == NULL) {  in xps2_of_probe()
281 	out_be32(drvdata->base_address + XPS2_IPIER_OFFSET, 0);  in xps2_of_probe()
287 	out_be32(drvdata->base_address + XPS2_SRST_OFFSET, XPS2_SRST_RESET);  in xps2_of_probe()
290 		 (unsigned long long)phys_addr, drvdata->base_address,  in xps2_of_probe()
291 		 drvdata->irq);  in xps2_of_probe()
297 	serio->port_data = drvdata;  in xps2_of_probe()
306 	platform_set_drvdata(ofdev, drvdata);  in xps2_of_probe()
313 	kfree(drvdata);  in xps2_of_probe()
328 	struct xps2data *drvdata = platform_get_drvdata(of_dev);  in xps2_of_remove()  local
331 	serio_unregister_port(drvdata->serio);  in xps2_of_remove()
332 	iounmap(drvdata->base_address);  in xps2_of_remove()
336 		dev_err(drvdata->dev, "invalid address\n");  in xps2_of_remove()
340 	kfree(drvdata);  in xps2_of_remove()