[PATCH] AX88796 parallel port driver
authorBen Dooks <ben-linux@fluff.org>
Sun, 25 Jun 2006 12:48:03 +0000 (05:48 -0700)
committerLinus Torvalds <torvalds@g5.osdl.org>
Sun, 25 Jun 2006 17:01:09 +0000 (10:01 -0700)
Driver for the simple parallel port interface on the Asix AX88796 chip on
an platform_bus.

[akpm@osdl.org: x86_64 build fix]
Signed-off-by: Ben Dooks <ben-linux@fluff.org>
Signed-off-by: Andrew Morton <akpm@osdl.org>
Signed-off-by: Linus Torvalds <torvalds@osdl.org>
drivers/parport/Kconfig
drivers/parport/Makefile
drivers/parport/parport_ax88796.c [new file with mode: 0644]
include/linux/parport.h

index 4d8dc27..c7fa28a 100644 (file)
@@ -136,6 +136,18 @@ config PARPORT_SUNBPP
          found on many Sun machines. Note that many of the newer Ultras
          actually have pc style hardware instead.
 
+config PARPORT_AX88796
+       tristate "AX88796 Parallel Port"
+       depends on PARPORT
+       select PARPORT_NOT_PC
+       help
+         Say Y here if you need support for the parallel port hardware on
+         the AX88796 network controller chip. This code is also available
+         as a module (say M), called parport_ax88796.
+
+         The driver is not dependant on the AX88796 network driver, and
+         should not interfere with the networking functions of the chip.
+
 config PARPORT_1284
        bool "IEEE 1284 transfer modes"
        depends on PARPORT
index a19de35..696b8d4 100644 (file)
@@ -17,4 +17,5 @@ obj-$(CONFIG_PARPORT_MFC3)    += parport_mfc3.o
 obj-$(CONFIG_PARPORT_ATARI)    += parport_atari.o
 obj-$(CONFIG_PARPORT_SUNBPP)   += parport_sunbpp.o
 obj-$(CONFIG_PARPORT_GSC)      += parport_gsc.o
