SAFE public projects git trees. - safe/jmp/linux-2.6/blob - arch/arm/kernel/ecard.c

   1 /*
   2  *  linux/arch/arm/kernel/ecard.c
   3  *
   4  *  Copyright 1995-2001 Russell King
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License version 2 as
   8  * published by the Free Software Foundation.
   9  *
  10  *  Find all installed expansion cards, and handle interrupts from them.
  11  *
  12  *  Created from information from Acorns RiscOS3 PRMs
  13  *
  14  *  08-Dec-1996 RMK     Added code for the 9'th expansion card - the ether
  15  *                      podule slot.
  16  *  06-May-1997 RMK     Added blacklist for cards whose loader doesn't work.
  17  *  12-Sep-1997 RMK     Created new handling of interrupt enables/disables
  18  *                      - cards can now register their own routine to control
  19  *                      interrupts (recommended).
  20  *  29-Sep-1997 RMK     Expansion card interrupt hardware not being re-enabled
  21  *                      on reset from Linux. (Caused cards not to respond
  22  *                      under RiscOS without hard reset).
  23  *  15-Feb-1998 RMK     Added DMA support
  24  *  12-Sep-1998 RMK     Added EASI support
  25  *  10-Jan-1999 RMK     Run loaders in a simulated RISC OS environment.
  26  *  17-Apr-1999 RMK     Support for EASI Type C cycles.
  27  */
  28 #define ECARD_C
  29
  30 #include <linux/config.h>
  31 #include <linux/module.h>
  32 #include <linux/kernel.h>
  33 #include <linux/types.h>
  34 #include <linux/sched.h>
  35 #include <linux/interrupt.h>
  36 #include <linux/completion.h>
  37 #include <linux/reboot.h>
  38 #include <linux/mm.h>
  39 #include <linux/slab.h>
  40 #include <linux/proc_fs.h>
  41 #include <linux/device.h>
  42 #include <linux/init.h>
  43
  44 #include <asm/dma.h>
  45 #include <asm/ecard.h>
  46 #include <asm/hardware.h>
  47 #include <asm/io.h>
  48 #include <asm/irq.h>
  49 #include <asm/mmu_context.h>
  50 #include <asm/mach/irq.h>
  51 #include <asm/tlbflush.h>
  52
  53 #ifndef CONFIG_ARCH_RPC
  54 #define HAVE_EXPMASK
  55 #endif
  56
  57 struct ecard_request {
  58         void            (*fn)(struct ecard_request *);
  59         ecard_t         *ec;
  60         unsigned int    address;
  61         unsigned int    length;
  62         unsigned int    use_loader;
  63         void            *buffer;
  64         struct completion *complete;
  65 };
  66
  67 struct expcard_blacklist {
  68         unsigned short   manufacturer;
  69         unsigned short   product;
  70         const char      *type;
  71 };
  72
  73 static ecard_t *cards;
  74 static ecard_t *slot_to_expcard[MAX_ECARDS];
  75 static unsigned int ectcr;
  76 #ifdef HAS_EXPMASK
  77 static unsigned int have_expmask;
  78 #endif
  79
  80 /* List of descriptions of cards which don't have an extended
  81  * identification, or chunk directories containing a description.
  82  */
  83 static struct expcard_blacklist __initdata blacklist[] = {
  84         { MANU_ACORN, PROD_ACORN_ETHER1, "Acorn Ether1" }
  85 };
  86
  87 asmlinkage extern int
  88 ecard_loader_reset(unsigned long base, loader_t loader);
  89 asmlinkage extern int
  90 ecard_loader_read(int off, unsigned long base, loader_t loader);
  91
  92 static inline unsigned short ecard_getu16(unsigned char *v)
  93 {
  94         return v[0] | v[1] << 8;
  95 }
  96
  97 static inline signed long ecard_gets24(unsigned char *v)
  98 {
  99         return v[0] | v[1] << 8 | v[2] << 16 | ((v[2] & 0x80) ? 0xff000000 : 0);
 100 }
 101
 102 static inline ecard_t *slot_to_ecard(unsigned int slot)
 103 {
 104         return slot < MAX_ECARDS ? slot_to_expcard[slot] : NULL;
 105 }
 106
 107 /* ===================== Expansion card daemon ======================== */
 108 /*
 109  * Since the loader programs on the expansion cards need to be run
 110  * in a specific environment, create a separate task with this
 111  * environment up, and pass requests to this task as and when we
 112  * need to.
 113  *
 114  * This should allow 99% of loaders to be called from Linux.
 115  *
 116  * From a security standpoint, we trust the card vendors.  This
 117  * may be a misplaced trust.
 118  */
 119 static void ecard_task_reset(struct ecard_request *req)
 120 {
 121         struct expansion_card *ec = req->ec;
 122         struct resource *res;
 123
 124         res = ec->slot_no == 8
 125                 ? &ec->resource[ECARD_RES_MEMC]
 126                 : ec->type == ECARD_EASI
 127                   ? &ec->resource[ECARD_RES_EASI]
 128                   : &ec->resource[ECARD_RES_IOCSYNC];
 129
 130         ecard_loader_reset(res->start, ec->loader);
 131 }
 132
 133 static void ecard_task_readbytes(struct ecard_request *req)
 134 {
 135         struct expansion_card *ec = req->ec;
 136         unsigned char *buf = req->buffer;
 137         unsigned int len = req->length;
 138         unsigned int off = req->address;
 139
 140         if (ec->slot_no == 8) {
 141                 void __iomem *base = (void __iomem *)
 142                                 ec->resource[ECARD_RES_MEMC].start;
 143
 144                 /*
 145                  * The card maintains an index which increments the address
 146                  * into a 4096-byte page on each access.  We need to keep
 147                  * track of the counter.
 148                  */
 149                 static unsigned int index;
 150                 unsigned int page;
 151
 152                 page = (off >> 12) * 4;
 153                 if (page > 256 * 4)
 154                         return;
 155
 156                 off &= 4095;
 157
 158                 /*
 159                  * If we are reading offset 0, or our current index is
 160                  * greater than the offset, reset the hardware index counter.
 161                  */
 162                 if (off == 0 || index > off) {
 163                         writeb(0, base);
 164                         index = 0;
 165                 }
 166
 167                 /*
 168                  * Increment the hardware index counter until we get to the
 169                  * required offset.  The read bytes are discarded.
 170                  */
 171                 while (index < off) {
 172                         readb(base + page);
 173                         index += 1;
 174                 }
 175
 176                 while (len--) {
 177                         *buf++ = readb(base + page);
 178                         index += 1;
 179                 }
 180         } else {
 181                 unsigned long base = (ec->type == ECARD_EASI
 182                          ? &ec->resource[ECARD_RES_EASI]
 183                          : &ec->resource[ECARD_RES_IOCSYNC])->start;
 184                 void __iomem *pbase = (void __iomem *)base;
 185
 186                 if (!req->use_loader || !ec->loader) {
 187                         off *= 4;
 188                         while (len--) {
 189                                 *buf++ = readb(pbase + off);
 190                                 off += 4;
 191                         }
 192                 } else {
 193                         while(len--) {
 194                                 /*
 195                                  * The following is required by some
 196                                  * expansion card loader programs.
 197                                  */
 198                                 *(unsigned long *)0x108 = 0;
 199                                 *buf++ = ecard_loader_read(off++, base,
 200                                                            ec->loader);
 201                         }
 202                 }
 203         }
 204
 205 }
 206
 207 static DECLARE_WAIT_QUEUE_HEAD(ecard_wait);
 208 static struct ecard_request *ecard_req;
 209 static DECLARE_MUTEX(ecard_sem);
 210
 211 /*
 212  * Set up the expansion card daemon's page tables.
 213  */
 214 static void ecard_init_pgtables(struct mm_struct *mm)
 215 {
 216         struct vm_area_struct vma;
 217
 218         /* We want to set up the page tables for the following mapping:
 219          *  Virtual     Physical
 220          *  0x03000000  0x03000000
 221          *  0x03010000  unmapped
 222          *  0x03210000  0x03210000
 223          *  0x03400000  unmapped
 224          *  0x08000000  0x08000000
 225          *  0x10000000  unmapped
 226          *
 227          * FIXME: we don't follow this 100% yet.
 228          */
 229         pgd_t *src_pgd, *dst_pgd;
 230
 231         src_pgd = pgd_offset(mm, (unsigned long)IO_BASE);
 232         dst_pgd = pgd_offset(mm, IO_START);
 233
 234         memcpy(dst_pgd, src_pgd, sizeof(pgd_t) * (IO_SIZE / PGDIR_SIZE));
 235
 236         src_pgd = pgd_offset(mm, EASI_BASE);
 237         dst_pgd = pgd_offset(mm, EASI_START);
 238
 239         memcpy(dst_pgd, src_pgd, sizeof(pgd_t) * (EASI_SIZE / PGDIR_SIZE));
 240
 241         vma.vm_mm = mm;
 242
 243         flush_tlb_range(&vma, IO_START, IO_START + IO_SIZE);
 244         flush_tlb_range(&vma, EASI_START, EASI_START + EASI_SIZE);
 245 }
 246
 247 static int ecard_init_mm(void)
 248 {
 249         struct mm_struct * mm = mm_alloc();
 250         struct mm_struct *active_mm = current->active_mm;
 251
 252         if (!mm)
 253                 return -ENOMEM;
 254
 255         current->mm = mm;
 256         current->active_mm = mm;
 257         activate_mm(active_mm, mm);
 258         mmdrop(active_mm);
 259         ecard_init_pgtables(mm);
 260         return 0;
 261 }
 262
 263 static int
 264 ecard_task(void * unused)
 265 {
 266         daemonize("kecardd");
 267
 268         /*
 269          * Allocate a mm.  We're not a lazy-TLB kernel task since we need
 270          * to set page table entries where the user space would be.  Note
 271          * that this also creates the page tables.  Failure is not an
 272          * option here.
 273          */
 274         if (ecard_init_mm())
 275                 panic("kecardd: unable to alloc mm\n");
 276
 277         while (1) {
 278                 struct ecard_request *req;
 279
 280                 wait_event_interruptible(ecard_wait, ecard_req != NULL);
 281
 282                 req = xchg(&ecard_req, NULL);
 283                 if (req != NULL) {
 284                         req->fn(req);
 285                         complete(req->complete);
 286                 }
 287         }
 288 }
 289
 290 /*
 291  * Wake the expansion card daemon to action our request.
 292  *
 293  * FIXME: The test here is not sufficient to detect if the
 294  * kcardd is running.
 295  */
 296 static void ecard_call(struct ecard_request *req)
 297 {
 298         DECLARE_COMPLETION(completion);
 299
 300         req->complete = &completion;
 301
 302         down(&ecard_sem);
 303         ecard_req = req;
 304         wake_up(&ecard_wait);
 305
 306         /*
 307          * Now wait for kecardd to run.
 308          */
 309         wait_for_completion(&completion);
 310         up(&ecard_sem);
 311 }
 312
 313 /* ======================= Mid-level card control ===================== */
 314
 315 static void
 316 ecard_readbytes(void *addr, ecard_t *ec, int off, int len, int useld)
 317 {
 318         struct ecard_request req;
 319
 320         req.fn          = ecard_task_readbytes;
 321         req.ec          = ec;
 322         req.address     = off;
 323         req.length      = len;
 324         req.use_loader  = useld;
 325         req.buffer      = addr;
 326
 327         ecard_call(&req);
 328 }
 329
 330 int ecard_readchunk(struct in_chunk_dir *cd, ecard_t *ec, int id, int num)
 331 {
 332         struct ex_chunk_dir excd;
 333         int index = 16;
 334         int useld = 0;
 335
 336         if (!ec->cid.cd)
 337                 return 0;
 338
 339         while(1) {
 340                 ecard_readbytes(&excd, ec, index, 8, useld);
 341                 index += 8;
 342                 if (c_id(&excd) == 0) {
 343                         if (!useld && ec->loader) {
 344                                 useld = 1;
 345                                 index = 0;
 346                                 continue;
 347                         }
 348                         return 0;
 349                 }
 350                 if (c_id(&excd) == 0xf0) { /* link */
 351                         index = c_start(&excd);
 352                         continue;
 353                 }
 354                 if (c_id(&excd) == 0x80) { /* loader */
 355                         if (!ec->loader) {
 356                                 ec->loader = (loader_t)kmalloc(c_len(&excd),
 357                                                                GFP_KERNEL);
 358                                 if (ec->loader)
 359                                         ecard_readbytes(ec->loader, ec,
 360                                                         (int)c_start(&excd),
 361                                                         c_len(&excd), useld);
 362                                 else
 363                                         return 0;
 364                         }
 365                         continue;
 366                 }
 367                 if (c_id(&excd) == id && num-- == 0)
 368                         break;
 369         }
 370
 371         if (c_id(&excd) & 0x80) {
 372                 switch (c_id(&excd) & 0x70) {
 373                 case 0x70:
 374                         ecard_readbytes((unsigned char *)excd.d.string, ec,
 375                                         (int)c_start(&excd), c_len(&excd),
 376                                         useld);
 377                         break;
 378                 case 0x00:
 379                         break;
 380                 }
 381         }
 382         cd->start_offset = c_start(&excd);
 383         memcpy(cd->d.string, excd.d.string, 256);
 384         return 1;
 385 }
 386
 387 /* ======================= Interrupt control ============================ */
 388
 389 static void ecard_def_irq_enable(ecard_t *ec, int irqnr)
 390 {
 391 #ifdef HAS_EXPMASK
 392         if (irqnr < 4 && have_expmask) {
 393                 have_expmask |= 1 << irqnr;
 394                 __raw_writeb(have_expmask, EXPMASK_ENABLE);
 395         }
 396 #endif
 397 }
 398
 399 static void ecard_def_irq_disable(ecard_t *ec, int irqnr)
 400 {
 401 #ifdef HAS_EXPMASK
 402         if (irqnr < 4 && have_expmask) {
 403                 have_expmask &= ~(1 << irqnr);
 404                 __raw_writeb(have_expmask, EXPMASK_ENABLE);
 405         }
 406 #endif
 407 }
 408
 409 static int ecard_def_irq_pending(ecard_t *ec)
 410 {
 411         return !ec->irqmask || readb(ec->irqaddr) & ec->irqmask;
 412 }
 413
 414 static void ecard_def_fiq_enable(ecard_t *ec, int fiqnr)
 415 {
 416         panic("ecard_def_fiq_enable called - impossible");
 417 }
 418
 419 static void ecard_def_fiq_disable(ecard_t *ec, int fiqnr)
 420 {
 421         panic("ecard_def_fiq_disable called - impossible");
 422 }
 423
 424 static int ecard_def_fiq_pending(ecard_t *ec)
 425 {
 426         return !ec->fiqmask || readb(ec->fiqaddr) & ec->fiqmask;
 427 }
 428
 429 static expansioncard_ops_t ecard_default_ops = {
 430         ecard_def_irq_enable,
 431         ecard_def_irq_disable,
 432         ecard_def_irq_pending,
 433         ecard_def_fiq_enable,
 434         ecard_def_fiq_disable,
 435         ecard_def_fiq_pending
 436 };
 437
 438 /*
 439  * Enable and disable interrupts from expansion cards.
 440  * (interrupts are disabled for these functions).
 441  *
 442  * They are not meant to be called directly, but via enable/disable_irq.
 443  */
 444 static void ecard_irq_unmask(unsigned int irqnr)
 445 {
 446         ecard_t *ec = slot_to_ecard(irqnr - 32);
 447
 448         if (ec) {
 449                 if (!ec->ops)
 450                         ec->ops = &ecard_default_ops;
 451
 452                 if (ec->claimed && ec->ops->irqenable)
 453                         ec->ops->irqenable(ec, irqnr);
 454                 else
 455                         printk(KERN_ERR "ecard: rejecting request to "
 456                                 "enable IRQs for %d\n", irqnr);
 457         }
 458 }
 459
 460 static void ecard_irq_mask(unsigned int irqnr)
 461 {
 462         ecard_t *ec = slot_to_ecard(irqnr - 32);
 463
 464         if (ec) {
 465                 if (!ec->ops)
 466                         ec->ops = &ecard_default_ops;
 467
 468                 if (ec->ops && ec->ops->irqdisable)
 469                         ec->ops->irqdisable(ec, irqnr);
 470         }
 471 }
 472
 473 static struct irqchip ecard_chip = {
 474         .ack    = ecard_irq_mask,
 475         .mask   = ecard_irq_mask,
 476         .unmask = ecard_irq_unmask,
 477 };
 478
 479 void ecard_enablefiq(unsigned int fiqnr)
 480 {
 481         ecard_t *ec = slot_to_ecard(fiqnr);
 482
 483         if (ec) {
 484                 if (!ec->ops)
 485                         ec->ops = &ecard_default_ops;
 486
 487                 if (ec->claimed && ec->ops->fiqenable)
 488                         ec->ops->fiqenable(ec, fiqnr);
 489                 else
 490                         printk(KERN_ERR "ecard: rejecting request to "
 491                                 "enable FIQs for %d\n", fiqnr);
 492         }
 493 }
 494
 495 void ecard_disablefiq(unsigned int fiqnr)
 496 {
 497         ecard_t *ec = slot_to_ecard(fiqnr);
 498
 499         if (ec) {
 500                 if (!ec->ops)
 501                         ec->ops = &ecard_default_ops;
 502
 503                 if (ec->ops->fiqdisable)
 504                         ec->ops->fiqdisable(ec, fiqnr);
 505         }
 506 }
 507
 508 static void ecard_dump_irq_state(void)
 509 {
 510         ecard_t *ec;
 511
 512         printk("Expansion card IRQ state:\n");
 513
 514         for (ec = cards; ec; ec = ec->next) {
 515                 if (ec->slot_no == 8)
 516                         continue;
 517
 518                 printk("  %d: %sclaimed, ",
 519                        ec->slot_no, ec->claimed ? "" : "not ");
 520
 521                 if (ec->ops && ec->ops->irqpending &&
 522                     ec->ops != &ecard_default_ops)
 523                         printk("irq %spending\n",
 524                                ec->ops->irqpending(ec) ? "" : "not ");
 525                 else
 526                         printk("irqaddr %p, mask = %02X, status = %02X\n",
 527                                ec->irqaddr, ec->irqmask, readb(ec->irqaddr));
 528         }
 529 }
 530
 531 static void ecard_check_lockup(struct irqdesc *desc)
 532 {
 533         static unsigned long last;
 534         static int lockup;
 535
 536         /*
 537          * If the timer interrupt has not run since the last million
 538          * unrecognised expansion card interrupts, then there is
 539          * something seriously wrong.  Disable the expansion card
 540          * interrupts so at least we can continue.
 541          *
 542          * Maybe we ought to start a timer to re-enable them some time
 543          * later?
 544          */
 545         if (last == jiffies) {
 546                 lockup += 1;
 547                 if (lockup > 1000000) {
 548                         printk(KERN_ERR "\nInterrupt lockup detected - "
 549                                "disabling all expansion card interrupts\n");
 550
 551                         desc->chip->mask(IRQ_EXPANSIONCARD);
 552                         ecard_dump_irq_state();
 553                 }
 554         } else
 555                 lockup = 0;
 556
 557         /*
 558          * If we did not recognise the source of this interrupt,
 559          * warn the user, but don't flood the user with these messages.
 560          */
 561         if (!last || time_after(jiffies, last + 5*HZ)) {
 562                 last = jiffies;
 563                 printk(KERN_WARNING "Unrecognised interrupt from backplane\n");
 564                 ecard_dump_irq_state();
 565         }
 566 }
 567
 568 static void
 569 ecard_irq_handler(unsigned int irq, struct irqdesc *desc, struct pt_regs *regs)
 570 {
 571         ecard_t *ec;
 572         int called = 0;
 573
 574         desc->chip->mask(irq);
 575         for (ec = cards; ec; ec = ec->next) {
 576                 int pending;
 577
 578                 if (!ec->claimed || ec->irq == NO_IRQ || ec->slot_no == 8)
 579                         continue;
 580
 581                 if (ec->ops && ec->ops->irqpending)
 582                         pending = ec->ops->irqpending(ec);
 583                 else
 584                         pending = ecard_default_ops.irqpending(ec);
 585
 586                 if (pending) {
 587                         struct irqdesc *d = irq_desc + ec->irq;
 588                         d->handle(ec->irq, d, regs);
 589                         called ++;
 590                 }
 591         }
 592         desc->chip->unmask(irq);
 593
 594         if (called == 0)
 595                 ecard_check_lockup(desc);
 596 }
 597
 598 #ifdef HAS_EXPMASK
 599 static unsigned char priority_masks[] =
 600 {
 601         0xf0, 0xf1, 0xf3, 0xf7, 0xff, 0xff, 0xff, 0xff
 602 };
 603
 604 static unsigned char first_set[] =
 605 {
 606         0x00, 0x00, 0x01, 0x00, 0x02, 0x00, 0x01, 0x00,
 607         0x03, 0x00, 0x01, 0x00, 0x02, 0x00, 0x01, 0x00
 608 };
 609
 610 static void
 611 ecard_irqexp_handler(unsigned int irq, struct irqdesc *desc, struct pt_regs *regs)
 612 {
 613         const unsigned int statusmask = 15;
 614         unsigned int status;
 615
 616         status = __raw_readb(EXPMASK_STATUS) & statusmask;
 617         if (status) {
 618                 unsigned int slot = first_set[status];
 619                 ecard_t *ec = slot_to_ecard(slot);
 620
 621                 if (ec->claimed) {
 622                         struct irqdesc *d = irqdesc + ec->irq;
 623                         /*
 624                          * this ugly code is so that we can operate a
 625                          * prioritorising system:
 626                          *
 627                          * Card 0       highest priority
 628                          * Card 1
 629                          * Card 2
 630                          * Card 3       lowest priority
 631                          *
 632                          * Serial cards should go in 0/1, ethernet/scsi in 2/3
 633                          * otherwise you will lose serial data at high speeds!
 634                          */
 635                         d->handle(ec->irq, d, regs);
 636                 } else {
 637                         printk(KERN_WARNING "card%d: interrupt from unclaimed "
 638                                "card???\n", slot);
 639                         have_expmask &= ~(1 << slot);
 640                         __raw_writeb(have_expmask, EXPMASK_ENABLE);
 641                 }
 642         } else
 643                 printk(KERN_WARNING "Wild interrupt from backplane (masks)\n");
 644 }
 645
 646 static int __init ecard_probeirqhw(void)
 647 {
 648         ecard_t *ec;
 649         int found;
 650
 651         __raw_writeb(0x00, EXPMASK_ENABLE);
 652         __raw_writeb(0xff, EXPMASK_STATUS);
 653         found = (__raw_readb(EXPMASK_STATUS) & 15) == 0;
 654         __raw_writeb(0xff, EXPMASK_ENABLE);
 655
 656         if (found) {
 657                 printk(KERN_DEBUG "Expansion card interrupt "
 658                        "management hardware found\n");
 659
 660                 /* for each card present, set a bit to '1' */
 661                 have_expmask = 0x80000000;
 662
 663                 for (ec = cards; ec; ec = ec->next)
 664                         have_expmask |= 1 << ec->slot_no;
 665
 666                 __raw_writeb(have_expmask, EXPMASK_ENABLE);
 667         }
 668
 669         return found;
 670 }
 671 #else
 672 #define ecard_irqexp_handler NULL
 673 #define ecard_probeirqhw() (0)
 674 #endif
 675
 676 #ifndef IO_EC_MEMC8_BASE
 677 #define IO_EC_MEMC8_BASE 0
 678 #endif
 679
 680 unsigned int __ecard_address(ecard_t *ec, card_type_t type, card_speed_t speed)
 681 {
 682         unsigned long address = 0;
 683         int slot = ec->slot_no;
 684
 685         if (ec->slot_no == 8)
 686                 return IO_EC_MEMC8_BASE;
 687
 688         ectcr &= ~(1 << slot);
 689
 690         switch (type) {
 691         case ECARD_MEMC:
 692                 if (slot < 4)
 693                         address = IO_EC_MEMC_BASE + (slot << 12);
 694                 break;
 695
 696         case ECARD_IOC:
 697                 if (slot < 4)
 698                         address = IO_EC_IOC_BASE + (slot << 12);
 699 #ifdef IO_EC_IOC4_BASE
 700                 else
 701                         address = IO_EC_IOC4_BASE + ((slot - 4) << 12);
 702 #endif
 703                 if (address)
 704                         address +=  speed << 17;
 705                 break;
 706
 707 #ifdef IO_EC_EASI_BASE
 708         case ECARD_EASI:
 709                 address = IO_EC_EASI_BASE + (slot << 22);
 710                 if (speed == ECARD_FAST)
 711                         ectcr |= 1 << slot;
 712                 break;
 713 #endif
 714         default:
 715                 break;
 716         }
 717
 718 #ifdef IOMD_ECTCR
 719         iomd_writeb(ectcr, IOMD_ECTCR);
 720 #endif
 721         return address;
 722 }
 723
 724 static int ecard_prints(char *buffer, ecard_t *ec)
 725 {
 726         char *start = buffer;
 727
 728         buffer += sprintf(buffer, "  %d: %s ", ec->slot_no,
 729                           ec->type == ECARD_EASI ? "EASI" : "    ");
 730
 731         if (ec->cid.id == 0) {
 732                 struct in_chunk_dir incd;
 733
 734                 buffer += sprintf(buffer, "[%04X:%04X] ",
 735                         ec->cid.manufacturer, ec->cid.product);
 736
 737                 if (!ec->card_desc && ec->cid.cd &&
 738                     ecard_readchunk(&incd, ec, 0xf5, 0)) {
 739                         ec->card_desc = kmalloc(strlen(incd.d.string)+1, GFP_KERNEL);
 740
 741                         if (ec->card_desc)
 742                                 strcpy((char *)ec->card_desc, incd.d.string);
 743                 }
 744
 745                 buffer += sprintf(buffer, "%s\n", ec->card_desc ? ec->card_desc : "*unknown*");
 746         } else
 747                 buffer += sprintf(buffer, "Simple card %d\n", ec->cid.id);
 748
 749         return buffer - start;
 750 }
 751
 752 static int get_ecard_dev_info(char *buf, char **start, off_t pos, int count)
 753 {
 754         ecard_t *ec = cards;
 755         off_t at = 0;
 756         int len, cnt;
 757
 758         cnt = 0;
 759         while (ec && count > cnt) {
 760                 len = ecard_prints(buf, ec);
 761                 at += len;
 762                 if (at >= pos) {
 763                         if (!*start) {
 764                                 *start = buf + (pos - (at - len));
 765                                 cnt = at - pos;
 766                         } else
 767                                 cnt += len;
 768                         buf += len;
 769                 }
 770                 ec = ec->next;
 771         }
 772         return (count > cnt) ? cnt : count;
 773 }
 774
 775 static struct proc_dir_entry *proc_bus_ecard_dir = NULL;
 776
 777 static void ecard_proc_init(void)
 778 {
 779         proc_bus_ecard_dir = proc_mkdir("ecard", proc_bus);
 780         create_proc_info_entry("devices", 0, proc_bus_ecard_dir,
 781                 get_ecard_dev_info);
 782 }
 783
 784 #define ec_set_resource(ec,nr,st,sz)                            \
 785         do {                                                    \
 786                 (ec)->resource[nr].name = ec->dev.bus_id;       \
 787                 (ec)->resource[nr].start = st;                  \
 788                 (ec)->resource[nr].end = (st) + (sz) - 1;       \
 789                 (ec)->resource[nr].flags = IORESOURCE_MEM;      \
 790         } while (0)
 791
 792 static void __init ecard_free_card(struct expansion_card *ec)
 793 {
 794         int i;
 795
 796         for (i = 0; i < ECARD_NUM_RESOURCES; i++)
 797                 if (ec->resource[i].flags)
 798                         release_resource(&ec->resource[i]);
 799
 800         kfree(ec);
 801 }
 802
 803 static struct expansion_card *__init ecard_alloc_card(int type, int slot)
 804 {
 805         struct expansion_card *ec;
 806         unsigned long base;
 807         int i;
 808
 809         ec = kmalloc(sizeof(ecard_t), GFP_KERNEL);
 810         if (!ec) {
 811                 ec = ERR_PTR(-ENOMEM);
 812                 goto nomem;
 813         }
 814
 815         memset(ec, 0, sizeof(ecard_t));
 816
 817         ec->slot_no = slot;
 818         ec->type = type;
 819         ec->irq = NO_IRQ;
 820         ec->fiq = NO_IRQ;
 821         ec->dma = NO_DMA;
 822         ec->ops = &ecard_default_ops;
 823
 824         snprintf(ec->dev.bus_id, sizeof(ec->dev.bus_id), "ecard%d", slot);
 825         ec->dev.parent = NULL;
 826         ec->dev.bus = &ecard_bus_type;
 827         ec->dev.dma_mask = &ec->dma_mask;
 828         ec->dma_mask = (u64)0xffffffff;
 829
 830         if (slot < 4) {
 831                 ec_set_resource(ec, ECARD_RES_MEMC,
 832                                 PODSLOT_MEMC_BASE + (slot << 14),
 833                                 PODSLOT_MEMC_SIZE);
 834                 base = PODSLOT_IOC0_BASE + (slot << 14);
 835         } else
 836                 base = PODSLOT_IOC4_BASE + ((slot - 4) << 14);
 837
 838 #ifdef CONFIG_ARCH_RPC
 839         if (slot < 8) {
 840                 ec_set_resource(ec, ECARD_RES_EASI,
 841                                 PODSLOT_EASI_BASE + (slot << 24),
 842                                 PODSLOT_EASI_SIZE);
 843         }
 844
 845         if (slot == 8) {
 846                 ec_set_resource(ec, ECARD_RES_MEMC, NETSLOT_BASE, NETSLOT_SIZE);
 847         } else
 848 #endif
 849
 850         for (i = 0; i <= ECARD_RES_IOCSYNC - ECARD_RES_IOCSLOW; i++)
 851                 ec_set_resource(ec, i + ECARD_RES_IOCSLOW,
 852                                 base + (i << 19), PODSLOT_IOC_SIZE);
 853
 854         for (i = 0; i < ECARD_NUM_RESOURCES; i++) {
 855                 if (ec->resource[i].flags &&
 856                     request_resource(&iomem_resource, &ec->resource[i])) {
 857                         printk(KERN_ERR "%s: resource(s) not available\n",
 858                                 ec->dev.bus_id);
 859                         ec->resource[i].end -= ec->resource[i].start;
 860                         ec->resource[i].start = 0;
 861                         ec->resource[i].flags = 0;
 862                 }
 863         }
 864
 865  nomem:
 866         return ec;
 867 }
 868
 869 static ssize_t ecard_show_irq(struct device *dev, char *buf)
 870 {
 871         struct expansion_card *ec = ECARD_DEV(dev);
 872         return sprintf(buf, "%u\n", ec->irq);
 873 }
 874
 875 static ssize_t ecard_show_dma(struct device *dev, char *buf)
 876 {
 877         struct expansion_card *ec = ECARD_DEV(dev);
 878         return sprintf(buf, "%u\n", ec->dma);
 879 }
 880
 881 static ssize_t ecard_show_resources(struct device *dev, char *buf)
 882 {
 883         struct expansion_card *ec = ECARD_DEV(dev);
 884         char *str = buf;
 885         int i;
 886
 887         for (i = 0; i < ECARD_NUM_RESOURCES; i++)
 888                 str += sprintf(str, "%08lx %08lx %08lx\n",
 889                                 ec->resource[i].start,
 890                                 ec->resource[i].end,
 891                                 ec->resource[i].flags);
 892
 893         return str - buf;
 894 }
 895
 896 static ssize_t ecard_show_vendor(struct device *dev, char *buf)
 897 {
 898         struct expansion_card *ec = ECARD_DEV(dev);
 899         return sprintf(buf, "%u\n", ec->cid.manufacturer);
 900 }
 901
 902 static ssize_t ecard_show_device(struct device *dev, char *buf)
 903 {
 904         struct expansion_card *ec = ECARD_DEV(dev);
 905         return sprintf(buf, "%u\n", ec->cid.product);
 906 }
 907
 908 static ssize_t ecard_show_type(struct device *dev, char *buf)
 909 {
 910         struct expansion_card *ec = ECARD_DEV(dev);
 911         return sprintf(buf, "%s\n", ec->type == ECARD_EASI ? "EASI" : "IOC");
 912 }
 913
 914 static struct device_attribute ecard_dev_attrs[] = {
 915         __ATTR(device,   S_IRUGO, ecard_show_device,    NULL),
 916         __ATTR(dma,      S_IRUGO, ecard_show_dma,       NULL),
 917         __ATTR(irq,      S_IRUGO, ecard_show_irq,       NULL),
 918         __ATTR(resource, S_IRUGO, ecard_show_resources, NULL),
 919         __ATTR(type,     S_IRUGO, ecard_show_type,      NULL),
 920         __ATTR(vendor,   S_IRUGO, ecard_show_vendor,    NULL),
 921         __ATTR_NULL,
 922 };
 923
 924
 925 int ecard_request_resources(struct expansion_card *ec)
 926 {
 927         int i, err = 0;
 928
 929         for (i = 0; i < ECARD_NUM_RESOURCES; i++) {
 930                 if (ecard_resource_end(ec, i) &&
 931                     !request_mem_region(ecard_resource_start(ec, i),
 932                                         ecard_resource_len(ec, i),
 933                                         ec->dev.driver->name)) {
 934                         err = -EBUSY;
 935                         break;
 936                 }
 937         }
 938
 939         if (err) {
 940                 while (i--)
 941                         if (ecard_resource_end(ec, i))
 942                                 release_mem_region(ecard_resource_start(ec, i),
 943                                                    ecard_resource_len(ec, i));
 944         }
 945         return err;
 946 }
 947 EXPORT_SYMBOL(ecard_request_resources);
 948
 949 void ecard_release_resources(struct expansion_card *ec)
 950 {
 951         int i;
 952
 953         for (i = 0; i < ECARD_NUM_RESOURCES; i++)
 954                 if (ecard_resource_end(ec, i))
 955                         release_mem_region(ecard_resource_start(ec, i),
 956                                            ecard_resource_len(ec, i));
 957 }
 958 EXPORT_SYMBOL(ecard_release_resources);
 959
 960 /*
 961  * Probe for an expansion card.
 962  *
 963  * If bit 1 of the first byte of the card is set, then the
 964  * card does not exist.
 965  */
 966 static int __init
 967 ecard_probe(int slot, card_type_t type)
 968 {
 969         ecard_t **ecp;
 970         ecard_t *ec;
 971         struct ex_ecid cid;
 972         int i, rc;
 973
 974         ec = ecard_alloc_card(type, slot);
 975         if (IS_ERR(ec)) {
 976                 rc = PTR_ERR(ec);
 977                 goto nomem;
 978         }
 979
 980         rc = -ENODEV;
 981         if ((ec->podaddr = ecard_address(ec, type, ECARD_SYNC)) == 0)
 982                 goto nodev;
 983
 984         cid.r_zero = 1;
 985         ecard_readbytes(&cid, ec, 0, 16, 0);
 986         if (cid.r_zero)
 987                 goto nodev;
 988
 989         ec->cid.id      = cid.r_id;
 990         ec->cid.cd      = cid.r_cd;
 991         ec->cid.is      = cid.r_is;
 992         ec->cid.w       = cid.r_w;
 993         ec->cid.manufacturer = ecard_getu16(cid.r_manu);
 994         ec->cid.product = ecard_getu16(cid.r_prod);
 995         ec->cid.country = cid.r_country;
 996         ec->cid.irqmask = cid.r_irqmask;
 997         ec->cid.irqoff  = ecard_gets24(cid.r_irqoff);
 998         ec->cid.fiqmask = cid.r_fiqmask;
 999         ec->cid.fiqoff  = ecard_gets24(cid.r_fiqoff);
1000         ec->fiqaddr     =
1001         ec->irqaddr     = (void __iomem *)ioaddr(ec->podaddr);
1002
1003         if (ec->cid.is) {
1004                 ec->irqmask = ec->cid.irqmask;
1005                 ec->irqaddr += ec->cid.irqoff;
1006                 ec->fiqmask = ec->cid.fiqmask;
1007                 ec->fiqaddr += ec->cid.fiqoff;
1008         } else {
1009                 ec->irqmask = 1;
1010                 ec->fiqmask = 4;
1011         }
1012
1013         for (i = 0; i < sizeof(blacklist) / sizeof(*blacklist); i++)
1014                 if (blacklist[i].manufacturer == ec->cid.manufacturer &&
1015                     blacklist[i].product == ec->cid.product) {
1016                         ec->card_desc = blacklist[i].type;
1017                         break;
1018                 }
1019
1020         /*
1021          * hook the interrupt handlers
1022          */
1023         if (slot < 8) {
1024                 ec->irq = 32 + slot;
1025                 set_irq_chip(ec->irq, &ecard_chip);
1026                 set_irq_handler(ec->irq, do_level_IRQ);
1027                 set_irq_flags(ec->irq, IRQF_VALID);
1028         }
1029
1030 #ifdef IO_EC_MEMC8_BASE
1031         if (slot == 8)
1032                 ec->irq = 11;
1033 #endif
1034 #ifdef CONFIG_ARCH_RPC
1035         /* On RiscPC, only first two slots have DMA capability */
1036         if (slot < 2)
1037                 ec->dma = 2 + slot;
1038 #endif
1039
1040         for (ecp = &cards; *ecp; ecp = &(*ecp)->next);
1041
1042         *ecp = ec;
1043         slot_to_expcard[slot] = ec;
1044
1045         device_register(&ec->dev);
1046
1047         return 0;
1048
1049  nodev:
1050         ecard_free_card(ec);
1051  nomem:
1052         return rc;
1053 }
1054
1055 /*
1056  * Initialise the expansion card system.
1057  * Locate all hardware - interrupt management and
1058  * actual cards.
1059  */
1060 static int __init ecard_init(void)
1061 {
1062         int slot, irqhw, ret;
1063
1064         ret = kernel_thread(ecard_task, NULL, CLONE_KERNEL);
1065         if (ret < 0) {
1066                 printk(KERN_ERR "Ecard: unable to create kernel thread: %d\n",
1067                        ret);
1068                 return ret;
1069         }
1070
1071         printk("Probing expansion cards\n");
1072
1073         for (slot = 0; slot < 8; slot ++) {
1074                 if (ecard_probe(slot, ECARD_EASI) == -ENODEV)
1075                         ecard_probe(slot, ECARD_IOC);
1076         }
1077
1078 #ifdef IO_EC_MEMC8_BASE
1079         ecard_probe(8, ECARD_IOC);
1080 #endif
1081
1082         irqhw = ecard_probeirqhw();
1083
1084         set_irq_chained_handler(IRQ_EXPANSIONCARD,
1085                                 irqhw ? ecard_irqexp_handler : ecard_irq_handler);
1086
1087         ecard_proc_init();
1088
1089         return 0;
1090 }
1091
1092 subsys_initcall(ecard_init);
1093
1094 /*
1095  *      ECARD "bus"
1096  */
1097 static const struct ecard_id *
1098 ecard_match_device(const struct ecard_id *ids, struct expansion_card *ec)
1099 {
1100         int i;
1101
1102         for (i = 0; ids[i].manufacturer != 65535; i++)
1103                 if (ec->cid.manufacturer == ids[i].manufacturer &&
1104                     ec->cid.product == ids[i].product)
1105                         return ids + i;
1106
1107         return NULL;
1108 }
1109
1110 static int ecard_drv_probe(struct device *dev)
1111 {
1112         struct expansion_card *ec = ECARD_DEV(dev);
1113         struct ecard_driver *drv = ECARD_DRV(dev->driver);
1114         const struct ecard_id *id;
1115         int ret;
1116
1117         id = ecard_match_device(drv->id_table, ec);
1118
1119         ecard_claim(ec);
1120         ret = drv->probe(ec, id);
1121         if (ret)
1122                 ecard_release(ec);
1123         return ret;
1124 }
1125
1126 static int ecard_drv_remove(struct device *dev)
1127 {
1128         struct expansion_card *ec = ECARD_DEV(dev);
1129         struct ecard_driver *drv = ECARD_DRV(dev->driver);
1130
1131         drv->remove(ec);
1132         ecard_release(ec);
1133
1134         return 0;
1135 }
1136
1137 /*
1138  * Before rebooting, we must make sure that the expansion card is in a
1139  * sensible state, so it can be re-detected.  This means that the first
1140  * page of the ROM must be visible.  We call the expansion cards reset
1141  * handler, if any.
1142  */
1143 static void ecard_drv_shutdown(struct device *dev)
1144 {
1145         struct expansion_card *ec = ECARD_DEV(dev);
1146         struct ecard_driver *drv = ECARD_DRV(dev->driver);
1147         struct ecard_request req;
1148
1149         if (drv->shutdown)
1150                 drv->shutdown(ec);
1151         ecard_release(ec);
1152
1153         /*
1154          * If this card has a loader, call the reset handler.
1155          */
1156         if (ec->loader) {
1157                 req.fn = ecard_task_reset;
1158                 req.ec = ec;
1159                 ecard_call(&req);
1160         }
1161 }
1162
1163 int ecard_register_driver(struct ecard_driver *drv)
1164 {
1165         drv->drv.bus = &ecard_bus_type;
1166         drv->drv.probe = ecard_drv_probe;
1167         drv->drv.remove = ecard_drv_remove;
1168         drv->drv.shutdown = ecard_drv_shutdown;
1169
1170         return driver_register(&drv->drv);
1171 }
1172
1173 void ecard_remove_driver(struct ecard_driver *drv)
1174 {
1175         driver_unregister(&drv->drv);
1176 }
1177
1178 static int ecard_match(struct device *_dev, struct device_driver *_drv)
1179 {
1180         struct expansion_card *ec = ECARD_DEV(_dev);
1181         struct ecard_driver *drv = ECARD_DRV(_drv);
1182         int ret;
1183
1184         if (drv->id_table) {
1185                 ret = ecard_match_device(drv->id_table, ec) != NULL;
1186         } else {
1187                 ret = ec->cid.id == drv->id;
1188         }
1189
1190         return ret;
1191 }
1192
1193 struct bus_type ecard_bus_type = {
1194         .name           = "ecard",
1195         .dev_attrs      = ecard_dev_attrs,
1196         .match          = ecard_match,
1197 };
1198
1199 static int ecard_bus_init(void)
1200 {
1201         return bus_register(&ecard_bus_type);
1202 }
1203
1204 postcore_initcall(ecard_bus_init);
1205
1206 EXPORT_SYMBOL(ecard_readchunk);
1207 EXPORT_SYMBOL(__ecard_address);
1208 EXPORT_SYMBOL(ecard_register_driver);
1209 EXPORT_SYMBOL(ecard_remove_driver);
1210 EXPORT_SYMBOL(ecard_bus_type);