input: remove at32psif

Message ID 20180118185811.12856-1-clabbe.montjoie@gmail.com
State New
Headers show
Series
  • input: remove at32psif
Related show

Commit Message

Corentin Labbe Jan. 18, 2018, 6:58 p.m.
Since AVR32 arch is gone, at32psif driver is useless.
This patch remove it.

Signed-off-by: Corentin Labbe <clabbe.montjoie@gmail.com>

---
 drivers/input/serio/Kconfig    |  10 --
 drivers/input/serio/Makefile   |   1 -
 drivers/input/serio/at32psif.c | 357 -----------------------------------------
 3 files changed, 368 deletions(-)
 delete mode 100644 drivers/input/serio/at32psif.c

-- 
2.13.6

--
To unsubscribe from this list: send the line "unsubscribe linux-input" in
the body of a message to majordomo@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Comments

Dmitry Torokhov Jan. 18, 2018, 7:20 p.m. | #1
On Thu, Jan 18, 2018 at 07:58:11PM +0100, Corentin Labbe wrote:
> Since AVR32 arch is gone, at32psif driver is useless.

> This patch remove it.

> 

> Signed-off-by: Corentin Labbe <clabbe.montjoie@gmail.com>


Applied, thank you.

What about:

config TOUCHSCREEN_WM97XX_ATMEL
	tristate "WM97xx Atmel accelerated touch"
	depends on TOUCHSCREEN_WM97XX && AVR32 

?

> ---

>  drivers/input/serio/Kconfig    |  10 --

>  drivers/input/serio/Makefile   |   1 -

>  drivers/input/serio/at32psif.c | 357 -----------------------------------------

>  3 files changed, 368 deletions(-)

>  delete mode 100644 drivers/input/serio/at32psif.c

> 

> diff --git a/drivers/input/serio/Kconfig b/drivers/input/serio/Kconfig

> index 21488c048fa3..ca4530eb3378 100644

> --- a/drivers/input/serio/Kconfig

> +++ b/drivers/input/serio/Kconfig

> @@ -96,16 +96,6 @@ config SERIO_RPCKBD

>  	  To compile this driver as a module, choose M here: the

>  	  module will be called rpckbd.

>  

> -config SERIO_AT32PSIF

> -	tristate "AVR32 PSIF PS/2 keyboard and mouse controller"

> -	depends on AVR32

> -	help

> -	  Say Y here if you want to use the PSIF peripheral on AVR32 devices

> -	  and connect a PS/2 keyboard and/or mouse to it.

> -

> -	  To compile this driver as a module, choose M here: the module will

> -	  be called at32psif.

> -

>  config SERIO_AMBAKMI

>  	tristate "AMBA KMI keyboard controller"

>  	depends on ARM_AMBA

> diff --git a/drivers/input/serio/Makefile b/drivers/input/serio/Makefile

> index a3ca07621542..67950a5ccb3f 100644

> --- a/drivers/input/serio/Makefile

> +++ b/drivers/input/serio/Makefile

> @@ -13,7 +13,6 @@ obj-$(CONFIG_SERIO_CT82C710)	+= ct82c710.o

>  obj-$(CONFIG_SERIO_RPCKBD)	+= rpckbd.o

>  obj-$(CONFIG_SERIO_SA1111)	+= sa1111ps2.o

>  obj-$(CONFIG_SERIO_AMBAKMI)	+= ambakmi.o

> -obj-$(CONFIG_SERIO_AT32PSIF)	+= at32psif.o

>  obj-$(CONFIG_SERIO_Q40KBD)	+= q40kbd.o

>  obj-$(CONFIG_SERIO_GSCPS2)	+= gscps2.o

>  obj-$(CONFIG_HP_SDC)		+= hp_sdc.o

> diff --git a/drivers/input/serio/at32psif.c b/drivers/input/serio/at32psif.c

> deleted file mode 100644

> index e420fd781d44..000000000000

> --- a/drivers/input/serio/at32psif.c

> +++ /dev/null

> @@ -1,357 +0,0 @@

> -/*

> - * Copyright (C) 2007 Atmel Corporation

> - *

> - * Driver for the AT32AP700X PS/2 controller (PSIF).

> - *

> - * This program is free software; you can redistribute it and/or modify it

> - * under the terms of the GNU General Public License version 2 as published

> - * by the Free Software Foundation.

> - */

> -#include <linux/kernel.h>

> -#include <linux/module.h>

> -#include <linux/device.h>

> -#include <linux/init.h>

> -#include <linux/serio.h>

> -#include <linux/interrupt.h>

> -#include <linux/delay.h>

> -#include <linux/err.h>

