git.oblomov.eu Git - linux-2.6/blob - drivers/parport/parport_sunbpp.c

   1 /* $Id: parport_sunbpp.c,v 1.12 2001/05/26 03:01:42 davem Exp $
   2  * Parallel-port routines for Sun architecture
   3  *
   4  * Author: Derrick J. Brashear <shadow@dementia.org>
   5  *
   6  * based on work by:
   7  *          Phil Blundell <philb@gnu.org>
   8  *          Tim Waugh <tim@cyberelk.demon.co.uk>
   9  *          Jose Renau <renau@acm.org>
  10  *          David Campbell <campbell@tirian.che.curtin.edu.au>
  11  *          Grant Guenther <grant@torque.net>
  12  *          Eddie C. Dost <ecd@skynet.be>
  13  *          Stephen Williams (steve@icarus.com)
  14  *          Gus Baldauf (gbaldauf@ix.netcom.com)
  15  *          Peter Zaitcev
  16  *          Tom Dyas
  17  */
  18
  19 #include <linux/string.h>
  20 #include <linux/module.h>
  21 #include <linux/delay.h>
  22 #include <linux/errno.h>
  23 #include <linux/ioport.h>
  24 #include <linux/kernel.h>
  25 #include <linux/slab.h>
  26 #include <linux/init.h>
  27
  28 #include <linux/parport.h>
  29
  30 #include <asm/ptrace.h>
  31 #include <linux/interrupt.h>
  32
  33 #include <asm/io.h>
  34 #include <asm/oplib.h>           /* OpenProm Library */
  35 #include <asm/sbus.h>
  36 #include <asm/dma.h>             /* BPP uses LSI 64854 for DMA */
  37 #include <asm/irq.h>
  38 #include <asm/sunbpp.h>
  39
  40 #undef __SUNBPP_DEBUG
  41 #ifdef __SUNBPP_DEBUG
  42 #define dprintk(x) printk x
  43 #else
  44 #define dprintk(x)
  45 #endif
  46
  47 static irqreturn_t parport_sunbpp_interrupt(int irq, void *dev_id, struct pt_regs *regs)
  48 {
  49         parport_generic_irq(irq, (struct parport *) dev_id, regs);
  50         return IRQ_HANDLED;
  51 }
  52
  53 static void parport_sunbpp_disable_irq(struct parport *p)
  54 {
  55         struct bpp_regs __iomem *regs = (struct bpp_regs __iomem *)p->base;
  56         u32 tmp;
  57
  58         tmp = sbus_readl(&regs->p_csr);
  59         tmp &= ~DMA_INT_ENAB;
  60         sbus_writel(tmp, &regs->p_csr);
  61 }
  62
  63 static void parport_sunbpp_enable_irq(struct parport *p)
  64 {
  65         struct bpp_regs __iomem *regs = (struct bpp_regs __iomem *)p->base;
  66         u32 tmp;
  67
  68         tmp = sbus_readl(&regs->p_csr);
  69         tmp |= DMA_INT_ENAB;
  70         sbus_writel(tmp, &regs->p_csr);
  71 }
  72
  73 static void parport_sunbpp_write_data(struct parport *p, unsigned char d)
  74 {
  75         struct bpp_regs __iomem *regs = (struct bpp_regs __iomem *)p->base;
  76
  77         sbus_writeb(d, &regs->p_dr);
  78         dprintk((KERN_DEBUG "wrote 0x%x\n", d));
  79 }
  80
  81 static unsigned char parport_sunbpp_read_data(struct parport *p)
  82 {
  83         struct bpp_regs __iomem *regs = (struct bpp_regs __iomem *)p->base;
  84
  85         return sbus_readb(&regs->p_dr);
  86 }
  87
  88 #if 0
  89 static void control_pc_to_sunbpp(struct parport *p, unsigned char status)
  90 {
  91         struct bpp_regs __iomem *regs = (struct bpp_regs __iomem *)p->base;
  92         unsigned char value_tcr = sbus_readb(&regs->p_tcr);
  93         unsigned char value_or = sbus_readb(&regs->p_or);
  94
  95         if (status & PARPORT_CONTROL_STROBE)
  96                 value_tcr |= P_TCR_DS;
  97         if (status & PARPORT_CONTROL_AUTOFD)
  98                 value_or |= P_OR_AFXN;
  99         if (status & PARPORT_CONTROL_INIT)
 100                 value_or |= P_OR_INIT;
 101         if (status & PARPORT_CONTROL_SELECT)
 102                 value_or |= P_OR_SLCT_IN;
 103
 104         sbus_writeb(value_or, &regs->p_or);
 105         sbus_writeb(value_tcr, &regs->p_tcr);
 106 }
 107 #endif
 108
 109 static unsigned char status_sunbpp_to_pc(struct parport *p)
 110 {
 111         struct bpp_regs __iomem *regs = (struct bpp_regs __iomem *)p->base;
 112         unsigned char bits = 0;
 113         unsigned char value_tcr = sbus_readb(&regs->p_tcr);
 114         unsigned char value_ir = sbus_readb(&regs->p_ir);
 115
 116         if (!(value_ir & P_IR_ERR))
 117                 bits |= PARPORT_STATUS_ERROR;
 118         if (!(value_ir & P_IR_SLCT))
 119                 bits |= PARPORT_STATUS_SELECT;
 120         if (!(value_ir & P_IR_PE))
 121                 bits |= PARPORT_STATUS_PAPEROUT;
 122         if (value_tcr & P_TCR_ACK)
 123                 bits |= PARPORT_STATUS_ACK;
 124         if (!(value_tcr & P_TCR_BUSY))
 125                 bits |= PARPORT_STATUS_BUSY;
 126
 127         dprintk((KERN_DEBUG "tcr 0x%x ir 0x%x\n", regs->p_tcr, regs->p_ir));
 128         dprintk((KERN_DEBUG "read status 0x%x\n", bits));
 129         return bits;
 130 }
 131
 132 static unsigned char control_sunbpp_to_pc(struct parport *p)
 133 {
 134         struct bpp_regs __iomem *regs = (struct bpp_regs __iomem *)p->base;
 135         unsigned char bits = 0;
 136         unsigned char value_tcr = sbus_readb(&regs->p_tcr);
 137         unsigned char value_or = sbus_readb(&regs->p_or);
 138
 139         if (!(value_tcr & P_TCR_DS))
 140                 bits |= PARPORT_CONTROL_STROBE;
 141         if (!(value_or & P_OR_AFXN))
 142                 bits |= PARPORT_CONTROL_AUTOFD;
 143         if (!(value_or & P_OR_INIT))
 144                 bits |= PARPORT_CONTROL_INIT;
 145         if (value_or & P_OR_SLCT_IN)
 146                 bits |= PARPORT_CONTROL_SELECT;
 147
 148         dprintk((KERN_DEBUG "tcr 0x%x or 0x%x\n", regs->p_tcr, regs->p_or));
 149         dprintk((KERN_DEBUG "read control 0x%x\n", bits));
 150         return bits;
 151 }
 152
 153 static unsigned char parport_sunbpp_read_control(struct parport *p)
 154 {
 155         return control_sunbpp_to_pc(p);
 156 }
 157
 158 static unsigned char parport_sunbpp_frob_control(struct parport *p,
 159                                                  unsigned char mask,
 160                                                  unsigned char val)
 161 {
 162         struct bpp_regs __iomem *regs = (struct bpp_regs __iomem *)p->base;
 163         unsigned char value_tcr = sbus_readb(&regs->p_tcr);
 164         unsigned char value_or = sbus_readb(&regs->p_or);
 165
 166         dprintk((KERN_DEBUG "frob1: tcr 0x%x or 0x%x\n", regs->p_tcr, regs->p_or));
 167         if (mask & PARPORT_CONTROL_STROBE) {
 168                 if (val & PARPORT_CONTROL_STROBE) {
 169                         value_tcr &= ~P_TCR_DS;
 170                 } else {
 171                         value_tcr |= P_TCR_DS;
 172                 }
 173         }
 174         if (mask & PARPORT_CONTROL_AUTOFD) {
 175                 if (val & PARPORT_CONTROL_AUTOFD) {
 176                         value_or &= ~P_OR_AFXN;
 177                 } else {
 178                         value_or |= P_OR_AFXN;
 179                 }
 180         }
 181         if (mask & PARPORT_CONTROL_INIT) {
 182                 if (val & PARPORT_CONTROL_INIT) {
 183                         value_or &= ~P_OR_INIT;
 184                 } else {
 185                         value_or |= P_OR_INIT;
 186                 }
 187         }
 188         if (mask & PARPORT_CONTROL_SELECT) {
 189                 if (val & PARPORT_CONTROL_SELECT) {
 190                         value_or |= P_OR_SLCT_IN;
 191                 } else {
 192                         value_or &= ~P_OR_SLCT_IN;
 193                 }
 194         }
 195
 196         sbus_writeb(value_or, &regs->p_or);
 197         sbus_writeb(value_tcr, &regs->p_tcr);
 198         dprintk((KERN_DEBUG "frob2: tcr 0x%x or 0x%x\n", regs->p_tcr, regs->p_or));
 199         return parport_sunbpp_read_control(p);
 200 }
 201
 202 static void parport_sunbpp_write_control(struct parport *p, unsigned char d)
 203 {
 204         const unsigned char wm = (PARPORT_CONTROL_STROBE |
 205                                   PARPORT_CONTROL_AUTOFD |
 206                                   PARPORT_CONTROL_INIT |
 207                                   PARPORT_CONTROL_SELECT);
 208
 209         parport_sunbpp_frob_control (p, wm, d & wm);
 210 }
 211
 212 static unsigned char parport_sunbpp_read_status(struct parport *p)
 213 {
 214         return status_sunbpp_to_pc(p);
 215 }
 216
 217 static void parport_sunbpp_data_forward (struct parport *p)
 218 {
 219         struct bpp_regs __iomem *regs = (struct bpp_regs __iomem *)p->base;
 220         unsigned char value_tcr = sbus_readb(&regs->p_tcr);
 221
 222         dprintk((KERN_DEBUG "forward\n"));
 223         value_tcr &= ~P_TCR_DIR;
 224         sbus_writeb(value_tcr, &regs->p_tcr);
 225 }
 226
 227 static void parport_sunbpp_data_reverse (struct parport *p)
 228 {
 229         struct bpp_regs __iomem *regs = (struct bpp_regs __iomem *)p->base;
 230         u8 val = sbus_readb(&regs->p_tcr);
 231
 232         dprintk((KERN_DEBUG "reverse\n"));
 233         val |= P_TCR_DIR;
 234         sbus_writeb(val, &regs->p_tcr);
 235 }
 236
 237 static void parport_sunbpp_init_state(struct pardevice *dev, struct parport_state *s)
 238 {
 239         s->u.pc.ctr = 0xc;
 240         s->u.pc.ecr = 0x0;
 241 }
 242
 243 static void parport_sunbpp_save_state(struct parport *p, struct parport_state *s)
 244 {
 245         s->u.pc.ctr = parport_sunbpp_read_control(p);
 246 }
 247
 248 static void parport_sunbpp_restore_state(struct parport *p, struct parport_state *s)
 249 {
 250         parport_sunbpp_write_control(p, s->u.pc.ctr);
 251 }
 252
 253 static struct parport_operations parport_sunbpp_ops =
 254 {
 255         .write_data     = parport_sunbpp_write_data,
 256         .read_data      = parport_sunbpp_read_data,
 257
 258         .write_control  = parport_sunbpp_write_control,
 259         .read_control   = parport_sunbpp_read_control,
 260         .frob_control   = parport_sunbpp_frob_control,
 261
 262         .read_status    = parport_sunbpp_read_status,
 263
 264         .enable_irq     = parport_sunbpp_enable_irq,
 265         .disable_irq    = parport_sunbpp_disable_irq,
 266
 267         .data_forward   = parport_sunbpp_data_forward,
 268         .data_reverse   = parport_sunbpp_data_reverse,
 269
 270         .init_state     = parport_sunbpp_init_state,
 271         .save_state     = parport_sunbpp_save_state,
 272         .restore_state  = parport_sunbpp_restore_state,
 273
 274         .epp_write_data = parport_ieee1284_epp_write_data,
 275         .epp_read_data  = parport_ieee1284_epp_read_data,
 276         .epp_write_addr = parport_ieee1284_epp_write_addr,
 277         .epp_read_addr  = parport_ieee1284_epp_read_addr,
 278
 279         .ecp_write_data = parport_ieee1284_ecp_write_data,
 280         .ecp_read_data  = parport_ieee1284_ecp_read_data,
 281         .ecp_write_addr = parport_ieee1284_ecp_write_addr,
 282
 283         .compat_write_data      = parport_ieee1284_write_compat,
 284         .nibble_read_data       = parport_ieee1284_read_nibble,
 285         .byte_read_data         = parport_ieee1284_read_byte,
 286
 287         .owner          = THIS_MODULE,
 288 };
 289
 290 typedef struct {
 291         struct list_head list;
 292         struct parport *port;
 293 } Node;
 294 /* no locks, everything's serialized */
 295 static LIST_HEAD(port_list);
 296
 297 static int __init init_one_port(struct sbus_dev *sdev)
 298 {
 299         struct parport *p;
 300         /* at least in theory there may be a "we don't dma" case */
 301         struct parport_operations *ops;
 302         void __iomem *base;
 303         int irq, dma, err = 0, size;
 304         struct bpp_regs __iomem *regs;
 305         unsigned char value_tcr;
 306         Node *node;
 307
 308         dprintk((KERN_DEBUG "init_one_port(%p): ranges, alloc_io, ", sdev));
 309         node = kmalloc(sizeof(Node), GFP_KERNEL);
 310         if (!node)
 311                 goto out0;
 312
 313         irq = sdev->irqs[0];
 314         base = sbus_ioremap(&sdev->resource[0], 0,
 315                             sdev->reg_addrs[0].reg_size,
 316                             "sunbpp");
 317         if (!base)
 318                 goto out1;
 319
 320         size = sdev->reg_addrs[0].reg_size;
 321         dma = PARPORT_DMA_NONE;
 322
 323         dprintk(("alloc(ppops), "));
 324         ops = kmalloc (sizeof (struct parport_operations), GFP_KERNEL);
 325         if (!ops)
 326                 goto out2;
 327
 328         memcpy (ops, &parport_sunbpp_ops, sizeof (struct parport_operations));
 329
 330         dprintk(("register_port\n"));
 331         if (!(p = parport_register_port((unsigned long)base, irq, dma, ops)))
 332                 goto out3;
 333
 334         p->size = size;
 335
 336         dprintk((KERN_DEBUG "init_one_port: request_irq(%08x:%p:%x:%s:%p) ",
 337                 p->irq, parport_sunbpp_interrupt, SA_SHIRQ, p->name, p));
 338         if ((err = request_irq(p->irq, parport_sunbpp_interrupt,
 339                                SA_SHIRQ, p->name, p)) != 0) {
 340                 dprintk(("ERROR %d\n", err));
 341                 goto out4;
 342         }
 343         dprintk(("OK\n"));
 344         parport_sunbpp_enable_irq(p);
 345
 346         regs = (struct bpp_regs __iomem *)p->base;
 347         dprintk((KERN_DEBUG "forward\n"));
 348         value_tcr = sbus_readb(&regs->p_tcr);
 349         value_tcr &= ~P_TCR_DIR;
 350         sbus_writeb(value_tcr, &regs->p_tcr);
 351
 352         printk(KERN_INFO "%s: sunbpp at 0x%lx\n", p->name, p->base);
 353         node->port = p;
 354         list_add(&node->list, &port_list);
 355         parport_announce_port (p);
 356
 357         return 1;
 358
 359 out4:
 360         parport_put_port(p);
 361 out3:
 362         kfree(ops);
 363 out2:
 364         sbus_iounmap(base, size);
 365 out1:
 366         kfree(node);
 367 out0:
 368         return err;
 369 }
 370
 371 static int __init parport_sunbpp_init(void)
 372 {
 373         struct sbus_bus *sbus;
 374         struct sbus_dev *sdev;
 375         int count = 0;
 376
 377         for_each_sbus(sbus) {
 378                 for_each_sbusdev(sdev, sbus) {
 379                         if (!strcmp(sdev->prom_name, "SUNW,bpp"))
 380                                 count += init_one_port(sdev);
 381                 }
 382         }
 383         return count ? 0 : -ENODEV;
 384 }
 385
 386 static void __exit parport_sunbpp_exit(void)
 387 {
 388         while (!list_empty(&port_list)) {
 389                 Node *node = list_entry(port_list.next, Node, list);
 390                 struct parport *p = node->port;
 391                 struct parport_operations *ops = p->ops;
 392                 parport_remove_port(p);
 393
 394                 if (p->irq != PARPORT_IRQ_NONE) {
 395                         parport_sunbpp_disable_irq(p);
 396                         free_irq(p->irq, p);
 397                 }
 398                 sbus_iounmap((void __iomem *)p->base, p->size);
 399                 parport_put_port(p);
 400                 kfree (ops);
 401                 list_del(&node->list);
 402                 kfree (node);
 403         }
 404 }
 405
 406 MODULE_AUTHOR("Derrick J Brashear");
 407 MODULE_DESCRIPTION("Parport Driver for Sparc bidirectional Port");
 408 MODULE_SUPPORTED_DEVICE("Sparc Bidirectional Parallel Port");
 409 MODULE_LICENSE("GPL");
 410
 411 module_init(parport_sunbpp_init)
 412 module_exit(parport_sunbpp_exit)