-obj-$(CONFIG_PARPORT_IP32)     += parport_ip32.o
+obj-$(CONFIG_PARPORT_AX88796)  += parport_ax88796.o
+obj-$(CONFIG_PARPORT_IP32)     += parport_ip32.o
\ No newline at end of file
diff --git a/drivers/parport/parport_ax88796.c b/drivers/parport/parport_ax88796.c
new file mode 100644 (file)
index 0000000..4baa719
--- /dev/null
@@ -0,0 +1,443 @@
+/* linux/drivers/parport/parport_ax88796.c
+ *
+ * (c) 2005,2006 Simtec Electronics
+ *     Ben Dooks <ben@simtec.co.uk>
+ *
+ * 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/module.h>
+#include <linux/kernel.h>
+#include <linux/parport.h>
+#include <linux/interrupt.h>
+#include <linux/errno.h>
+#include <linux/platform_device.h>
+
+#include <asm/io.h>
+#include <asm/irq.h>
+
+#define AX_SPR_BUSY            (1<<7)
+#define AX_SPR_ACK             (1<<6)
+#define AX_SPR_PE              (1<<5)
+#define AX_SPR_SLCT            (1<<4)
+#define AX_SPR_ERR             (1<<3)
+
+#define AX_CPR_nDOE            (1<<5)
+#define AX_CPR_SLCTIN          (1<<3)
+#define AX_CPR_nINIT           (1<<2)
+#define AX_CPR_ATFD            (1<<1)
+#define AX_CPR_STRB            (1<<0)
+
+struct ax_drvdata {
+       struct parport          *parport;
+       struct parport_state     suspend;
+
+       struct device           *dev;
+       struct resource         *io;
+
+       unsigned char            irq_enabled;
+
+       void __iomem            *base;
+       void __iomem            *spp_data;
+       void __iomem            *spp_spr;
+       void __iomem            *spp_cpr;
+};
+
+static inline struct ax_drvdata *pp_to_drv(struct parport *p)
+{
+       return p->private_data;
+}
+
+static unsigned char
+parport_ax88796_read_data(struct parport *p)
+{
+       struct ax_drvdata *dd = pp_to_drv(p);
+
+       return readb(dd->spp_data);
+}
+
+static void
+parport_ax88796_write_data(struct parport *p, unsigned char data)
+{
+       struct ax_drvdata *dd = pp_to_drv(p);
+
+       writeb(data, dd->spp_data);
+}
+
+static unsigned char
+parport_ax88796_read_control(struct parport *p)
+{
+       struct ax_drvdata *dd = pp_to_drv(p);
+       unsigned int cpr = readb(dd->spp_cpr);
+       unsigned int ret = 0;
+
+       if (!(cpr & AX_CPR_STRB))
+               ret |= PARPORT_CONTROL_STROBE;
+
+       if (!(cpr & AX_CPR_ATFD))
+               ret |= PARPORT_CONTROL_AUTOFD;
+
+       if (cpr & AX_CPR_nINIT)
+               ret |= PARPORT_CONTROL_INIT;
+
+       if (!(cpr & AX_CPR_SLCTIN))
+               ret |= PARPORT_CONTROL_SELECT;
+
+       return ret;
+}
+
+static void
+parport_ax88796_write_control(struct parport *p, unsigned char control)
+{
+       struct ax_drvdata *dd = pp_to_drv(p);
+       unsigned int cpr = readb(dd->spp_cpr);
+
+       cpr &= AX_CPR_nDOE;
+
+       if (!(control & PARPORT_CONTROL_STROBE))
+               cpr |= AX_CPR_STRB;
+
+       if (!(control & PARPORT_CONTROL_AUTOFD))
+               cpr |= AX_CPR_ATFD;
+
+       if (control & PARPORT_CONTROL_INIT)
+               cpr |= AX_CPR_nINIT;
+
+       if (!(control & PARPORT_CONTROL_SELECT))
+               cpr |= AX_CPR_SLCTIN;
+
+       dev_dbg(dd->dev, "write_control: ctrl=%02x, cpr=%02x\n", control, cpr);
+       writeb(cpr, dd->spp_cpr);
+
+       if (parport_ax88796_read_control(p) != control) {
+               dev_err(dd->dev, "write_control: read != set (%02x, %02x)\n",
+                       parport_ax88796_read_control(p), control);
+       }
+}
+
+static unsigned char
+parport_ax88796_read_status(struct parport *p)
+{
+       struct ax_drvdata *dd = pp_to_drv(p);
+       unsigned int status = readb(dd->spp_spr);
+       unsigned int ret = 0;
+
+       if (status & AX_SPR_BUSY)
+               ret |= PARPORT_STATUS_BUSY;
+
+       if (status & AX_SPR_ACK)
+               ret |= PARPORT_STATUS_ACK;
+
+       if (status & AX_SPR_ERR)
+               ret |= PARPORT_STATUS_ERROR;
+
+       if (status & AX_SPR_SLCT)
+               ret |= PARPORT_STATUS_SELECT;
+
+       if (status & AX_SPR_PE)
+               ret |= PARPORT_STATUS_PAPEROUT;
+
+       return ret;
+}
+
+static unsigned char
+parport_ax88796_frob_control(struct parport *p, unsigned char mask,
+                            unsigned char val)
+{
+       struct ax_drvdata *dd = pp_to_drv(p);
+       unsigned char old = parport_ax88796_read_control(p);
+
+       dev_dbg(dd->dev, "frob: mask=%02x, val=%02x, old=%02x\n",
+               mask, val, old);
+
+       parport_ax88796_write_control(p, (old & ~mask) | val);
+       return old;
+}
+
+static void
+parport_ax88796_enable_irq(struct parport *p)
+{
+       struct ax_drvdata *dd = pp_to_drv(p);
+       unsigned long flags;
+
+       local_irq_save(flags);
+       if (!dd->irq_enabled) {
+               enable_irq(p->irq);
+               dd->irq_enabled = 1;
+       }
+       local_irq_restore(flags);
+}
+
+static void
+parport_ax88796_disable_irq(struct parport *p)
+{
+       struct ax_drvdata *dd = pp_to_drv(p);
+       unsigned long flags;
+
+       local_irq_save(flags);
+       if (dd->irq_enabled) {
+               disable_irq(p->irq);
+               dd->irq_enabled = 0;
+       }
+       local_irq_restore(flags);
+}
+
+static void
+parport_ax88796_data_forward(struct parport *p)
+{
+       struct ax_drvdata *dd = pp_to_drv(p);
+       void __iomem *cpr = dd->spp_cpr;
+
+       writeb((readb(cpr) & ~AX_CPR_nDOE), cpr);
+}
+
+static void
+parport_ax88796_data_reverse(struct parport *p)
+{
+       struct ax_drvdata *dd = pp_to_drv(p);
+       void __iomem *cpr = dd->spp_cpr;
+
+       writeb(readb(cpr) | AX_CPR_nDOE, cpr);
+}
+
+static void
+parport_ax88796_init_state(struct pardevice *d, struct parport_state *s)
+{
+       struct ax_drvdata *dd = pp_to_drv(d->port);
+
+       memset(s, 0, sizeof(struct parport_state));
+
+       dev_dbg(dd->dev, "init_state: %p: state=%p\n", d, s);
+       s->u.ax88796.cpr = readb(dd->spp_cpr);
+}
+
+static void
+parport_ax88796_save_state(struct parport *p, struct parport_state *s)
+{
+       struct ax_drvdata *dd = pp_to_drv(p);
+
+       dev_dbg(dd->dev, "save_state: %p: state=%p\n", p, s);
+       s->u.ax88796.cpr = readb(dd->spp_cpr);
+}
+
+static void
+parport_ax88796_restore_state(struct parport *p, struct parport_state *s)
+{
+       struct ax_drvdata *dd = pp_to_drv(p);
+
+       dev_dbg(dd->dev, "restore_state: %p: state=%p\n", p, s);
+       writeb(s->u.ax88796.cpr, dd->spp_cpr);
+}
+
+static irqreturn_t
+parport_ax88796_interrupt(int irq, void *dev_id, struct pt_regs *regs)
+{
+        parport_generic_irq(irq, dev_id, regs);
+        return IRQ_HANDLED;
+}
+
+
+static struct parport_operations parport_ax88796_ops = {
+       .write_data     = parport_ax88796_write_data,
+       .read_data      = parport_ax88796_read_data,
+
+       .write_control  = parport_ax88796_write_control,
+       .read_control   = parport_ax88796_read_control,
+       .frob_control   = parport_ax88796_frob_control,
+
+       .read_status    = parport_ax88796_read_status,
+
+       .enable_irq     = parport_ax88796_enable_irq,
+       .disable_irq    = parport_ax88796_disable_irq,
+
+       .data_forward   = parport_ax88796_data_forward,
+       .data_reverse   = parport_ax88796_data_reverse,
+
+       .init_state     = parport_ax88796_init_state,
+       .save_state     = parport_ax88796_save_state,
+       .restore_state  = parport_ax88796_restore_state,
+
+       .epp_write_data = parport_ieee1284_epp_write_data,
+       .epp_read_data  = parport_ieee1284_epp_read_data,
+       .epp_write_addr = parport_ieee1284_epp_write_addr,
+       .epp_read_addr  = parport_ieee1284_epp_read_addr,
+
+       .ecp_write_data = parport_ieee1284_ecp_write_data,
+       .ecp_read_data  = parport_ieee1284_ecp_read_data,
+       .ecp_write_addr = parport_ieee1284_ecp_write_addr,
+
+       .compat_write_data      = parport_ieee1284_write_compat,
+       .nibble_read_data       = parport_ieee1284_read_nibble,
+       .byte_read_data         = parport_ieee1284_read_byte,
+
+       .owner          = THIS_MODULE,
+};
+
+static int parport_ax88796_probe(struct platform_device *pdev)
+{
+       struct device *_dev = &pdev->dev;
+       struct ax_drvdata *dd;
+       struct parport *pp = NULL;
+       struct resource *res;
+       unsigned long size;
+       int spacing;
+       int irq;
+       int ret;
+
+       dd = kzalloc(sizeof(struct ax_drvdata), GFP_KERNEL);
+       if (dd == NULL) {
+               dev_err(_dev, "no memory for private data\n");
+               return -ENOMEM;
+       }
+
+       res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+       if (res == NULL) {
+               dev_err(_dev, "no MEM specified\n");
+               ret = -ENXIO;
+               goto exit_mem;
+       }
+
+       size = (res->end - res->start) + 1;
+       spacing = size / 3;
+
+       dd->io = request_mem_region(res->start, size, pdev->name);
+       if (dd->io == NULL) {
+               dev_err(_dev, "cannot reserve memory\n");
+               ret = -ENXIO;
+               goto exit_mem;
+       }
+
+       dd->base = ioremap(res->start, size);
+       if (dd->base == NULL) {
+               dev_err(_dev, "cannot ioremap region\n");
+               ret = -ENXIO;
+               goto exit_res;
+       }
+
+       irq = platform_get_irq(pdev, 0);
+       if (irq <= 0)
+               irq = PARPORT_IRQ_NONE;
+
+       pp = parport_register_port((unsigned long)dd->base, irq,
+                                  PARPORT_DMA_NONE,
+                                  &parport_ax88796_ops);
+
+       if (pp == NULL) {
+               dev_err(_dev, "failed to register parallel port\n");
+               ret = -ENOMEM;
+               goto exit_unmap;
+       }
+
+       pp->private_data = dd;
+       dd->parport = pp;
+       dd->dev = _dev;
+
+       dd->spp_data = dd->base;
+       dd->spp_spr  = dd->base + (spacing * 1);
+       dd->spp_cpr  = dd->base + (spacing * 2);
+
+       /* initialise the port controls */
+       writeb(AX_CPR_STRB, dd->spp_cpr);
+
+       if (irq >= 0) {
+               /* request irq */
+               ret = request_irq(irq, parport_ax88796_interrupt,
+                                 SA_TRIGGER_FALLING, pdev->name, pp);
+
+               if (ret < 0)
+                       goto exit_port;
+
+               dd->irq_enabled = 1;
+       }
+
+       platform_set_drvdata(pdev, pp);
+
+       dev_info(_dev, "attached parallel port driver\n");
+       parport_announce_port(pp);
+
+       return 0;
+
+ exit_port:
+       parport_remove_port(pp);
+ exit_unmap:
+       iounmap(dd->base);
+ exit_res:
+       release_resource(dd->io);
+       kfree(dd->io);
+ exit_mem:
+       kfree(dd);
+       return ret;
+}
+
+static int parport_ax88796_remove(struct platform_device *pdev)
+{
+       struct parport *p = platform_get_drvdata(pdev);
+       struct ax_drvdata *dd = pp_to_drv(p);
+
+       free_irq(p->irq, p);
+       parport_remove_port(p);
+       iounmap(dd->base);
+       release_resource(dd->io);
+       kfree(dd->io);
+       kfree(dd);
+
+       return 0;
+}
+
+#ifdef CONFIG_PM
+
+static int parport_ax88796_suspend(struct platform_device *dev,
+                                  pm_message_t state)
+{
+       struct parport *p = platform_get_drvdata(dev);
+       struct ax_drvdata *dd = pp_to_drv(p);
+
+       parport_ax88796_save_state(p, &dd->suspend);
+       writeb(AX_CPR_nDOE | AX_CPR_STRB, dd->spp_cpr);
+       return 0;
+}
+
+static int parport_ax88796_resume(struct platform_device *dev)
+{
+       struct parport *p = platform_get_drvdata(dev);
+       struct ax_drvdata *dd = pp_to_drv(p);
+
+       parport_ax88796_restore_state(p, &dd->suspend);
+       return 0;
+}
+
+#else
+#define parport_ax88796_suspend NULL
+#define parport_ax88796_resume  NULL
+#endif
+
+static struct platform_driver axdrv = {
+       .driver         = {
+               .name   = "ax88796-pp",
+               .owner  = THIS_MODULE,
+       },
+       .probe          = parport_ax88796_probe,
+       .remove         = parport_ax88796_remove,
+       .suspend        = parport_ax88796_suspend,
+       .resume         = parport_ax88796_resume,
+};
+
+static int __init parport_ax88796_init(void)
+{
+       return platform_driver_register(&axdrv);
+}
+
+static void __exit parport_ax88796_exit(void)
+{
+       platform_driver_unregister(&axdrv);
+}
+
+module_init(parport_ax88796_init)
+module_exit(parport_ax88796_exit)
+
+MODULE_AUTHOR("Ben Dooks <ben@simtec.co.uk>");
+MODULE_DESCRIPTION("AX88796 Parport parallel port driver");
+MODULE_LICENSE("GPL");
index d42737e..5bf321e 100644 (file)
@@ -127,6 +127,10 @@ struct amiga_parport_state {
        unsigned char statusdir;/* ciab.ddrb & 7 */
 };
 
+struct ax88796_parport_state {
+       unsigned char cpr;
+};
+
 struct ip32_parport_state {
        unsigned int dcr;
        unsigned int ecr;
@@ -138,6 +142,7 @@ struct parport_state {
                /* ARC has no state. */
                struct ax_parport_state ax;
                struct amiga_parport_state amiga;
+               struct ax88796_parport_state ax88796;
                /* Atari has not state. */
                struct ip32_parport_state ip32;
                void *misc;