> -#include <linux/io.h>

> -#include <linux/clk.h>

> -#include <linux/platform_device.h>

> -#include <linux/slab.h>

> -

> -/* PSIF register offsets */

> -#define PSIF_CR				0x00

> -#define PSIF_RHR			0x04

> -#define PSIF_THR			0x08

> -#define PSIF_SR				0x10

> -#define PSIF_IER			0x14

> -#define PSIF_IDR			0x18

> -#define PSIF_IMR			0x1c

> -#define PSIF_PSR			0x24

> -

> -/* Bitfields in control register. */

> -#define PSIF_CR_RXDIS_OFFSET		1

> -#define PSIF_CR_RXDIS_SIZE		1

> -#define PSIF_CR_RXEN_OFFSET		0

> -#define PSIF_CR_RXEN_SIZE		1

> -#define PSIF_CR_SWRST_OFFSET		15

> -#define PSIF_CR_SWRST_SIZE		1

> -#define PSIF_CR_TXDIS_OFFSET		9

> -#define PSIF_CR_TXDIS_SIZE		1

> -#define PSIF_CR_TXEN_OFFSET		8

> -#define PSIF_CR_TXEN_SIZE		1

> -

> -/* Bitfields in interrupt disable, enable, mask and status register. */

> -#define PSIF_NACK_OFFSET		8

> -#define PSIF_NACK_SIZE			1

> -#define PSIF_OVRUN_OFFSET		5

> -#define PSIF_OVRUN_SIZE			1

> -#define PSIF_PARITY_OFFSET		9

> -#define PSIF_PARITY_SIZE		1

> -#define PSIF_RXRDY_OFFSET		4

> -#define PSIF_RXRDY_SIZE			1

> -#define PSIF_TXEMPTY_OFFSET		1

> -#define PSIF_TXEMPTY_SIZE		1

> -#define PSIF_TXRDY_OFFSET		0

> -#define PSIF_TXRDY_SIZE			1

> -

> -/* Bitfields in prescale register. */

> -#define PSIF_PSR_PRSCV_OFFSET		0

> -#define PSIF_PSR_PRSCV_SIZE		12

> -

> -/* Bitfields in receive hold register. */

> -#define PSIF_RHR_RXDATA_OFFSET		0

> -#define PSIF_RHR_RXDATA_SIZE		8

> -

> -/* Bitfields in transmit hold register. */

> -#define PSIF_THR_TXDATA_OFFSET		0

> -#define PSIF_THR_TXDATA_SIZE		8

> -

> -/* Bit manipulation macros */

> -#define PSIF_BIT(name)					\

