Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / drivers / parport / parport_gsc.c
diff --git a/kernel/drivers/parport/parport_gsc.c b/kernel/drivers/parport/parport_gsc.c
new file mode 100644 (file)
index 0000000..6e3a60c
--- /dev/null
@@ -0,0 +1,431 @@
+/*
+ *      Low-level parallel-support for PC-style hardware integrated in the 
+ *     LASI-Controller (on GSC-Bus) for HP-PARISC Workstations
+ *
+ *     This program is free software; you can redistribute it and/or modify
+ *     it under the terms of the GNU General Public License as published by
+ *      the Free Software Foundation; either version 2 of the License, or
+ *      (at your option) any later version.
+ *
+ *     (C) 1999-2001 by Helge Deller <deller@gmx.de>
+ *
+ * 
+ * based on parport_pc.c by 
+ *         Grant Guenther <grant@torque.net>
+ *         Phil Blundell <philb@gnu.org>
+ *          Tim Waugh <tim@cyberelk.demon.co.uk>
+ *         Jose Renau <renau@acm.org>
+ *          David Campbell
+ *          Andrea Arcangeli
+ */
+
+#undef DEBUG   /* undef for production */
+
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/delay.h>
+#include <linux/errno.h>
+#include <linux/interrupt.h>
+#include <linux/ioport.h>
+#include <linux/kernel.h>
+#include <linux/slab.h>
+#include <linux/pci.h>
+#include <linux/sysctl.h>
+
+#include <asm/io.h>
+#include <asm/dma.h>
+#include <asm/uaccess.h>
+#include <asm/superio.h>
+
+#include <linux/parport.h>
+#include <asm/pdc.h>
+#include <asm/parisc-device.h>
+#include <asm/hardware.h>
+#include "parport_gsc.h"
+
+
+MODULE_AUTHOR("Helge Deller <deller@gmx.de>");
+MODULE_DESCRIPTION("HP-PARISC PC-style parallel port driver");
+MODULE_SUPPORTED_DEVICE("integrated PC-style parallel port");
+MODULE_LICENSE("GPL");
+
+
+/*
+ * Clear TIMEOUT BIT in EPP MODE
+ *
+ * This is also used in SPP detection.
+ */
+static int clear_epp_timeout(struct parport *pb)
+{
+       unsigned char r;
+
+       if (!(parport_gsc_read_status(pb) & 0x01))
+               return 1;
+
+       /* To clear timeout some chips require double read */
+       parport_gsc_read_status(pb);
+       r = parport_gsc_read_status(pb);
+       parport_writeb (r | 0x01, STATUS (pb)); /* Some reset by writing 1 */
+       parport_writeb (r & 0xfe, STATUS (pb)); /* Others by writing 0 */
+       r = parport_gsc_read_status(pb);
+
+       return !(r & 0x01);
+}
+
+/*
+ * Access functions.
+ *
+ * Most of these aren't static because they may be used by the
+ * parport_xxx_yyy macros.  extern __inline__ versions of several
+ * of these are in parport_gsc.h.
+ */
+
+void parport_gsc_init_state(struct pardevice *dev, struct parport_state *s)
+{
+       s->u.pc.ctr = 0xc | (dev->irq_func ? 0x10 : 0x0);
+}
+
+void parport_gsc_save_state(struct parport *p, struct parport_state *s)
+{
+       s->u.pc.ctr = parport_readb (CONTROL (p));
+}
+
+void parport_gsc_restore_state(struct parport *p, struct parport_state *s)
+{
+       parport_writeb (s->u.pc.ctr, CONTROL (p));
+}
+
+struct parport_operations parport_gsc_ops = 
+{
+       .write_data     = parport_gsc_write_data,
+       .read_data      = parport_gsc_read_data,
+
+       .write_control  = parport_gsc_write_control,
+       .read_control   = parport_gsc_read_control,
+       .frob_control   = parport_gsc_frob_control,
+
+       .read_status    = parport_gsc_read_status,
+
+       .enable_irq     = parport_gsc_enable_irq,
+       .disable_irq    = parport_gsc_disable_irq,
+
+       .data_forward   = parport_gsc_data_forward,
+       .data_reverse   = parport_gsc_data_reverse,
+
+       .init_state     = parport_gsc_init_state,
+       .save_state     = parport_gsc_save_state,
+       .restore_state  = parport_gsc_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,
+};
+
+/* --- Mode detection ------------------------------------- */
+
+/*
+ * Checks for port existence, all ports support SPP MODE
+ */
+static int parport_SPP_supported(struct parport *pb)
+{
+       unsigned char r, w;
+
+       /*
+        * first clear an eventually pending EPP timeout 
+        * I (sailer@ife.ee.ethz.ch) have an SMSC chipset
+        * that does not even respond to SPP cycles if an EPP
+        * timeout is pending
+        */
+       clear_epp_timeout(pb);
+
+       /* Do a simple read-write test to make sure the port exists. */
+       w = 0xc;
+       parport_writeb (w, CONTROL (pb));
+
+       /* Is there a control register that we can read from?  Some
+        * ports don't allow reads, so read_control just returns a
+        * software copy. Some ports _do_ allow reads, so bypass the
+        * software copy here.  In addition, some bits aren't
+        * writable. */
+       r = parport_readb (CONTROL (pb));
+       if ((r & 0xf) == w) {
+               w = 0xe;
+               parport_writeb (w, CONTROL (pb));
+               r = parport_readb (CONTROL (pb));
+               parport_writeb (0xc, CONTROL (pb));
+               if ((r & 0xf) == w)
+                       return PARPORT_MODE_PCSPP;
+       }
+
+       /* Try the data register.  The data lines aren't tri-stated at
+        * this stage, so we expect back what we wrote. */
+       w = 0xaa;
+       parport_gsc_write_data (pb, w);
+       r = parport_gsc_read_data (pb);
+       if (r == w) {
+               w = 0x55;
+               parport_gsc_write_data (pb, w);
+               r = parport_gsc_read_data (pb);
+               if (r == w)
+                       return PARPORT_MODE_PCSPP;
+       }
+
+       return 0;
+}
+
+/* Detect PS/2 support.
+ *
+ * Bit 5 (0x20) sets the PS/2 data direction; setting this high
+ * allows us to read data from the data lines.  In theory we would get back
+ * 0xff but any peripheral attached to the port may drag some or all of the
+ * lines down to zero.  So if we get back anything that isn't the contents
+ * of the data register we deem PS/2 support to be present. 
+ *
+ * Some SPP ports have "half PS/2" ability - you can't turn off the line
+ * drivers, but an external peripheral with sufficiently beefy drivers of
+ * its own can overpower them and assert its own levels onto the bus, from
+ * where they can then be read back as normal.  Ports with this property
+ * and the right type of device attached are likely to fail the SPP test,
+ * (as they will appear to have stuck bits) and so the fact that they might
+ * be misdetected here is rather academic. 
+ */
+
+static int parport_PS2_supported(struct parport *pb)
+{
+       int ok = 0;
+  
+       clear_epp_timeout(pb);
+
+       /* try to tri-state the buffer */
+       parport_gsc_data_reverse (pb);
+       
+       parport_gsc_write_data(pb, 0x55);
+       if (parport_gsc_read_data(pb) != 0x55) ok++;
+
+       parport_gsc_write_data(pb, 0xaa);
+       if (parport_gsc_read_data(pb) != 0xaa) ok++;
+
+       /* cancel input mode */
+       parport_gsc_data_forward (pb);
+
+       if (ok) {
+               pb->modes |= PARPORT_MODE_TRISTATE;
+       } else {
+               struct parport_gsc_private *priv = pb->private_data;
+               priv->ctr_writable &= ~0x20;
+       }
+
+       return ok;
+}
+
+
+/* --- Initialisation code -------------------------------- */
+
+struct parport *parport_gsc_probe_port(unsigned long base,
+                                      unsigned long base_hi, int irq,
+                                      int dma, struct parisc_device *padev)
+{
+       struct parport_gsc_private *priv;
+       struct parport_operations *ops;
+       struct parport tmp;
+       struct parport *p = &tmp;
+
+       priv = kzalloc (sizeof (struct parport_gsc_private), GFP_KERNEL);
+       if (!priv) {
+               printk (KERN_DEBUG "parport (0x%lx): no memory!\n", base);
+               return NULL;
+       }
+       ops = kmemdup(&parport_gsc_ops, sizeof(struct parport_operations),
+                     GFP_KERNEL);
+       if (!ops) {
+               printk (KERN_DEBUG "parport (0x%lx): no memory for ops!\n",
+                       base);
+               kfree (priv);
+               return NULL;
+       }
+       priv->ctr = 0xc;
+       priv->ctr_writable = 0xff;
+       priv->dma_buf = 0;
+       priv->dma_handle = 0;
+       p->base = base;
+       p->base_hi = base_hi;
+       p->irq = irq;
+       p->dma = dma;
+       p->modes = PARPORT_MODE_PCSPP | PARPORT_MODE_SAFEININT;
+       p->ops = ops;
+       p->private_data = priv;
+       p->physport = p;
+       if (!parport_SPP_supported (p)) {
+               /* No port. */
+               kfree (priv);
+               kfree(ops);
+               return NULL;
+       }
+       parport_PS2_supported (p);
+
+       if (!(p = parport_register_port(base, PARPORT_IRQ_NONE,
+                                       PARPORT_DMA_NONE, ops))) {
+               kfree (priv);
+               kfree (ops);
+               return NULL;
+       }
+
+       p->dev = &padev->dev;
+       p->base_hi = base_hi;
+       p->modes = tmp.modes;
+       p->size = (p->modes & PARPORT_MODE_EPP)?8:3;
+       p->private_data = priv;
+
+       printk(KERN_INFO "%s: PC-style at 0x%lx", p->name, p->base);
+       p->irq = irq;
+       if (p->irq == PARPORT_IRQ_AUTO) {
+               p->irq = PARPORT_IRQ_NONE;
+       }
+       if (p->irq != PARPORT_IRQ_NONE) {
+               printk(", irq %d", p->irq);
+
+               if (p->dma == PARPORT_DMA_AUTO) {
+                       p->dma = PARPORT_DMA_NONE;
+               }
+       }
+       if (p->dma == PARPORT_DMA_AUTO) /* To use DMA, giving the irq
+                                           is mandatory (see above) */
+               p->dma = PARPORT_DMA_NONE;
+
+       printk(" [");
+#define printmode(x) {if(p->modes&PARPORT_MODE_##x){printk("%s%s",f?",":"",#x);f++;}}
+       {
+               int f = 0;
+               printmode(PCSPP);
+               printmode(TRISTATE);
+               printmode(COMPAT)
+               printmode(EPP);
+//             printmode(ECP);
+//             printmode(DMA);
+       }
+#undef printmode
+       printk("]\n");
+
+       if (p->irq != PARPORT_IRQ_NONE) {
+               if (request_irq (p->irq, parport_irq_handler,
+                                0, p->name, p)) {
+                       printk (KERN_WARNING "%s: irq %d in use, "
+                               "resorting to polled operation\n",
+                               p->name, p->irq);
+                       p->irq = PARPORT_IRQ_NONE;
+                       p->dma = PARPORT_DMA_NONE;
+               }
+       }
+
+       /* Done probing.  Now put the port into a sensible start-up state. */
+
+       parport_gsc_write_data(p, 0);
+       parport_gsc_data_forward (p);
+
+       /* Now that we've told the sharing engine about the port, and
+          found out its characteristics, let the high-level drivers
+          know about it. */
+       parport_announce_port (p);
+
+       return p;
+}
+
+
+#define PARPORT_GSC_OFFSET 0x800
+
+static int parport_count;
+
+static int parport_init_chip(struct parisc_device *dev)
+{
+       struct parport *p;
+       unsigned long port;
+
+       if (!dev->irq) {
+               printk(KERN_WARNING "IRQ not found for parallel device at 0x%llx\n",
+                       (unsigned long long)dev->hpa.start);
+               return -ENODEV;
+       }
+
+       port = dev->hpa.start + PARPORT_GSC_OFFSET;
+       
+       /* some older machines with ASP-chip don't support
+        * the enhanced parport modes.
+        */
+       if (boot_cpu_data.cpu_type > pcxt && !pdc_add_valid(port+4)) {
+
+               /* Initialize bidirectional-mode (0x10) & data-tranfer-mode #1 (0x20) */
+               printk("%s: initialize bidirectional-mode.\n", __func__);
+               parport_writeb ( (0x10 + 0x20), port + 4);
+
+       } else {
+               printk("%s: enhanced parport-modes not supported.\n", __func__);
+       }
+       
+       p = parport_gsc_probe_port(port, 0, dev->irq,
+                       /* PARPORT_IRQ_NONE */ PARPORT_DMA_NONE, dev);
+       if (p)
+               parport_count++;
+       dev_set_drvdata(&dev->dev, p);
+
+       return 0;
+}
+
+static int parport_remove_chip(struct parisc_device *dev)
+{
+       struct parport *p = dev_get_drvdata(&dev->dev);
+       if (p) {
+               struct parport_gsc_private *priv = p->private_data;
+               struct parport_operations *ops = p->ops;
+               parport_remove_port(p);
+               if (p->dma != PARPORT_DMA_NONE)
+                       free_dma(p->dma);
+               if (p->irq != PARPORT_IRQ_NONE)
+                       free_irq(p->irq, p);
+               if (priv->dma_buf)
+                       pci_free_consistent(priv->dev, PAGE_SIZE,
+                                           priv->dma_buf,
+                                           priv->dma_handle);
+               kfree (p->private_data);
+               parport_put_port(p);
+               kfree (ops); /* hope no-one cached it */
+       }
+       return 0;
+}
+
+static struct parisc_device_id parport_tbl[] = {
+       { HPHW_FIO, HVERSION_REV_ANY_ID, HVERSION_ANY_ID, 0x74 },
+       { 0, }
+};
+
+MODULE_DEVICE_TABLE(parisc, parport_tbl);
+
+static struct parisc_driver parport_driver = {
+       .name           = "Parallel",
+       .id_table       = parport_tbl,
+       .probe          = parport_init_chip,
+       .remove         = parport_remove_chip,
+};
+
+int parport_gsc_init(void)
+{
+       return register_parisc_driver(&parport_driver);
+}
+
+static void parport_gsc_exit(void)
+{
+       unregister_parisc_driver(&parport_driver);
+}
+
+module_init(parport_gsc_init);
+module_exit(parport_gsc_exit);