git.oblomov.eu Git - linux-2.6/blob - arch/alpha/kernel/core_titan.c

   1 /*
   2  *      linux/arch/alpha/kernel/core_titan.c
   3  *
   4  * Code common to all TITAN core logic chips.
   5  */
   6
   7 #define __EXTERN_INLINE inline
   8 #include <asm/io.h>
   9 #include <asm/core_titan.h>
  10 #undef __EXTERN_INLINE
  11
  12 #include <linux/module.h>
  13 #include <linux/types.h>
  14 #include <linux/pci.h>
  15 #include <linux/sched.h>
  16 #include <linux/init.h>
  17 #include <linux/vmalloc.h>
  18 #include <linux/bootmem.h>
  19
  20 #include <asm/ptrace.h>
  21 #include <asm/smp.h>
  22 #include <asm/pgalloc.h>
  23 #include <asm/tlbflush.h>
  24 #include <asm/vga.h>
  25
  26 #include "proto.h"
  27 #include "pci_impl.h"
  28
  29 /* Save Titan configuration data as the console had it set up.  */
  30
  31 struct
  32 {
  33         unsigned long wsba[4];
  34         unsigned long wsm[4];
  35         unsigned long tba[4];
  36 } saved_config[4] __attribute__((common));
  37
  38 /*
  39  * Is PChip 1 present? No need to query it more than once.
  40  */
  41 static int titan_pchip1_present;
  42
  43 /*
  44  * BIOS32-style PCI interface:
  45  */
  46
  47 #define DEBUG_CONFIG 0
  48
  49 #if DEBUG_CONFIG
  50 # define DBG_CFG(args)  printk args
  51 #else
  52 # define DBG_CFG(args)
  53 #endif
  54
  55 \f
  56 /*
  57  * Routines to access TIG registers.
  58  */
  59 static inline volatile unsigned long *
  60 mk_tig_addr(int offset)
  61 {
  62         return (volatile unsigned long *)(TITAN_TIG_SPACE + (offset << 6));
  63 }
  64
  65 static inline u8
  66 titan_read_tig(int offset, u8 value)
  67 {
  68         volatile unsigned long *tig_addr = mk_tig_addr(offset);
  69         return (u8)(*tig_addr & 0xff);
  70 }
  71
  72 static inline void
  73 titan_write_tig(int offset, u8 value)
  74 {
  75         volatile unsigned long *tig_addr = mk_tig_addr(offset);
  76         *tig_addr = (unsigned long)value;
  77 }
  78
  79 \f
  80 /*
  81  * Given a bus, device, and function number, compute resulting
  82  * configuration space address
  83  * accordingly.  It is therefore not safe to have concurrent
  84  * invocations to configuration space access routines, but there
  85  * really shouldn't be any need for this.
  86  *
  87  * Note that all config space accesses use Type 1 address format.
  88  *
  89  * Note also that type 1 is determined by non-zero bus number.
  90  *
  91  * Type 1:
  92  *
  93  *  3 3|3 3 2 2|2 2 2 2|2 2 2 2|1 1 1 1|1 1 1 1|1 1
  94  *  3 2|1 0 9 8|7 6 5 4|3 2 1 0|9 8 7 6|5 4 3 2|1 0 9 8|7 6 5 4|3 2 1 0
  95  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
  96  * | | | | | | | | | | |B|B|B|B|B|B|B|B|D|D|D|D|D|F|F|F|R|R|R|R|R|R|0|1|
  97  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
  98  *
  99  *      31:24   reserved
 100  *      23:16   bus number (8 bits = 128 possible buses)
 101  *      15:11   Device number (5 bits)
 102  *      10:8    function number
 103  *       7:2    register number
 104  *
 105  * Notes:
 106  *      The function number selects which function of a multi-function device
 107  *      (e.g., SCSI and Ethernet).
 108  *
 109  *      The register selects a DWORD (32 bit) register offset.  Hence it
 110  *      doesn't get shifted by 2 bits as we want to "drop" the bottom two
 111  *      bits.
 112  */
 113
 114 static int
 115 mk_conf_addr(struct pci_bus *pbus, unsigned int device_fn, int where,
 116              unsigned long *pci_addr, unsigned char *type1)
 117 {
 118         struct pci_controller *hose = pbus->sysdata;
 119         unsigned long addr;
 120         u8 bus = pbus->number;
 121
 122         DBG_CFG(("mk_conf_addr(bus=%d ,device_fn=0x%x, where=0x%x, "
 123                  "pci_addr=0x%p, type1=0x%p)\n",
 124                  bus, device_fn, where, pci_addr, type1));
 125
 126         if (!pbus->parent) /* No parent means peer PCI bus. */
 127                 bus = 0;
 128         *type1 = (bus != 0);
 129
 130         addr = (bus << 16) | (device_fn << 8) | where;
 131         addr |= hose->config_space_base;
 132
 133         *pci_addr = addr;
 134         DBG_CFG(("mk_conf_addr: returning pci_addr 0x%lx\n", addr));
 135         return 0;
 136 }
 137
 138 static int
 139 titan_read_config(struct pci_bus *bus, unsigned int devfn, int where,
 140                   int size, u32 *value)
 141 {
 142         unsigned long addr;
 143         unsigned char type1;
 144
 145         if (mk_conf_addr(bus, devfn, where, &addr, &type1))
 146                 return PCIBIOS_DEVICE_NOT_FOUND;
 147
 148         switch (size) {
 149         case 1:
 150                 *value = __kernel_ldbu(*(vucp)addr);
 151                 break;
 152         case 2:
 153                 *value = __kernel_ldwu(*(vusp)addr);
 154                 break;
 155         case 4:
 156                 *value = *(vuip)addr;
 157                 break;
 158         }
 159
 160         return PCIBIOS_SUCCESSFUL;
 161 }
 162
 163 static int
 164 titan_write_config(struct pci_bus *bus, unsigned int devfn, int where,
 165                    int size, u32 value)
 166 {
 167         unsigned long addr;
 168         unsigned char type1;
 169
 170         if (mk_conf_addr(bus, devfn, where, &addr, &type1))
 171                 return PCIBIOS_DEVICE_NOT_FOUND;
 172
 173         switch (size) {
 174         case 1:
 175                 __kernel_stb(value, *(vucp)addr);
 176                 mb();
 177                 __kernel_ldbu(*(vucp)addr);
 178                 break;
 179         case 2:
 180                 __kernel_stw(value, *(vusp)addr);
 181                 mb();
 182                 __kernel_ldwu(*(vusp)addr);
 183                 break;
 184         case 4:
 185                 *(vuip)addr = value;
 186                 mb();
 187                 *(vuip)addr;
 188                 break;
 189         }
 190
 191         return PCIBIOS_SUCCESSFUL;
 192 }
 193
 194 struct pci_ops titan_pci_ops =
 195 {
 196         .read =         titan_read_config,
 197         .write =        titan_write_config,
 198 };
 199
 200 \f
 201 void
 202 titan_pci_tbi(struct pci_controller *hose, dma_addr_t start, dma_addr_t end)
 203 {
 204         titan_pachip *pachip =
 205           (hose->index & 1) ? TITAN_pachip1 : TITAN_pachip0;
 206         titan_pachip_port *port;
 207         volatile unsigned long *csr;
 208         unsigned long value;
 209
 210         /* Get the right hose.  */
 211         port = &pachip->g_port;
 212         if (hose->index & 2)
 213                 port = &pachip->a_port;
 214
 215         /* We can invalidate up to 8 tlb entries in a go.  The flush
 216            matches against <31:16> in the pci address.
 217            Note that gtlbi* and atlbi* are in the same place in the g_port
 218            and a_port, respectively, so the g_port offset can be used
 219            even if hose is an a_port */
 220         csr = &port->port_specific.g.gtlbia.csr;
 221         if (((start ^ end) & 0xffff0000) == 0)
 222                 csr = &port->port_specific.g.gtlbiv.csr;
 223
 224         /* For TBIA, it doesn't matter what value we write.  For TBI,
 225            it's the shifted tag bits.  */
 226         value = (start & 0xffff0000) >> 12;
 227
 228         wmb();
 229         *csr = value;
 230         mb();
 231         *csr;
 232 }
 233
 234 static int
 235 titan_query_agp(titan_pachip_port *port)
 236 {
 237         union TPAchipPCTL pctl;
 238
 239         /* set up APCTL */
 240         pctl.pctl_q_whole = port->pctl.csr;
 241
 242         return pctl.pctl_r_bits.apctl_v_agp_present;
 243
 244 }
 245
 246 static void __init
 247 titan_init_one_pachip_port(titan_pachip_port *port, int index)
 248 {
 249         struct pci_controller *hose;
 250
 251         hose = alloc_pci_controller();
 252         if (index == 0)
 253                 pci_isa_hose = hose;
 254         hose->io_space = alloc_resource();
 255         hose->mem_space = alloc_resource();
 256
 257         /*
 258          * This is for userland consumption.  The 40-bit PIO bias that we
 259          * use in the kernel through KSEG doesn't work in the page table
 260          * based user mappings. (43-bit KSEG sign extends the physical
 261          * address from bit 40 to hit the I/O bit - mapped addresses don't).
 262          * So make sure we get the 43-bit PIO bias.
 263          */
 264         hose->sparse_mem_base = 0;
 265         hose->sparse_io_base = 0;
 266         hose->dense_mem_base
 267           = (TITAN_MEM(index) & 0xffffffffffUL) | 0x80000000000UL;
 268         hose->dense_io_base
 269           = (TITAN_IO(index) & 0xffffffffffUL) | 0x80000000000UL;
 270
 271         hose->config_space_base = TITAN_CONF(index);
 272         hose->index = index;
 273
 274         hose->io_space->start = TITAN_IO(index) - TITAN_IO_BIAS;
 275         hose->io_space->end = hose->io_space->start + TITAN_IO_SPACE - 1;
 276         hose->io_space->name = pci_io_names[index];
 277         hose->io_space->flags = IORESOURCE_IO;
 278
 279         hose->mem_space->start = TITAN_MEM(index) - TITAN_MEM_BIAS;
 280         hose->mem_space->end = hose->mem_space->start + 0xffffffff;
 281         hose->mem_space->name = pci_mem_names[index];
 282         hose->mem_space->flags = IORESOURCE_MEM;
 283
 284         if (request_resource(&ioport_resource, hose->io_space) < 0)
 285                 printk(KERN_ERR "Failed to request IO on hose %d\n", index);
 286         if (request_resource(&iomem_resource, hose->mem_space) < 0)
 287                 printk(KERN_ERR "Failed to request MEM on hose %d\n", index);
 288
 289         /*
 290          * Save the existing PCI window translations.  SRM will
 291          * need them when we go to reboot.
 292          */
 293         saved_config[index].wsba[0] = port->wsba[0].csr;
 294         saved_config[index].wsm[0]  = port->wsm[0].csr;
 295         saved_config[index].tba[0]  = port->tba[0].csr;
 296
 297         saved_config[index].wsba[1] = port->wsba[1].csr;
 298         saved_config[index].wsm[1]  = port->wsm[1].csr;
 299         saved_config[index].tba[1]  = port->tba[1].csr;
 300
 301         saved_config[index].wsba[2] = port->wsba[2].csr;
 302         saved_config[index].wsm[2]  = port->wsm[2].csr;
 303         saved_config[index].tba[2]  = port->tba[2].csr;
 304
 305         saved_config[index].wsba[3] = port->wsba[3].csr;
 306         saved_config[index].wsm[3]  = port->wsm[3].csr;
 307         saved_config[index].tba[3]  = port->tba[3].csr;
 308
 309         /*
 310          * Set up the PCI to main memory translation windows.
 311          *
 312          * Note: Window 3 on Titan is Scatter-Gather ONLY.
 313          *
 314          * Window 0 is scatter-gather 8MB at 8MB (for isa)
 315          * Window 1 is direct access 1GB at 2GB
 316          * Window 2 is scatter-gather 1GB at 3GB
 317          */
 318         hose->sg_isa = iommu_arena_new(hose, 0x00800000, 0x00800000, 0);
 319         hose->sg_isa->align_entry = 8; /* 64KB for ISA */
 320
 321         hose->sg_pci = iommu_arena_new(hose, 0xc0000000, 0x40000000, 0);
 322         hose->sg_pci->align_entry = 4; /* Titan caches 4 PTEs at a time */
 323
 324         port->wsba[0].csr = hose->sg_isa->dma_base | 3;
 325         port->wsm[0].csr  = (hose->sg_isa->size - 1) & 0xfff00000;
 326         port->tba[0].csr  = virt_to_phys(hose->sg_isa->ptes);
 327
 328         port->wsba[1].csr = __direct_map_base | 1;
 329         port->wsm[1].csr  = (__direct_map_size - 1) & 0xfff00000;
 330         port->tba[1].csr  = 0;
 331
 332         port->wsba[2].csr = hose->sg_pci->dma_base | 3;
 333         port->wsm[2].csr  = (hose->sg_pci->size - 1) & 0xfff00000;
 334         port->tba[2].csr  = virt_to_phys(hose->sg_pci->ptes);
 335
 336         port->wsba[3].csr = 0;
 337
 338         /* Enable the Monster Window to make DAC pci64 possible.  */
 339         port->pctl.csr |= pctl_m_mwin;
 340
 341         /*
 342          * If it's an AGP port, initialize agplastwr.
 343          */
 344         if (titan_query_agp(port))
 345                 port->port_specific.a.agplastwr.csr = __direct_map_base;
 346
 347         titan_pci_tbi(hose, 0, -1);
 348 }
 349
 350 static void __init
 351 titan_init_pachips(titan_pachip *pachip0, titan_pachip *pachip1)
 352 {
 353         titan_pchip1_present = TITAN_cchip->csc.csr & 1L<<14;
 354
 355         /* Init the ports in hose order... */
 356         titan_init_one_pachip_port(&pachip0->g_port, 0);        /* hose 0 */
 357         if (titan_pchip1_present)
 358                 titan_init_one_pachip_port(&pachip1->g_port, 1);/* hose 1 */
 359         titan_init_one_pachip_port(&pachip0->a_port, 2);        /* hose 2 */
 360         if (titan_pchip1_present)
 361                 titan_init_one_pachip_port(&pachip1->a_port, 3);/* hose 3 */
 362 }
 363
 364 void __init
 365 titan_init_arch(void)
 366 {
 367 #if 0
 368         printk("%s: titan_init_arch()\n", __FUNCTION__);
 369         printk("%s: CChip registers:\n", __FUNCTION__);
 370         printk("%s: CSR_CSC 0x%lx\n", __FUNCTION__, TITAN_cchip->csc.csr);
 371         printk("%s: CSR_MTR 0x%lx\n", __FUNCTION__, TITAN_cchip->mtr.csr);
 372         printk("%s: CSR_MISC 0x%lx\n", __FUNCTION__, TITAN_cchip->misc.csr);
 373         printk("%s: CSR_DIM0 0x%lx\n", __FUNCTION__, TITAN_cchip->dim0.csr);
 374         printk("%s: CSR_DIM1 0x%lx\n", __FUNCTION__, TITAN_cchip->dim1.csr);
 375         printk("%s: CSR_DIR0 0x%lx\n", __FUNCTION__, TITAN_cchip->dir0.csr);
 376         printk("%s: CSR_DIR1 0x%lx\n", __FUNCTION__, TITAN_cchip->dir1.csr);
 377         printk("%s: CSR_DRIR 0x%lx\n", __FUNCTION__, TITAN_cchip->drir.csr);
 378
 379         printk("%s: DChip registers:\n", __FUNCTION__);
 380         printk("%s: CSR_DSC 0x%lx\n", __FUNCTION__, TITAN_dchip->dsc.csr);
 381         printk("%s: CSR_STR 0x%lx\n", __FUNCTION__, TITAN_dchip->str.csr);
 382         printk("%s: CSR_DREV 0x%lx\n", __FUNCTION__, TITAN_dchip->drev.csr);
 383 #endif
 384
 385         boot_cpuid = __hard_smp_processor_id();
 386
 387         /* With multiple PCI busses, we play with I/O as physical addrs.  */
 388         ioport_resource.end = ~0UL;
 389         iomem_resource.end = ~0UL;
 390
 391         /* PCI DMA Direct Mapping is 1GB at 2GB.  */
 392         __direct_map_base = 0x80000000;
 393         __direct_map_size = 0x40000000;
 394
 395         /* Init the PA chip(s).  */
 396         titan_init_pachips(TITAN_pachip0, TITAN_pachip1);
 397
 398         /* Check for graphic console location (if any).  */
 399         find_console_vga_hose();
 400 }
 401
 402 static void
 403 titan_kill_one_pachip_port(titan_pachip_port *port, int index)
 404 {
 405         port->wsba[0].csr = saved_config[index].wsba[0];
 406         port->wsm[0].csr  = saved_config[index].wsm[0];
 407         port->tba[0].csr  = saved_config[index].tba[0];
 408
 409         port->wsba[1].csr = saved_config[index].wsba[1];
 410         port->wsm[1].csr  = saved_config[index].wsm[1];
 411         port->tba[1].csr  = saved_config[index].tba[1];
 412
 413         port->wsba[2].csr = saved_config[index].wsba[2];
 414         port->wsm[2].csr  = saved_config[index].wsm[2];
 415         port->tba[2].csr  = saved_config[index].tba[2];
 416
 417         port->wsba[3].csr = saved_config[index].wsba[3];
 418         port->wsm[3].csr  = saved_config[index].wsm[3];
 419         port->tba[3].csr  = saved_config[index].tba[3];
 420 }
 421
 422 static void
 423 titan_kill_pachips(titan_pachip *pachip0, titan_pachip *pachip1)
 424 {
 425         if (titan_pchip1_present) {
 426                 titan_kill_one_pachip_port(&pachip1->g_port, 1);
 427                 titan_kill_one_pachip_port(&pachip1->a_port, 3);
 428         }
 429         titan_kill_one_pachip_port(&pachip0->g_port, 0);
 430         titan_kill_one_pachip_port(&pachip0->a_port, 2);
 431 }
 432
 433 void
 434 titan_kill_arch(int mode)
 435 {
 436         titan_kill_pachips(TITAN_pachip0, TITAN_pachip1);
 437 }
 438
 439 \f
 440 /*
 441  * IO map support.
 442  */
 443
 444 void __iomem *
 445 titan_ioportmap(unsigned long addr)
 446 {
 447         FIXUP_IOADDR_VGA(addr);
 448         return (void __iomem *)(addr + TITAN_IO_BIAS);
 449 }
 450
 451
 452 void __iomem *
 453 titan_ioremap(unsigned long addr, unsigned long size)
 454 {
 455         int h = (addr & TITAN_HOSE_MASK) >> TITAN_HOSE_SHIFT;
 456         unsigned long baddr = addr & ~TITAN_HOSE_MASK;
 457         unsigned long last = baddr + size - 1;
 458         struct pci_controller *hose;
 459         struct vm_struct *area;
 460         unsigned long vaddr;
 461         unsigned long *ptes;
 462         unsigned long pfn;
 463
 464         /*
 465          * Adjust the address and hose, if necessary.
 466          */
 467         if (pci_vga_hose && __is_mem_vga(addr)) {
 468                 h = pci_vga_hose->index;
 469                 addr += pci_vga_hose->mem_space->start;
 470         }
 471
 472         /*
 473          * Find the hose.
 474          */
 475         for (hose = hose_head; hose; hose = hose->next)
 476                 if (hose->index == h)
 477                         break;
 478         if (!hose)
 479                 return NULL;
 480
 481         /*
 482          * Is it direct-mapped?
 483          */
 484         if ((baddr >= __direct_map_base) &&
 485             ((baddr + size - 1) < __direct_map_base + __direct_map_size)) {
 486                 vaddr = addr - __direct_map_base + TITAN_MEM_BIAS;
 487                 return (void __iomem *) vaddr;
 488         }
 489
 490         /*
 491          * Check the scatter-gather arena.
 492          */
 493         if (hose->sg_pci &&
 494             baddr >= (unsigned long)hose->sg_pci->dma_base &&
 495             last < (unsigned long)hose->sg_pci->dma_base + hose->sg_pci->size){
 496
 497                 /*
 498                  * Adjust the limits (mappings must be page aligned)
 499                  */
 500                 baddr -= hose->sg_pci->dma_base;
 501                 last -= hose->sg_pci->dma_base;
 502                 baddr &= PAGE_MASK;
 503                 size = PAGE_ALIGN(last) - baddr;
 504
 505                 /*
 506                  * Map it
 507                  */
 508                 area = get_vm_area(size, VM_IOREMAP);
 509                 if (!area) {
 510                         printk("ioremap failed... no vm_area...\n");
 511                         return NULL;
 512                 }
 513
 514                 ptes = hose->sg_pci->ptes;
 515                 for (vaddr = (unsigned long)area->addr;
 516                     baddr <= last;
 517                     baddr += PAGE_SIZE, vaddr += PAGE_SIZE) {
 518                         pfn = ptes[baddr >> PAGE_SHIFT];
 519                         if (!(pfn & 1)) {
 520                                 printk("ioremap failed... pte not valid...\n");
 521                                 vfree(area->addr);
 522                                 return NULL;
 523                         }
 524                         pfn >>= 1;      /* make it a true pfn */
 525
 526                         if (__alpha_remap_area_pages(vaddr,
 527                                                      pfn << PAGE_SHIFT,
 528                                                      PAGE_SIZE, 0)) {
 529                                 printk("FAILED to remap_area_pages...\n");
 530                                 vfree(area->addr);
 531                                 return NULL;
 532                         }
 533                 }
 534
 535                 flush_tlb_all();
 536
 537                 vaddr = (unsigned long)area->addr + (addr & ~PAGE_MASK);
 538                 return (void __iomem *) vaddr;
 539         }
 540
 541         /* Assume a legacy (read: VGA) address, and return appropriately. */
 542         return (void __iomem *)(addr + TITAN_MEM_BIAS);
 543 }
 544
 545 void
 546 titan_iounmap(volatile void __iomem *xaddr)
 547 {
 548         unsigned long addr = (unsigned long) xaddr;
 549         if (addr >= VMALLOC_START)
 550                 vfree((void *)(PAGE_MASK & addr));
 551 }
 552
 553 int
 554 titan_is_mmio(const volatile void __iomem *xaddr)
 555 {
 556         unsigned long addr = (unsigned long) xaddr;
 557
 558         if (addr >= VMALLOC_START)
 559                 return 1;
 560         else
 561                 return (addr & 0x100000000UL) == 0;
 562 }
 563
 564 #ifndef CONFIG_ALPHA_GENERIC
 565 EXPORT_SYMBOL(titan_ioportmap);
 566 EXPORT_SYMBOL(titan_ioremap);
 567 EXPORT_SYMBOL(titan_iounmap);
 568 EXPORT_SYMBOL(titan_is_mmio);
 569 #endif
 570 \f
 571 /*
 572  * AGP GART Support.
 573  */
 574 #include <linux/agp_backend.h>
 575 #include <asm/agp_backend.h>
 576 #include <linux/slab.h>
 577 #include <linux/delay.h>
 578
 579 struct titan_agp_aperture {
 580         struct pci_iommu_arena *arena;
 581         long pg_start;
 582         long pg_count;
 583 };
 584
 585 static int
 586 titan_agp_setup(alpha_agp_info *agp)
 587 {
 588         struct titan_agp_aperture *aper;
 589
 590         if (!alpha_agpgart_size)
 591                 return -ENOMEM;
 592
 593         aper = kmalloc(sizeof(struct titan_agp_aperture), GFP_KERNEL);
 594         if (aper == NULL)
 595                 return -ENOMEM;
 596
 597         aper->arena = agp->hose->sg_pci;
 598         aper->pg_count = alpha_agpgart_size / PAGE_SIZE;
 599         aper->pg_start = iommu_reserve(aper->arena, aper->pg_count,
 600                                        aper->pg_count - 1);
 601         if (aper->pg_start < 0) {
 602                 printk(KERN_ERR "Failed to reserve AGP memory\n");
 603                 kfree(aper);
 604                 return -ENOMEM;
 605         }
 606
 607         agp->aperture.bus_base =
 608                 aper->arena->dma_base + aper->pg_start * PAGE_SIZE;
 609         agp->aperture.size = aper->pg_count * PAGE_SIZE;
 610         agp->aperture.sysdata = aper;
 611
 612         return 0;
 613 }
 614
 615 static void
 616 titan_agp_cleanup(alpha_agp_info *agp)
 617 {
 618         struct titan_agp_aperture *aper = agp->aperture.sysdata;
 619         int status;
 620
 621         status = iommu_release(aper->arena, aper->pg_start, aper->pg_count);
 622         if (status == -EBUSY) {
 623                 printk(KERN_WARNING
 624                        "Attempted to release bound AGP memory - unbinding\n");
 625                 iommu_unbind(aper->arena, aper->pg_start, aper->pg_count);
 626                 status = iommu_release(aper->arena, aper->pg_start,
 627                                        aper->pg_count);
 628         }
 629         if (status < 0)
 630                 printk(KERN_ERR "Failed to release AGP memory\n");
 631
 632         kfree(aper);
 633         kfree(agp);
 634 }
 635
 636 static int
 637 titan_agp_configure(alpha_agp_info *agp)
 638 {
 639         union TPAchipPCTL pctl;
 640         titan_pachip_port *port = agp->private;
 641         pctl.pctl_q_whole = port->pctl.csr;
 642
 643         /* Side-Band Addressing? */
 644         pctl.pctl_r_bits.apctl_v_agp_sba_en = agp->mode.bits.sba;
 645
 646         /* AGP Rate? */
 647         pctl.pctl_r_bits.apctl_v_agp_rate = 0;          /* 1x */
 648         if (agp->mode.bits.rate & 2)
 649                 pctl.pctl_r_bits.apctl_v_agp_rate = 1;  /* 2x */
 650 #if 0
 651         if (agp->mode.bits.rate & 4)
 652                 pctl.pctl_r_bits.apctl_v_agp_rate = 2;  /* 4x */
 653 #endif
 654
 655         /* RQ Depth? */
 656         pctl.pctl_r_bits.apctl_v_agp_hp_rd = 2;
 657         pctl.pctl_r_bits.apctl_v_agp_lp_rd = 7;
 658
 659         /*
 660          * AGP Enable.
 661          */
 662         pctl.pctl_r_bits.apctl_v_agp_en = agp->mode.bits.enable;
 663
 664         /* Tell the user.  */
 665         printk("Enabling AGP: %dX%s\n",
 666                1 << pctl.pctl_r_bits.apctl_v_agp_rate,
 667                pctl.pctl_r_bits.apctl_v_agp_sba_en ? " - SBA" : "");
 668
 669         /* Write it.  */
 670         port->pctl.csr = pctl.pctl_q_whole;
 671
 672         /* And wait at least 5000 66MHz cycles (per Titan spec).  */
 673         udelay(100);
 674
 675         return 0;
 676 }
 677
 678 static int
 679 titan_agp_bind_memory(alpha_agp_info *agp, off_t pg_start, struct agp_memory *mem)
 680 {
 681         struct titan_agp_aperture *aper = agp->aperture.sysdata;
 682         return iommu_bind(aper->arena, aper->pg_start + pg_start,
 683                           mem->page_count, mem->memory);
 684 }
 685
 686 static int
 687 titan_agp_unbind_memory(alpha_agp_info *agp, off_t pg_start, struct agp_memory *mem)
 688 {
 689         struct titan_agp_aperture *aper = agp->aperture.sysdata;
 690         return iommu_unbind(aper->arena, aper->pg_start + pg_start,
 691                             mem->page_count);
 692 }
 693
 694 static unsigned long
 695 titan_agp_translate(alpha_agp_info *agp, dma_addr_t addr)
 696 {
 697         struct titan_agp_aperture *aper = agp->aperture.sysdata;
 698         unsigned long baddr = addr - aper->arena->dma_base;
 699         unsigned long pte;
 700
 701         if (addr < agp->aperture.bus_base ||
 702             addr >= agp->aperture.bus_base + agp->aperture.size) {
 703                 printk("%s: addr out of range\n", __FUNCTION__);
 704                 return -EINVAL;
 705         }
 706
 707         pte = aper->arena->ptes[baddr >> PAGE_SHIFT];
 708         if (!(pte & 1)) {
 709                 printk("%s: pte not valid\n", __FUNCTION__);
 710                 return -EINVAL;
 711         }
 712
 713         return (pte >> 1) << PAGE_SHIFT;
 714 }
 715
 716 struct alpha_agp_ops titan_agp_ops =
 717 {
 718         .setup          = titan_agp_setup,
 719         .cleanup        = titan_agp_cleanup,
 720         .configure      = titan_agp_configure,
 721         .bind           = titan_agp_bind_memory,
 722         .unbind         = titan_agp_unbind_memory,
 723         .translate      = titan_agp_translate
 724 };
 725
 726 alpha_agp_info *
 727 titan_agp_info(void)
 728 {
 729         alpha_agp_info *agp;
 730         struct pci_controller *hose;
 731         titan_pachip_port *port;
 732         int hosenum = -1;
 733         union TPAchipPCTL pctl;
 734
 735         /*
 736          * Find the AGP port.
 737          */
 738         port = &TITAN_pachip0->a_port;
 739         if (titan_query_agp(port))
 740                 hosenum = 2;
 741         if (hosenum < 0 &&
 742             titan_pchip1_present &&
 743             titan_query_agp(port = &TITAN_pachip1->a_port))
 744                 hosenum = 3;
 745
 746         /*
 747          * Find the hose the port is on.
 748          */
 749         for (hose = hose_head; hose; hose = hose->next)
 750                 if (hose->index == hosenum)
 751                         break;
 752
 753         if (!hose || !hose->sg_pci)
 754                 return NULL;
 755
 756         /*
 757          * Allocate the info structure.
 758          */
 759         agp = kmalloc(sizeof(*agp), GFP_KERNEL);
 760
 761         /*
 762          * Fill it in.
 763          */
 764         agp->hose = hose;
 765         agp->private = port;
 766         agp->ops = &titan_agp_ops;
 767
 768         /*
 769          * Aperture - not configured until ops.setup().
 770          *
 771          * FIXME - should we go ahead and allocate it here?
 772          */
 773         agp->aperture.bus_base = 0;
 774         agp->aperture.size = 0;
 775         agp->aperture.sysdata = NULL;
 776
 777         /*
 778          * Capabilities.
 779          */
 780         agp->capability.lw = 0;
 781         agp->capability.bits.rate = 3;  /* 2x, 1x */
 782         agp->capability.bits.sba = 1;
 783         agp->capability.bits.rq = 7;    /* 8 - 1 */
 784
 785         /*
 786          * Mode.
 787          */
 788         pctl.pctl_q_whole = port->pctl.csr;
 789         agp->mode.lw = 0;
 790         agp->mode.bits.rate = 1 << pctl.pctl_r_bits.apctl_v_agp_rate;
 791         agp->mode.bits.sba = pctl.pctl_r_bits.apctl_v_agp_sba_en;
 792         agp->mode.bits.rq = 7;  /* RQ Depth? */
 793         agp->mode.bits.enable = pctl.pctl_r_bits.apctl_v_agp_en;
 794
 795         return agp;
 796 }