> -	(1 << PSIF_##name##_OFFSET)

> -

> -#define PSIF_BF(name, value)				\

> -	(((value) & ((1 << PSIF_##name##_SIZE) - 1))	\

> -	 << PSIF_##name##_OFFSET)

> -

> -#define PSIF_BFEXT(name, value)				\

> -	(((value) >> PSIF_##name##_OFFSET)		\

> -	 & ((1 << PSIF_##name##_SIZE) - 1))

> -

> -#define PSIF_BFINS(name, value, old)			\

> -	(((old) & ~(((1 << PSIF_##name##_SIZE) - 1)	\

> -		    << PSIF_##name##_OFFSET))		\

> -	 | PSIF_BF(name, value))

> -

> -/* Register access macros */

> -#define psif_readl(port, reg)				\

> -	__raw_readl((port)->regs + PSIF_##reg)

> -

> -#define psif_writel(port, reg, value)			\

> -	__raw_writel((value), (port)->regs + PSIF_##reg)

> -

> -struct psif {

> -	struct platform_device	*pdev;

> -	struct clk		*pclk;

> -	struct serio		*io;

> -	void __iomem		*regs;

> -	unsigned int		irq;

> -	/* Prevent concurrent writes to PSIF THR. */

> -	spinlock_t		lock;

> -	bool			open;

> -};

> -

> -static irqreturn_t psif_interrupt(int irq, void *_ptr)

> -{

> -	struct psif *psif = _ptr;

> -	int retval = IRQ_NONE;

> -	unsigned int io_flags = 0;

> -	unsigned long status;

> -

> -	status = psif_readl(psif, SR);

> -

> -	if (status & PSIF_BIT(RXRDY)) {

> -		unsigned char val = (unsigned char) psif_readl(psif, RHR);

> -

> -		if (status & PSIF_BIT(PARITY))

> -			io_flags |= SERIO_PARITY;

> -		if (status & PSIF_BIT(OVRUN))

> -			dev_err(&psif->pdev->dev, "overrun read error\n");

> -

> -		serio_interrupt(psif->io, val, io_flags);

> -

> -		retval = IRQ_HANDLED;

> -	}

> -

> -	return retval;

> -}

> -

> -static int psif_write(struct serio *io, unsigned char val)

> -{

> -	struct psif *psif = io->port_data;

> -	unsigned long flags;

> -	int timeout = 10;

> -	int retval = 0;

> -

> -	spin_lock_irqsave(&psif->lock, flags);

> -

> -	while (!(psif_readl(psif, SR) & PSIF_BIT(TXEMPTY)) && timeout--)

> -		udelay(50);

> -

> -	if (timeout >= 0) {

> -		psif_writel(psif, THR, val);

> -	} else {

> -		dev_dbg(&psif->pdev->dev, "timeout writing to THR\n");

> -		retval = -EBUSY;

> -	}

> -

> -	spin_unlock_irqrestore(&psif->lock, flags);

> -

> -	return retval;

> -}

> -

> -static int psif_open(struct serio *io)

> -{

> -	struct psif *psif = io->port_data;

> -	int retval;

> -

> -	retval = clk_enable(psif->pclk);

> -	if (retval)

> -		return retval;

> -

> -	psif_writel(psif, CR, PSIF_BIT(CR_TXEN) | PSIF_BIT(CR_RXEN));

> -	psif_writel(psif, IER, PSIF_BIT(RXRDY));

> -

> -	psif->open = true;

> -	return retval;

> -}

> -

> -static void psif_close(struct serio *io)

> -{

> -	struct psif *psif = io->port_data;

> -

> -	psif->open = false;

> -

> -	psif_writel(psif, IDR, ~0UL);

> -	psif_writel(psif, CR, PSIF_BIT(CR_TXDIS) | PSIF_BIT(CR_RXDIS));

> -

> -	clk_disable(psif->pclk);

> -}

> -

> -static void psif_set_prescaler(struct psif *psif)

> -{

> -	unsigned long prscv;

> -	unsigned long rate = clk_get_rate(psif->pclk);

> -

> -	/* PRSCV = Pulse length (100 us) * PSIF module frequency. */

> -	prscv = 100 * (rate / 1000000UL);

> -

> -	if (prscv > ((1<<PSIF_PSR_PRSCV_SIZE) - 1)) {

> -		prscv = (1<<PSIF_PSR_PRSCV_SIZE) - 1;

> -		dev_dbg(&psif->pdev->dev, "pclk too fast, "

> -				"prescaler set to max\n");

> -	}

> -

> -	clk_enable(psif->pclk);

> -	psif_writel(psif, PSR, prscv);

> -	clk_disable(psif->pclk);

> -}

> -

> -static int __init psif_probe(struct platform_device *pdev)

> -{

> -	struct resource *regs;

> -	struct psif *psif;

> -	struct serio *io;

> -	struct clk *pclk;

> -	int irq;

> -	int ret;

> -

> -	psif = kzalloc(sizeof(struct psif), GFP_KERNEL);

> -	if (!psif)

> -		return -ENOMEM;

> -	psif->pdev = pdev;

> -

> -	io = kzalloc(sizeof(struct serio), GFP_KERNEL);

> -	if (!io) {

> -		ret = -ENOMEM;

> -		goto out_free_psif;

> -	}

> -	psif->io = io;

> -

> -	regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);

> -	if (!regs) {

> -		dev_dbg(&pdev->dev, "no mmio resources defined\n");

> -		ret = -ENOMEM;

> -		goto out_free_io;

> -	}

> -

> -	psif->regs = ioremap(regs->start, resource_size(regs));

> -	if (!psif->regs) {

> -		ret = -ENOMEM;

> -		dev_dbg(&pdev->dev, "could not map I/O memory\n");

> -		goto out_free_io;

> -	}

> -

> -	pclk = clk_get(&pdev->dev, "pclk");

> -	if (IS_ERR(pclk)) {

> -		dev_dbg(&pdev->dev, "could not get peripheral clock\n");

> -		ret = PTR_ERR(pclk);

> -		goto out_iounmap;

> -	}

> -	psif->pclk = pclk;

> -

> -	/* Reset the PSIF to enter at a known state. */

> -	ret = clk_enable(pclk);

> -	if (ret) {

> -		dev_dbg(&pdev->dev, "could not enable pclk\n");

> -		goto out_put_clk;

> -	}

> -	psif_writel(psif, CR, PSIF_BIT(CR_SWRST));

> -	clk_disable(pclk);

> -

> -	irq = platform_get_irq(pdev, 0);

> -	if (irq < 0) {

> -		dev_dbg(&pdev->dev, "could not get irq\n");

> -		ret = -ENXIO;

> -		goto out_put_clk;

> -	}

> -	ret = request_irq(irq, psif_interrupt, IRQF_SHARED, "at32psif", psif);

> -	if (ret) {

> -		dev_dbg(&pdev->dev, "could not request irq %d\n", irq);

> -		goto out_put_clk;

> -	}

> -	psif->irq = irq;

> -

> -	io->id.type	= SERIO_8042;

> -	io->write	= psif_write;

> -	io->open	= psif_open;

> -	io->close	= psif_close;

> -	snprintf(io->name, sizeof(io->name), "AVR32 PS/2 port%d", pdev->id);

> -	snprintf(io->phys, sizeof(io->phys), "at32psif/serio%d", pdev->id);

> -	io->port_data	= psif;

> -	io->dev.parent	= &pdev->dev;

> -

> -	psif_set_prescaler(psif);

> -

> -	spin_lock_init(&psif->lock);

> -	serio_register_port(psif->io);

> -	platform_set_drvdata(pdev, psif);

> -

> -	dev_info(&pdev->dev, "Atmel AVR32 PSIF PS/2 driver on 0x%08x irq %d\n",

> -			(int)psif->regs, psif->irq);

> -

> -	return 0;

> -

> -out_put_clk:

> -	clk_put(psif->pclk);

> -out_iounmap:

> -	iounmap(psif->regs);

> -out_free_io:

> -	kfree(io);

> -out_free_psif:

> -	kfree(psif);

> -	return ret;

> -}

> -

> -static int __exit psif_remove(struct platform_device *pdev)

> -{

> -	struct psif *psif = platform_get_drvdata(pdev);

> -

> -	psif_writel(psif, IDR, ~0UL);

> -	psif_writel(psif, CR, PSIF_BIT(CR_TXDIS) | PSIF_BIT(CR_RXDIS));

> -

> -	serio_unregister_port(psif->io);

> -	iounmap(psif->regs);

> -	free_irq(psif->irq, psif);

> -	clk_put(psif->pclk);

> -	kfree(psif);

> -

> -	return 0;

> -}

> -

> -#ifdef CONFIG_PM_SLEEP

> -static int psif_suspend(struct device *dev)

> -{

> -	struct platform_device *pdev = to_platform_device(dev);

> -	struct psif *psif = platform_get_drvdata(pdev);

> -

> -	if (psif->open) {

> -		psif_writel(psif, CR, PSIF_BIT(CR_RXDIS) | PSIF_BIT(CR_TXDIS));

> -		clk_disable(psif->pclk);

> -	}

> -

> -	return 0;

> -}

> -

> -static int psif_resume(struct device *dev)

> -{

> -	struct platform_device *pdev = to_platform_device(dev);

> -	struct psif *psif = platform_get_drvdata(pdev);

> -

> -	if (psif->open) {

> -		clk_enable(psif->pclk);

> -		psif_set_prescaler(psif);

> -		psif_writel(psif, CR, PSIF_BIT(CR_RXEN) | PSIF_BIT(CR_TXEN));

> -	}

> -

> -	return 0;

> -}

> -#endif

> -

> -static SIMPLE_DEV_PM_OPS(psif_pm_ops, psif_suspend, psif_resume);

> -

> -static struct platform_driver psif_driver = {

> -	.remove		= __exit_p(psif_remove),

> -	.driver		= {

> -		.name	= "atmel_psif",

> -		.pm	= &psif_pm_ops,

> -	},

> -};

> -

> -module_platform_driver_probe(psif_driver, psif_probe);

> -

> -MODULE_AUTHOR("Hans-Christian Egtvedt <egtvedt@samfundet.no>");

> -MODULE_DESCRIPTION("Atmel AVR32 PSIF PS/2 driver");

> -MODULE_LICENSE("GPL");

> -- 

> 2.13.6

> 


-- 
Dmitry
--
To unsubscribe from this list: send the line "unsubscribe linux-input" in
the body of a message to majordomo@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Corentin Labbe Jan. 18, 2018, 7:48 p.m. | #2
On Thu, Jan 18, 2018 at 11:20:17AM -0800, Dmitry Torokhov wrote:
> On Thu, Jan 18, 2018 at 07:58:11PM +0100, Corentin Labbe wrote:

> > Since AVR32 arch is gone, at32psif driver is useless.

> > This patch remove it.

> > 

> > Signed-off-by: Corentin Labbe <clabbe.montjoie@gmail.com>

> 

> Applied, thank you.

> 

> What about:

> 

> config TOUCHSCREEN_WM97XX_ATMEL

> 	tristate "WM97xx Atmel accelerated touch"

> 	depends on TOUCHSCREEN_WM97XX && AVR32 

> 

> ?

> 


It was my second target BUT the code content reference to AT91 (wm97xx continuous touch driver for Atmel AT91 and AVR32) so perhaps it could be keeped.

But someone need to test it.

Regards
--
To unsubscribe from this list: send the line "unsubscribe linux-input" in
the body of a message to majordomo@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Dmitry Torokhov Jan. 18, 2018, 7:55 p.m. | #3
On Thu, Jan 18, 2018 at 08:48:24PM +0100, Corentin Labbe wrote:
> On Thu, Jan 18, 2018 at 11:20:17AM -0800, Dmitry Torokhov wrote:

> > On Thu, Jan 18, 2018 at 07:58:11PM +0100, Corentin Labbe wrote:

> > > Since AVR32 arch is gone, at32psif driver is useless.

> > > This patch remove it.

> > > 

> > > Signed-off-by: Corentin Labbe <clabbe.montjoie@gmail.com>

> > 

> > Applied, thank you.

> > 

> > What about:

> > 

> > config TOUCHSCREEN_WM97XX_ATMEL

> > 	tristate "WM97xx Atmel accelerated touch"

> > 	depends on TOUCHSCREEN_WM97XX && AVR32 

> > 

> > ?

> > 

> 

> It was my second target BUT the code content reference to AT91 (wm97xx continuous touch driver for Atmel AT91 and AVR32) so perhaps it could be keeped.

> 

> But someone need to test it.


"&& AVR32" means that nobody ever ran it on AT91 though...
Hans-Christian, any ideas?

Thanks.

-- 
Dmitry
--
To unsubscribe from this list: send the line "unsubscribe linux-input" in
the body of a message to majordomo@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Hans-Christian Noren Egtvedt Jan. 19, 2018, 7:25 a.m. | #4
Around Thu 18 Jan 2018 11:55:43 -0800 or thereabout, Dmitry Torokhov wrote:
> On Thu, Jan 18, 2018 at 08:48:24PM +0100, Corentin Labbe wrote:

>> On Thu, Jan 18, 2018 at 11:20:17AM -0800, Dmitry Torokhov wrote:

>> > On Thu, Jan 18, 2018 at 07:58:11PM +0100, Corentin Labbe wrote:

>> > > Since AVR32 arch is gone, at32psif driver is useless.

>> > > This patch remove it.

>> > > 

>> > > Signed-off-by: Corentin Labbe <clabbe.montjoie@gmail.com>

>> > 

>> > Applied, thank you.

>> > 

>> > What about:

>> > 

>> > config TOUCHSCREEN_WM97XX_ATMEL

>> > 	tristate "WM97xx Atmel accelerated touch"

>> > 	depends on TOUCHSCREEN_WM97XX && AVR32 

>> > 

>> > ?

>> > 

>> 

>> It was my second target BUT the code content reference to AT91 (wm97xx continuous touch driver for Atmel AT91 and AVR32) so perhaps it could be keeped.

>> 

>> But someone need to test it.

> 

> "&& AVR32" means that nobody ever ran it on AT91 though...

> Hans-Christian, any ideas?


I never tested accelerating WM97xx codecs on AT91, hence it is AVR32 only. It
can be removed.

Thanks for cleaning (-:

-- 
Best regards,
Hans-Christian Noren Egtvedt
--
To unsubscribe from this list: send the line "unsubscribe linux-input" in
the body of a message to majordomo@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Patch

diff --git a/drivers/input/serio/Kconfig b/drivers/input/serio/Kconfig
index 21488c048fa3..ca4530eb3378 100644
--- a/drivers/input/serio/Kconfig
+++ b/drivers/input/serio/Kconfig
@@ -96,16 +96,6 @@  config SERIO_RPCKBD
 	  To compile this driver as a module, choose M here: the
 	  module will be called rpckbd.
 
-config SERIO_AT32PSIF
-	tristate "AVR32 PSIF PS/2 keyboard and mouse controller"
-	depends on AVR32
-	help
-	  Say Y here if you want to use the PSIF peripheral on AVR32 devices
-	  and connect a PS/2 keyboard and/or mouse to it.
-
-	  To compile this driver as a module, choose M here: the module will
-	  be called at32psif.
-
 config SERIO_AMBAKMI
 	tristate "AMBA KMI keyboard controller"
 	depends on ARM_AMBA
diff --git a/drivers/input/serio/Makefile b/drivers/input/serio/Makefile
index a3ca07621542..67950a5ccb3f 100644
--- a/drivers/input/serio/Makefile
+++ b/drivers/input/serio/Makefile
@@ -13,7 +13,6 @@  obj-$(CONFIG_SERIO_CT82C710)	+= ct82c710.o
 obj-$(CONFIG_SERIO_RPCKBD)	+= rpckbd.o
 obj-$(CONFIG_SERIO_SA1111)	+= sa1111ps2.o
 obj-$(CONFIG_SERIO_AMBAKMI)	+= ambakmi.o
-obj-$(CONFIG_SERIO_AT32PSIF)	+= at32psif.o
 obj-$(CONFIG_SERIO_Q40KBD)	+= q40kbd.o
 obj-$(CONFIG_SERIO_GSCPS2)	+= gscps2.o
 obj-$(CONFIG_HP_SDC)		+= hp_sdc.o
diff --git a/drivers/input/serio/at32psif.c b/drivers/input/serio/at32psif.c
deleted file mode 100644
index e420fd781d44..000000000000
--- a/drivers/input/serio/at32psif.c
+++ /dev/null
@@ -1,357 +0,0 @@ 
-/*
- * Copyright (C) 2007 Atmel Corporation
- *
- * Driver for the AT32AP700X PS/2 controller (PSIF).
- *
- * This program is free software; you can redistribute it and/or modify it
- * under the terms of the GNU General Public License version 2 as published
- * by the Free Software Foundation.
- */
-#include <linux/kernel.h>
-#include <linux/module.h>
-#include <linux/device.h>
-#include <linux/init.h>
-#include <linux/serio.h>
-#include <linux/interrupt.h>
-#include <linux/delay.h>
-#include <linux/err.h>
-#include <linux/io.h>
-#include <linux/clk.h>
-#include <linux/platform_device.h>
-#include <linux/slab.h>
-
-/* PSIF register offsets */
-#define PSIF_CR				0x00
-#define PSIF_RHR			0x04
-#define PSIF_THR			0x08
-#define PSIF_SR				0x10
-#define PSIF_IER			0x14
-#define PSIF_IDR			0x18
-#define PSIF_IMR			0x1c
-#define PSIF_PSR			0x24
-
-/* Bitfields in control register. */
-#define PSIF_CR_RXDIS_OFFSET		1
-#define PSIF_CR_RXDIS_SIZE		1
-#define PSIF_CR_RXEN_OFFSET		0
-#define PSIF_CR_RXEN_SIZE		1
-#define PSIF_CR_SWRST_OFFSET		15
-#define PSIF_CR_SWRST_SIZE		1
-#define PSIF_CR_TXDIS_OFFSET		9
-#define PSIF_CR_TXDIS_SIZE		1
-#define PSIF_CR_TXEN_OFFSET		8
-#define PSIF_CR_TXEN_SIZE		1
-
-/* Bitfields in interrupt disable, enable, mask and status register. */
-#define PSIF_NACK_OFFSET		8
-#define PSIF_NACK_SIZE			1
-#define PSIF_OVRUN_OFFSET		5
-#define PSIF_OVRUN_SIZE			1
-#define PSIF_PARITY_OFFSET		9
-#define PSIF_PARITY_SIZE		1
-#define PSIF_RXRDY_OFFSET		4
-#define PSIF_RXRDY_SIZE			1
-#define PSIF_TXEMPTY_OFFSET		1
-#define PSIF_TXEMPTY_SIZE		1
-#define PSIF_TXRDY_OFFSET		0
-#define PSIF_TXRDY_SIZE			1
-
-/* Bitfields in prescale register. */
-#define PSIF_PSR_PRSCV_OFFSET		0
-#define PSIF_PSR_PRSCV_SIZE		12
-
-/* Bitfields in receive hold register. */
-#define PSIF_RHR_RXDATA_OFFSET		0
-#define PSIF_RHR_RXDATA_SIZE		8
-
-/* Bitfields in transmit hold register. */
-#define PSIF_THR_TXDATA_OFFSET		0
-#define PSIF_THR_TXDATA_SIZE		8
-
-/* Bit manipulation macros */
-#define PSIF_BIT(name)					\
-	(1 << PSIF_##name##_OFFSET)
-
-#define PSIF_BF(name, value)				\
-	(((value) & ((1 << PSIF_##name##_SIZE) - 1))	\
-	 << PSIF_##name##_OFFSET)
-
-#define PSIF_BFEXT(name, value)				\
-	(((value) >> PSIF_##name##_OFFSET)		\
-	 & ((1 << PSIF_##name##_SIZE) - 1))
-
-#define PSIF_BFINS(name, value, old)			\
-	(((old) & ~(((1 << PSIF_##name##_SIZE) - 1)	\
-		    << PSIF_##name##_OFFSET))		\
-	 | PSIF_BF(name, value))
-
-/* Register access macros */
-#define psif_readl(port, reg)				\
-	__raw_readl((port)->regs + PSIF_##reg)
-
-#define psif_writel(port, reg, value)			\
-	__raw_writel((value), (port)->regs + PSIF_##reg)
-
-struct psif {
-	struct platform_device	*pdev;
-	struct clk		*pclk;
-	struct serio		*io;
-	void __iomem		*regs;
-	unsigned int		irq;
-	/* Prevent concurrent writes to PSIF THR. */
-	spinlock_t		lock;
-	bool			open;
-};
-
-static irqreturn_t psif_interrupt(int irq, void *_ptr)
-{
-	struct psif *psif = _ptr;
-	int retval = IRQ_NONE;
-	unsigned int io_flags = 0;
-	unsigned long status;
-
-	status = psif_readl(psif, SR);
-
-	if (status & PSIF_BIT(RXRDY)) {
-		unsigned char val = (unsigned char) psif_readl(psif, RHR);
-
-		if (status & PSIF_BIT(PARITY))
-			io_flags |= SERIO_PARITY;
-		if (status & PSIF_BIT(OVRUN))
-			dev_err(&psif->pdev->dev, "overrun read error\n");
-
-		serio_interrupt(psif->io, val, io_flags);
-
-		retval = IRQ_HANDLED;
-	}
-
-	return retval;
-}
-
-static int psif_write(struct serio *io, unsigned char val)
-{
-	struct psif *psif = io->port_data;
-	unsigned long flags;
-	int timeout = 10;
-	int retval = 0;
-
-	spin_lock_irqsave(&psif->lock, flags);
-
-	while (!(psif_readl(psif, SR) & PSIF_BIT(TXEMPTY)) && timeout--)
-		udelay(50);
-
-	if (timeout >= 0) {
-		psif_writel(psif, THR, val);
-	} else {
-		dev_dbg(&psif->pdev->dev, "timeout writing to THR\n");
-		retval = -EBUSY;
-	}
-
-	spin_unlock_irqrestore(&psif->lock, flags);
-
-	return retval;
-}
-
-static int psif_open(struct serio *io)
-{
-	struct psif *psif = io->port_data;
-	int retval;
-
-	retval = clk_enable(psif->pclk);
-	if (retval)
-		return retval;
-
-	psif_writel(psif, CR, PSIF_BIT(CR_TXEN) | PSIF_BIT(CR_RXEN));
-	psif_writel(psif, IER, PSIF_BIT(RXRDY));
-
-	psif->open = true;
-	return retval;
-}
-
-static void psif_close(struct serio *io)
-{
-	struct psif *psif = io->port_data;
-
-	psif->open = false;
-
-	psif_writel(psif, IDR, ~0UL);
-	psif_writel(psif, CR, PSIF_BIT(CR_TXDIS) | PSIF_BIT(CR_RXDIS));
-
-	clk_disable(psif->pclk);
-}
-
-static void psif_set_prescaler(struct psif *psif)
-{
-	unsigned long prscv;
-	unsigned long rate = clk_get_rate(psif->pclk);
-
-	/* PRSCV = Pulse length (100 us) * PSIF module frequency. */
-	prscv = 100 * (rate / 1000000UL);
-
-	if (prscv > ((1<<PSIF_PSR_PRSCV_SIZE) - 1)) {
-		prscv = (1<<PSIF_PSR_PRSCV_SIZE) - 1;
-		dev_dbg(&psif->pdev->dev, "pclk too fast, "
-				"prescaler set to max\n");
-	}
-
-	clk_enable(psif->pclk);
-	psif_writel(psif, PSR, prscv);
-	clk_disable(psif->pclk);
-}
-
-static int __init psif_probe(struct platform_device *pdev)
-{
-	struct resource *regs;
-	struct psif *psif;
-	struct serio *io;
-	struct clk *pclk;
-	int irq;
-	int ret;
-
-	psif = kzalloc(sizeof(struct psif), GFP_KERNEL);
-	if (!psif)
-		return -ENOMEM;
-	psif->pdev = pdev;
-
-	io = kzalloc(sizeof(struct serio), GFP_KERNEL);
-	if (!io) {
-		ret = -ENOMEM;
-		goto out_free_psif;
-	}
-	psif->io = io;
-
-	regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
-	if (!regs) {
-		dev_dbg(&pdev->dev, "no mmio resources defined\n");
-		ret = -ENOMEM;
-		goto out_free_io;
-	}
-
-	psif->regs = ioremap(regs->start, resource_size(regs));
-	if (!psif->regs) {
-		ret = -ENOMEM;
-		dev_dbg(&pdev->dev, "could not map I/O memory\n");
-		goto out_free_io;
-	}
-
-	pclk = clk_get(&pdev->dev, "pclk");
-	if (IS_ERR(pclk)) {
-		dev_dbg(&pdev->dev, "could not get peripheral clock\n");
-		ret = PTR_ERR(pclk);
-		goto out_iounmap;
-	}
-	psif->pclk = pclk;
-
-	/* Reset the PSIF to enter at a known state. */
-	ret = clk_enable(pclk);
-	if (ret) {
-		dev_dbg(&pdev->dev, "could not enable pclk\n");
-		goto out_put_clk;
-	}
-	psif_writel(psif, CR, PSIF_BIT(CR_SWRST));
-	clk_disable(pclk);
-
-	irq = platform_get_irq(pdev, 0);
-	if (irq < 0) {
-		dev_dbg(&pdev->dev, "could not get irq\n");
-		ret = -ENXIO;
-		goto out_put_clk;
-	}
-	ret = request_irq(irq, psif_interrupt, IRQF_SHARED, "at32psif", psif);
-	if (ret) {
-		dev_dbg(&pdev->dev, "could not request irq %d\n", irq);
-		goto out_put_clk;
-	}
-	psif->irq = irq;
-
-	io->id.type	= SERIO_8042;
-	io->write	= psif_write;
-	io->open	= psif_open;
-	io->close	= psif_close;
-	snprintf(io->name, sizeof(io->name), "AVR32 PS/2 port%d", pdev->id);
-	snprintf(io->phys, sizeof(io->phys), "at32psif/serio%d", pdev->id);
-	io->port_data	= psif;
-	io->dev.parent	= &pdev->dev;
-
-	psif_set_prescaler(psif);
-
-	spin_lock_init(&psif->lock);
-	serio_register_port(psif->io);
-	platform_set_drvdata(pdev, psif);
-
-	dev_info(&pdev->dev, "Atmel AVR32 PSIF PS/2 driver on 0x%08x irq %d\n",
-			(int)psif->regs, psif->irq);
-
-	return 0;
-
-out_put_clk:
-	clk_put(psif->pclk);
-out_iounmap:
-	iounmap(psif->regs);
-out_free_io:
-	kfree(io);
-out_free_psif:
-	kfree(psif);
-	return ret;
-}
-
-static int __exit psif_remove(struct platform_device *pdev)
-{
-	struct psif *psif = platform_get_drvdata(pdev);
-
-	psif_writel(psif, IDR, ~0UL);
-	psif_writel(psif, CR, PSIF_BIT(CR_TXDIS) | PSIF_BIT(CR_RXDIS));
-
-	serio_unregister_port(psif->io);
-	iounmap(psif->regs);
-	free_irq(psif->irq, psif);
-	clk_put(psif->pclk);
-	kfree(psif);
-
-	return 0;
-}
-
-#ifdef CONFIG_PM_SLEEP
-static int psif_suspend(struct device *dev)
-{
-	struct platform_device *pdev = to_platform_device(dev);
-	struct psif *psif = platform_get_drvdata(pdev);
-
-	if (psif->open) {
-		psif_writel(psif, CR, PSIF_BIT(CR_RXDIS) | PSIF_BIT(CR_TXDIS));
-		clk_disable(psif->pclk);
-	}
-
-	return 0;
-}
-
-static int psif_resume(struct device *dev)
-{
-	struct platform_device *pdev = to_platform_device(dev);
-	struct psif *psif = platform_get_drvdata(pdev);
-
-	if (psif->open) {
-		clk_enable(psif->pclk);
-		psif_set_prescaler(psif);
-		psif_writel(psif, CR, PSIF_BIT(CR_RXEN) | PSIF_BIT(CR_TXEN));
-	}
-
-	return 0;
-}
-#endif
-
-static SIMPLE_DEV_PM_OPS(psif_pm_ops, psif_suspend, psif_resume);
-
-static struct platform_driver psif_driver = {
-	.remove		= __exit_p(psif_remove),
-	.driver		= {
-		.name	= "atmel_psif",
-		.pm	= &psif_pm_ops,
-	},
-};
-
-module_platform_driver_probe(psif_driver, psif_probe);
-
-MODULE_AUTHOR("Hans-Christian Egtvedt <egtvedt@samfundet.no>");
-MODULE_DESCRIPTION("Atmel AVR32 PSIF PS/2 driver");
-MODULE_LICENSE("GPL");