diff options
author | Taru Karttunen <taruti@taruti.net> | 2011-03-30 15:46:40 +0300 |
---|---|---|
committer | Taru Karttunen <taruti@taruti.net> | 2011-03-30 15:46:40 +0300 |
commit | e5888a1ffdae813d7575f5fb02275c6bb07e5199 (patch) | |
tree | d8d51eac403f07814b9e936eed0c9a79195e2450 /sys/src/9/pc/devpccard.c |
Import sources from 2011-03-30 iso image
Diffstat (limited to 'sys/src/9/pc/devpccard.c')
-rwxr-xr-x | sys/src/9/pc/devpccard.c | 1918 |
1 files changed, 1918 insertions, 0 deletions
diff --git a/sys/src/9/pc/devpccard.c b/sys/src/9/pc/devpccard.c new file mode 100755 index 000000000..cd7321de9 --- /dev/null +++ b/sys/src/9/pc/devpccard.c @@ -0,0 +1,1918 @@ +/* + cardbus and pcmcia (grmph) support. +*/ +#include "u.h" +#include "../port/lib.h" +#include "mem.h" +#include "dat.h" +#include "fns.h" +#include "../port/error.h" +#include "io.h" + +#define DEBUG 0 + +#pragma varargck type "T" int + +#define MAP(x,o) (Rmap + (x)*0x8 + o) + +enum { + TI_vid = 0x104c, + TI_1131_did = 0xAC15, + TI_1250_did = 0xAC16, + TI_1450_did = 0xAC1B, + TI_1251A_did = 0xAC1D, + TI_1420_did = 0xAC51, + + Ricoh_vid = 0x1180, + Ricoh_475_did = 0x0475, + Ricoh_476_did = 0x0476, + Ricoh_478_did = 0x0478, + + O2_vid = 0x1217, + O2_OZ711M3_did = 0x7134, + + Nslots = 4, /* Maximum number of CardBus slots to use */ + + K = 1024, + M = K * K, + + LegacyAddr = 0x3e0, + NUMEVENTS = 10, + + TI1131xSC = 0x80, /* system control */ + TI122X_SC_INTRTIE = 1 << 29, + TI12xxIM = 0x8c, /* */ + TI1131xCC = 0x91, /* card control */ + TI113X_CC_RIENB = 1 << 7, + TI113X_CC_ZVENABLE = 1 << 6, + TI113X_CC_PCI_IRQ_ENA = 1 << 5, + TI113X_CC_PCI_IREQ = 1 << 4, + TI113X_CC_PCI_CSC = 1 << 3, + TI113X_CC_SPKROUTEN = 1 << 1, + TI113X_CC_IFG = 1 << 0, + TI1131xDC = 0x92, /* device control */ +}; + +typedef struct Variant Variant; +struct Variant { + ushort vid; + ushort did; + char *name; +}; + +static Variant variant[] = { +{ Ricoh_vid, Ricoh_475_did, "Ricoh 475 PCI/Cardbus bridge", }, +{ Ricoh_vid, Ricoh_476_did, "Ricoh 476 PCI/Cardbus bridge", }, +{ Ricoh_vid, Ricoh_478_did, "Ricoh 478 PCI/Cardbus bridge", }, +{ TI_vid, TI_1131_did, "TI PCI-1131 Cardbus Controller", }, +{ TI_vid, TI_1250_did, "TI PCI-1250 Cardbus Controller", }, +{ TI_vid, TI_1450_did, "TI PCI-1450 Cardbus Controller", }, +{ TI_vid, TI_1251A_did, "TI PCI-1251A Cardbus Controller", }, +{ TI_vid, TI_1420_did, "TI PCI-1420 Cardbus Controller", }, +{ O2_vid, O2_OZ711M3_did, "O2Micro OZ711M3 MemoryCardBus", }, +}; + +/* Cardbus registers */ +enum { + SocketEvent = 0, + SE_CCD = 3 << 1, + SE_POWER = 1 << 3, + SocketMask = 1, + SocketState = 2, + SS_CCD = 3 << 1, + SS_POWER = 1 << 3, + SS_PC16 = 1 << 4, + SS_CBC = 1 << 5, + SS_NOTCARD = 1 << 7, + SS_BADVCC = 1 << 9, + SS_5V = 1 << 10, + SS_3V = 1 << 11, + SocketForce = 3, + SocketControl = 4, + SC_5V = 0x22, + SC_3V = 0x33, +}; + +enum { + PciPCR_IO = 1 << 0, + PciPCR_MEM = 1 << 1, + PciPCR_Master = 1 << 2, + + PciPMC = 0xa4, + + Nbars = 6, + Ncmd = 10, + CBIRQ = 9, + + PC16, + PC32, +}; + +enum { + Ti82365, + Tpd6710, + Tpd6720, + Tvg46x, +}; + +/* + * Intel 82365SL PCIC controller for the PCMCIA or + * Cirrus Logic PD6710/PD6720 which is mostly register compatible + */ +enum +{ + /* + * registers indices + */ + Rid= 0x0, /* identification and revision */ + Ris= 0x1, /* interface status */ + Rpc= 0x2, /* power control */ + Foutena= (1<<7), /* output enable */ + Fautopower= (1<<5), /* automatic power switching */ + Fcardena= (1<<4), /* PC card enable */ + Rigc= 0x3, /* interrupt and general control */ + Fiocard= (1<<5), /* I/O card (vs memory) */ + Fnotreset= (1<<6), /* reset if not set */ + FSMIena= (1<<4), /* enable change interrupt on SMI */ + Rcsc= 0x4, /* card status change */ + Rcscic= 0x5, /* card status change interrupt config */ + Fchangeena= (1<<3), /* card changed */ + Fbwarnena= (1<<1), /* card battery warning */ + Fbdeadena= (1<<0), /* card battery dead */ + Rwe= 0x6, /* address window enable */ + Fmem16= (1<<5), /* use A23-A12 to decode address */ + Rio= 0x7, /* I/O control */ + Fwidth16= (1<<0), /* 16 bit data width */ + Fiocs16= (1<<1), /* IOCS16 determines data width */ + Fzerows= (1<<2), /* zero wait state */ + Ftiming= (1<<3), /* timing register to use */ + Riobtm0lo= 0x8, /* I/O address 0 start low byte */ + Riobtm0hi= 0x9, /* I/O address 0 start high byte */ + Riotop0lo= 0xa, /* I/O address 0 stop low byte */ + Riotop0hi= 0xb, /* I/O address 0 stop high byte */ + Riobtm1lo= 0xc, /* I/O address 1 start low byte */ + Riobtm1hi= 0xd, /* I/O address 1 start high byte */ + Riotop1lo= 0xe, /* I/O address 1 stop low byte */ + Riotop1hi= 0xf, /* I/O address 1 stop high byte */ + Rmap= 0x10, /* map 0 */ + + /* + * CL-PD67xx extension registers + */ + Rmisc1= 0x16, /* misc control 1 */ + F5Vdetect= (1<<0), + Fvcc3V= (1<<1), + Fpmint= (1<<2), + Fpsirq= (1<<3), + Fspeaker= (1<<4), + Finpack= (1<<7), + Rfifo= 0x17, /* fifo control */ + Fflush= (1<<7), /* flush fifo */ + Rmisc2= 0x1E, /* misc control 2 */ + Flowpow= (1<<1), /* low power mode */ + Rchipinfo= 0x1F, /* chip information */ + Ratactl= 0x26, /* ATA control */ + + /* + * offsets into the system memory address maps + */ + Mbtmlo= 0x0, /* System mem addr mapping start low byte */ + Mbtmhi= 0x1, /* System mem addr mapping start high byte */ + F16bit= (1<<7), /* 16-bit wide data path */ + Mtoplo= 0x2, /* System mem addr mapping stop low byte */ + Mtophi= 0x3, /* System mem addr mapping stop high byte */ + Ftimer1= (1<<6), /* timer set 1 */ + Mofflo= 0x4, /* Card memory offset address low byte */ + Moffhi= 0x5, /* Card memory offset address high byte */ + Fregactive= (1<<6), /* attribute memory */ + + /* + * configuration registers - they start at an offset in attribute + * memory found in the CIS. + */ + Rconfig= 0, + Creset= (1<<7), /* reset device */ + Clevel= (1<<6), /* level sensitive interrupt line */ +}; + +/* + * read and crack the card information structure enough to set + * important parameters like power + */ +/* cis memory walking */ +typedef struct Cisdat Cisdat; +struct Cisdat { + uchar *cisbase; + int cispos; + int cisskip; + int cislen; +}; + +typedef struct Pcminfo Pcminfo; +struct Pcminfo { + char verstr[512]; /* Version string */ + PCMmap mmap[4]; /* maps, last is always for the kernel */ + ulong conf_addr; /* Config address */ + uchar conf_present; /* Config register present */ + int nctab; /* In use configuration tables */ + PCMconftab ctab[8]; /* Configuration tables */ + PCMconftab *defctab; /* Default conftab */ + + int port; /* Actual port usage */ + int irq; /* Actual IRQ usage */ +}; + +typedef struct Cardbus Cardbus; +struct Cardbus { + Lock; + Variant *variant; /* Which CardBus chipset */ + Pcidev *pci; /* The bridge itself */ + ulong *regs; /* Cardbus registers */ + int ltype; /* Legacy type */ + int lindex; /* Legacy port index address */ + int ldata; /* Legacy port data address */ + int lbase; /* Base register for this socket */ + + int state; /* Current state of card */ + int type; /* Type of card */ + Pcminfo linfo; /* PCMCIA slot info */ + + int special; /* card is allocated to a driver */ + + int refs; /* Number of refs to slot */ + Lock refslock; /* inc/dev ref lock */ +}; + +static int managerstarted; + +enum { + Mshift= 12, + Mgran= (1<<Mshift), /* granularity of maps */ + Mmask= ~(Mgran-1), /* mask for address bits important to the chip */ +}; + +static Cardbus cbslots[Nslots]; +static int nslots; + +static ulong exponent[8] = { + 1, 10, 100, 1000, 10000, 100000, 1000000, 10000000, +}; + +static ulong vmant[16] = { + 10, 12, 13, 15, 20, 25, 30, 35, 40, 45, 50, 55, 60, 70, 80, 90, +}; + +static ulong mantissa[16] = { + 0, 10, 12, 13, 15, 20, 25, 30, 35, 40, 45, 50, 55, 60, 70, 80, +}; + +static char Enocard[] = "No card in slot"; + +enum +{ + CMdown, + CMpower, +}; + +static Cmdtab pccardctlmsg[] = +{ + CMdown, "down", 2, + CMpower, "power", 1, +}; + +static int powerup(Cardbus *); +static void configure(Cardbus *); +static void powerdown(Cardbus *cb); +static void unconfigure(Cardbus *cb); + +static void i82365probe(Cardbus *cb, int lindex, int ldata); +static void i82365configure(Cardbus *cb); +static PCMmap *isamap(Cardbus *cb, ulong offset, int len, int attr); +static void isaunmap(PCMmap* m); +static uchar rdreg(Cardbus *cb, int index); +static void wrreg(Cardbus *cb, int index, uchar val); +static int readc(Cisdat *cis, uchar *x); +static void tvers1(Cardbus *cb, Cisdat *cis, int ); +static void tcfig(Cardbus *cb, Cisdat *cis, int ); +static void tentry(Cardbus *cb, Cisdat *cis, int ); +static int vcode(int volt); +static int pccard_pcmspecial(char *idstr, ISAConf *isa); +static void pccard_pcmspecialclose(int slotno); + +enum { + CardDetected, + CardPowered, + CardEjected, + CardConfigured, +}; + +static char *messages[] = { +[CardDetected] "CardDetected", +[CardPowered] "CardPowered", +[CardEjected] "CardEjected", +[CardConfigured] "CardConfigured", +}; + +enum { + SlotEmpty, + SlotFull, + SlotPowered, + SlotConfigured, +}; + +static char *states[] = { +[SlotEmpty] "SlotEmpty", +[SlotFull] "SlotFull", +[SlotPowered] "SlotPowered", +[SlotConfigured] "SlotConfigured", +}; + +static void +engine(Cardbus *cb, int message) +{ + if(DEBUG) + print("engine(%ld): %s(%s)\n", cb - cbslots, + states[cb->state], messages[message]); + switch (cb->state) { + case SlotEmpty: + + switch (message) { + case CardDetected: + cb->state = SlotFull; + powerup(cb); + break; + case CardEjected: + break; + default: + if(DEBUG) + print("#Y%ld: Invalid message %s in SlotEmpty state\n", + cb - cbslots, messages[message]); + break; + } + break; + + case SlotFull: + + switch (message) { + case CardPowered: + cb->state = SlotPowered; + configure(cb); + break; + case CardEjected: + cb->state = SlotEmpty; + powerdown(cb); + break; + default: + if(DEBUG) + print("#Y%ld: Invalid message %s in SlotFull state\n", + cb - cbslots, messages[message]); + break; + } + break; + + case SlotPowered: + + switch (message) { + case CardConfigured: + cb->state = SlotConfigured; + break; + case CardEjected: + cb->state = SlotEmpty; + unconfigure(cb); + powerdown(cb); + break; + default: + print("#Y%ld: Invalid message %s in SlotPowered state\n", + cb - cbslots, messages[message]); + break; + } + break; + + case SlotConfigured: + + switch (message) { + case CardEjected: + cb->state = SlotEmpty; + unconfigure(cb); + powerdown(cb); + break; + default: + if(DEBUG) + print("#Y%ld: Invalid message %s in SlotConfigured state\n", + cb - cbslots, messages[message]); + break; + } + break; + } +} + +static void +qengine(Cardbus *cb, int message) +{ + lock(cb); + engine(cb, message); + unlock(cb); +} + +typedef struct Events Events; +struct Events { + Cardbus *cb; + int message; +}; + +static Lock levents; +static Events events[NUMEVENTS]; +static Rendez revents; +static int nevents; + +static void +iengine(Cardbus *cb, int message) +{ + if (nevents >= NUMEVENTS) { + print("#Y: Too many events queued, discarding request\n"); + return; + } + ilock(&levents); + events[nevents].cb = cb; + events[nevents].message = message; + nevents++; + iunlock(&levents); + wakeup(&revents); +} + +static int +eventoccured(void) +{ + return nevents > 0; +} + +static void +processevents(void *) +{ + while (1) { + int message; + Cardbus *cb; + + sleep(&revents, (int (*)(void *))eventoccured, nil); + + cb = nil; + message = 0; + ilock(&levents); + if (nevents > 0) { + cb = events[0].cb; + message = events[0].message; + nevents--; + if (nevents > 0) + memmove(events, &events[1], nevents * sizeof(Events)); + } + iunlock(&levents); + + if (cb) + qengine(cb, message); + } +} + +static void +cbinterrupt(Ureg *, void *) +{ + int i; + + for (i = 0; i != nslots; i++) { + Cardbus *cb = &cbslots[i]; + ulong event, state; + + event = cb->regs[SocketEvent]; + if(!(event & (SE_POWER|SE_CCD))) + continue; + state = cb->regs[SocketState]; + rdreg(cb, Rcsc); /* Ack the interrupt */ + + if(DEBUG) + print("#Y%ld: interrupt: event %.8lX, state %.8lX, (%s)\n", + cb - cbslots, event, state, states[cb->state]); + + if (event & SE_CCD) { + cb->regs[SocketEvent] |= SE_CCD; /* Ack interrupt */ + if (state & SE_CCD) { + if (cb->state != SlotEmpty) { + print("#Y: take cardejected interrupt\n"); + iengine(cb, CardEjected); + } + } + else + iengine(cb, CardDetected); + } + + if (event & SE_POWER) { + cb->regs[SocketEvent] |= SE_POWER; /* Ack interrupt */ + iengine(cb, CardPowered); + } + } +} + +void +devpccardlink(void) +{ + static int initialized; + Pcidev *pci; + int i; + uchar intl; + char *p; + void *baddrva; + + if (initialized) + return; + initialized = 1; + + if((p=getconf("pccard0")) && strncmp(p, "disabled", 8)==0) + return; + + if(_pcmspecial) + return; + + /* Allocate legacy space */ + if (ioalloc(LegacyAddr, 2, 0, "i82365.0") < 0) + print("#Y: WARNING: Cannot allocate legacy ports\n"); + + /* Find all CardBus controllers */ + pci = nil; + intl = 0xff; + while ((pci = pcimatch(pci, 0, 0)) != nil) { + ulong baddr; + Cardbus *cb; + int slot; + uchar pin; + + if(pci->ccrb != 6 || pci->ccru != 7) + continue; + for (i = 0; i != nelem(variant); i++) + if (pci->vid == variant[i].vid && pci->did == variant[i].did) + break; + if (i == nelem(variant)) + continue; + + /* initialize this slot */ + slot = nslots++; + cb = &cbslots[slot]; + + cb->pci = pci; + cb->variant = &variant[i]; + + if (pci->vid != TI_vid) { + /* + * Gross hack, needs a fix. Inherit the mappings from + * 9load for the TIs (pb) + */ + pcicfgw32(pci, PciCBMBR0, 0xffffffff); + pcicfgw32(pci, PciCBMLR0, 0); + pcicfgw32(pci, PciCBMBR1, 0xffffffff); + pcicfgw32(pci, PciCBMLR1, 0); + pcicfgw32(pci, PciCBIBR0, 0xffffffff); + pcicfgw32(pci, PciCBILR0, 0); + pcicfgw32(pci, PciCBIBR1, 0xffffffff); + pcicfgw32(pci, PciCBILR1, 0); + } + + /* Set up PCI bus numbers if needed. */ + if (pcicfgr8(pci, PciSBN) == 0) { + static int busbase = 0x20; + + pcicfgw8(pci, PciSBN, busbase); + pcicfgw8(pci, PciUBN, busbase + 2); + busbase += 3; + } + + /* Patch up intl if needed. */ + if ((pin = pcicfgr8(pci, PciINTP)) != 0 && + (pci->intl == 0xff || pci->intl == 0)) { + pci->intl = pciipin(nil, pin); + pcicfgw8(pci, PciINTL, pci->intl); + + if (pci->intl == 0xff || pci->intl == 0) + print("#Y%ld: No interrupt?\n", cb - cbslots); + } + + /* Don't you love standards! */ + if (pci->vid == TI_vid) { + if (pci->did <= TI_1131_did) { + uchar cc; + + cc = pcicfgr8(pci, TI1131xCC); + cc &= ~(TI113X_CC_PCI_IRQ_ENA | + TI113X_CC_PCI_IREQ | + TI113X_CC_PCI_CSC | + TI113X_CC_ZVENABLE); + cc |= TI113X_CC_PCI_IRQ_ENA | + TI113X_CC_PCI_IREQ | + TI113X_CC_SPKROUTEN; + pcicfgw8(pci, TI1131xCC, cc); + + /* PCI interrupts only */ + pcicfgw8(pci, TI1131xDC, + pcicfgr8(pci, TI1131xDC) & ~6); + + /* CSC ints to PCI bus. */ + wrreg(cb, Rigc, rdreg(cb, Rigc) | 0x10); + } + else if (pci->did == TI_1250_did) { + print("No support yet for the TI_1250_did, prod pb\n"); + } + else if (pci->did == TI_1420_did) { + /* Disable Vcc protection */ + pcicfgw32(cb->pci, 0x80, + pcicfgr32(cb->pci, 0x80) | (1 << 21)); + } + + pcicfgw16(cb->pci, PciPMC, pcicfgr16(cb->pci, PciPMC) & ~3); + } + if (pci->vid == O2_vid) { + if(DEBUG) + print("writing O2 config\n"); + pcicfgw8(cb->pci, 0x94, 0xCA); + pcicfgw8(cb->pci, 0xD4, 0xCA); + } + + if (intl != 0xff && intl != pci->intl) + intrenable(pci->intl, cbinterrupt, cb, pci->tbdf, "cardbus"); + intl = pci->intl; + + if ((baddr = pcicfgr32(cb->pci, PciBAR0)) == 0) { + int size = (pci->did == Ricoh_478_did)? 0x10000: 0x1000; + + baddr = upaalloc(size, size); + baddrva = vmap(baddr, size); + pcicfgw32(cb->pci, PciBAR0, baddr); + cb->regs = (ulong *)baddrva; + } + else + cb->regs = (ulong *)vmap(baddr, 4096); + cb->state = SlotEmpty; + + /* Don't really know what to do with this... */ + i82365probe(cb, LegacyAddr, LegacyAddr + 1); + + print("#Y%ld: %s, %.8ulX intl %d\n", cb - cbslots, + variant[i].name, baddr, pci->intl); + } + + if (nslots == 0){ + iofree(LegacyAddr); + return; + } + + _pcmspecial = pccard_pcmspecial; + _pcmspecialclose = pccard_pcmspecialclose; + + for (i = 0; i != nslots; i++) { + Cardbus *cb = &cbslots[i]; + + if ((cb->regs[SocketState] & SE_CCD) == 0) + engine(cb, CardDetected); + } + + delay(500); /* Allow time for power up */ + + for (i = 0; i != nslots; i++) { + Cardbus *cb = &cbslots[i]; + + if (cb->regs[SocketState] & SE_POWER) + engine(cb, CardPowered); + + /* Ack and enable interrupts on all events */ + // cb->regs[SocketEvent] = cb->regs[SocketEvent]; + cb->regs[SocketMask] |= 0xF; + wrreg(cb, Rcscic, 0xC); + } +} + +static int +powerup(Cardbus *cb) +{ + ulong state; + ushort bcr; + + state = cb->regs[SocketState]; + if (state & SS_PC16) { + if(DEBUG) + print("#Y%ld: Probed a PC16 card, powering up card\n", + cb - cbslots); + cb->type = PC16; + memset(&cb->linfo, 0, sizeof(Pcminfo)); + + /* power up and unreset, wait's are empirical (???) */ + wrreg(cb, Rpc, Fautopower|Foutena|Fcardena); + delay(300); + wrreg(cb, Rigc, 0); + delay(100); + wrreg(cb, Rigc, Fnotreset); + delay(500); + +// return 1; + } + + if (state & SS_CCD) + return 0; + + if (state & SS_NOTCARD) { + print("#Y%ld: No card inserted\n", cb - cbslots); + return 0; + } + + if ((state & SS_3V) == 0 && (state & SS_5V) == 0) { + print("#Y%ld: Unsupported voltage, powering down card!\n", + cb - cbslots); + cb->regs[SocketControl] = 0; + return 0; + } + + if(DEBUG) + print("#Y%ld: card %spowered at %d volt\n", cb - cbslots, + (state & SS_POWER)? "": "not ", + (state & SS_3V)? 3: (state & SS_5V)? 5: -1); + + /* Power up the card + * and make sure the secondary bus is not in reset. + */ + cb->regs[SocketControl] = (state & SS_5V)? SC_5V: SC_3V; + delay(50); + bcr = pcicfgr16(cb->pci, PciBCR); + bcr &= ~0x40; + pcicfgw16(cb->pci, PciBCR, bcr); + delay(100); + + if (state & SS_PC16) + cb->type = PC16; + else + cb->type = PC32; + + return 1; +} + +static void +powerdown(Cardbus *cb) +{ + ushort bcr; + + if (cb->type == PC16) { + + wrreg(cb, Rpc, 0); /* turn off card power */ + wrreg(cb, Rwe, 0); /* no windows */ + + cb->type = -1; + return; + } + + bcr = pcicfgr16(cb->pci, PciBCR); + bcr |= 0x40; + pcicfgw16(cb->pci, PciBCR, bcr); + cb->regs[SocketControl] = 0; + cb->type = -1; +} + +static void +configure(Cardbus *cb) +{ + int i, r; + ulong size, bar; + Pcidev *pci; + ulong membase, iobase, memlen, iolen, rombase, romlen; + + if(DEBUG) + print("configuring slot %ld (%s)\n", cb - cbslots, states[cb->state]); + if (cb->state == SlotConfigured) + return; + engine(cb, CardConfigured); + + delay(50); /* Emperically established */ + + if (cb->type == PC16) { + i82365configure(cb); + return; + } + + /* Scan the CardBus for new PCI devices */ + pciscan(pcicfgr8(cb->pci, PciSBN), &cb->pci->bridge); + + /* + * size the devices on the bus, reserve a minimum for devices arriving later, + * allow for ROM space, allocate space, and set the cardbus mapping registers + */ + pcibussize(cb->pci->bridge, &memlen, &iolen); /* TO DO: need initial alignments */ + + romlen = 0; + for(pci = cb->pci->bridge; pci != nil; pci = pci->list){ + size = pcibarsize(pci, PciEBAR0); + if(size > 0){ + pci->rom.bar = -1; + pci->rom.size = size; + romlen += size; + } + } + + if(iolen < 512) + iolen = 512; + iobase = ioreserve(~0, iolen, 0, "cardbus"); + pcicfgw32(cb->pci, PciCBIBR0, iobase); + pcicfgw32(cb->pci, PciCBILR0, iobase + iolen-1); + pcicfgw32(cb->pci, PciCBIBR1, 0); + pcicfgw32(cb->pci, PciCBILR1, 0); + + rombase = memlen; + memlen += romlen; + if(memlen < 1*1024*1024) + memlen = 1*1024*1024; + membase = upaalloc(memlen, 4*1024*1024); /* TO DO: better alignment */ + pcicfgw32(cb->pci, PciCBMBR0, membase); + pcicfgw32(cb->pci, PciCBMLR0, membase + memlen-1); + pcicfgw32(cb->pci, PciCBMBR1, 0); + pcicfgw32(cb->pci, PciCBMLR1, 0); + +// pcibussize(cb->pci->bridge, &membase, &iobase); /* now assign them */ + rombase += membase; + + for(pci = cb->pci->bridge; pci != nil; pci = pci->list){ + r = pcicfgr16(pci, PciPCR); + r &= ~(PciPCR_IO|PciPCR_MEM); + pcicfgw16(pci, PciPCR, r); + + /* + * Treat the found device as an ordinary PCI card. + * It seems that the CIS is not always present in + * CardBus cards. + * XXX, need to support multifunction cards + */ + for(i = 0; i < Nbars; i++) { + if(pci->mem[i].size == 0) + continue; + bar = pci->mem[i].bar; + if(bar & 1) + bar += iobase; + else + bar += membase; + pci->mem[i].bar = bar; + pcicfgw32(pci, PciBAR0 + 4*i, bar); + if((bar & 1) == 0){ + print("%T mem[%d] %8.8lux %d\n", pci->tbdf, i, bar, pci->mem[i].size); + if(bar & 0x80){ /* TO DO: enable prefetch */ + ; + } + } + } + if((size = pcibarsize(pci, PciEBAR0)) > 0) { /* TO DO: can this be done by pci.c? */ + pci->rom.bar = rombase; + pci->rom.size = size; + rombase += size; + pcicfgw32(pci, PciEBAR0, pci->rom.bar); + } + + /* Set the basic PCI registers for the device */ + pci->pcr = pcicfgr16(pci, PciPCR); + pci->pcr |= PciPCR_IO|PciPCR_MEM|PciPCR_Master; + pci->cls = 8; + pci->ltr = 64; + pcicfgw16(pci, PciPCR, pci->pcr); + pcicfgw8(pci, PciCLS, pci->cls); + pcicfgw8(pci, PciLTR, pci->ltr); + + if (pcicfgr8(pci, PciINTP)) { + pci->intl = pcicfgr8(cb->pci, PciINTL); + pcicfgw8(pci, PciINTL, pci->intl); + + /* Route interrupts to INTA#/B# */ + pcicfgw16(cb->pci, PciBCR, + pcicfgr16(cb->pci, PciBCR) & ~(1 << 7)); + } + } +} + +static void +unconfigure(Cardbus *cb) +{ + Pcidev *pci; + int i, ioindex, memindex, r; + + if (cb->type == PC16) { + print("#Y%d: Don't know how to unconfigure a PC16 card\n", + (int)(cb - cbslots)); + + memset(&cb->linfo, 0, sizeof(Pcminfo)); + return; + } + + pci = cb->pci->bridge; + if (pci == nil) + return; /* Not configured */ + cb->pci->bridge = nil; + + memindex = ioindex = 0; + while (pci) { + Pcidev *_pci; + + for (i = 0; i != Nbars; i++) { + if (pci->mem[i].size == 0) + continue; + if (pci->mem[i].bar & 1) { + iofree(pci->mem[i].bar & ~1); + pcicfgw16(cb->pci, PciCBIBR0 + ioindex * 8, + (ushort)-1); + pcicfgw16(cb->pci, PciCBILR0 + ioindex * 8, 0); + ioindex++; + continue; + } + + upafree(pci->mem[i].bar & ~0xF, pci->mem[i].size); + pcicfgw32(cb->pci, PciCBMBR0 + memindex * 8, (ulong)-1); + pcicfgw32(cb->pci, PciCBMLR0 + memindex * 8, 0); + r = pcicfgr16(cb->pci, PciBCR); + r &= ~(1 << (8 + memindex)); + pcicfgw16(cb->pci, PciBCR, r); + memindex++; + } + + if (pci->rom.bar && memindex < 2) { + upafree(pci->rom.bar & ~0xF, pci->rom.size); + pcicfgw32(cb->pci, PciCBMBR0 + memindex * 8, (ulong)-1); + pcicfgw32(cb->pci, PciCBMLR0 + memindex * 8, 0); + memindex++; + } + + _pci = pci->list; + free(_pci); + pci = _pci; + } +} + +static void +i82365configure(Cardbus *cb) +{ + int this; + Cisdat cis; + PCMmap *m; + uchar type, link; + + /* + * Read all tuples in attribute space. + */ + m = isamap(cb, 0, 0, 1); + if(m == 0) + return; + + cis.cisbase = KADDR(m->isa); + cis.cispos = 0; + cis.cisskip = 2; + cis.cislen = m->len; + + /* loop through all the tuples */ + for(;;){ + this = cis.cispos; + if(readc(&cis, &type) != 1) + break; + if(type == 0xFF) + break; + if(readc(&cis, &link) != 1) + break; + + switch(type){ + default: + break; + case 0x15: + tvers1(cb, &cis, type); + break; + case 0x1A: + tcfig(cb, &cis, type); + break; + case 0x1B: + tentry(cb, &cis, type); + break; + } + + if(link == 0xFF) + break; + cis.cispos = this + (2+link); + } + isaunmap(m); +} + +/* + * look for a card whose version contains 'idstr' + */ +static int +pccard_pcmspecial(char *idstr, ISAConf *isa) +{ + int i, irq; + PCMconftab *ct, *et; + Pcminfo *pi; + Cardbus *cb; + uchar x, we, *p; + + cb = nil; + for (i = 0; i != nslots; i++) { + cb = &cbslots[i]; + + lock(cb); + if (cb->state == SlotConfigured && + cb->type == PC16 && + !cb->special && + strstr(cb->linfo.verstr, idstr)) + break; + unlock(cb); + } + + if (i == nslots) { + if(0 && DEBUG) + print("#Y: %s not found\n", idstr); + return -1; + } + + pi = &cb->linfo; + + /* + * configure the PCMslot for IO. We assume very heavily that we can read + * configuration info from the CIS. If not, we won't set up correctly. + */ + irq = isa->irq; + if(irq == 2) + irq = 9; + + et = &pi->ctab[pi->nctab]; + ct = nil; + for(i = 0; i < isa->nopt; i++){ + int index; + char *cp; + + if(strncmp(isa->opt[i], "index=", 6)) + continue; + index = strtol(&isa->opt[i][6], &cp, 0); + if(cp == &isa->opt[i][6] || index >= pi->nctab) { + unlock(cb); + print("#Y%d: Cannot find index %d in conf table\n", + (int)(cb - cbslots), index); + return -1; + } + ct = &pi->ctab[index]; + } + + if(ct == nil){ + PCMconftab *t; + + /* assume default is right */ + if(pi->defctab) + ct = pi->defctab; + else + ct = pi->ctab; + + /* try for best match */ + if(ct->nio == 0 + || ct->io[0].start != isa->port || ((1<<irq) & ct->irqs) == 0){ + for(t = pi->ctab; t < et; t++) + if(t->nio + && t->io[0].start == isa->port + && ((1<<irq) & t->irqs)){ + ct = t; + break; + } + } + if(ct->nio == 0 || ((1<<irq) & ct->irqs) == 0){ + for(t = pi->ctab; t < et; t++) + if(t->nio && ((1<<irq) & t->irqs)){ + ct = t; + break; + } + } + if(ct->nio == 0){ + for(t = pi->ctab; t < et; t++) + if(t->nio){ + ct = t; + break; + } + } + } + + if(ct == et || ct->nio == 0) { + unlock(cb); + print("#Y%d: No configuration?\n", (int)(cb - cbslots)); + return -1; + } + if(isa->port == 0 && ct->io[0].start == 0) { + unlock(cb); + print("#Y%d: No part or start address\n", (int)(cb - cbslots)); + return -1; + } + + cb->special = 1; /* taken */ + + /* route interrupts */ + isa->irq = irq; + wrreg(cb, Rigc, irq | Fnotreset | Fiocard); + + /* set power and enable device */ + x = vcode(ct->vpp1); + wrreg(cb, Rpc, x|Fautopower|Foutena|Fcardena); + + /* 16-bit data path */ + if(ct->bit16) + x = Ftiming|Fiocs16|Fwidth16; + else + x = Ftiming; + if(ct->nio == 2 && ct->io[1].start) + x |= x<<4; + wrreg(cb, Rio, x); + + /* + * enable io port map 0 + * the 'top' register value includes the last valid address + */ + if(isa->port == 0) + isa->port = ct->io[0].start; + we = rdreg(cb, Rwe); + wrreg(cb, Riobtm0lo, isa->port); + wrreg(cb, Riobtm0hi, isa->port>>8); + i = isa->port+ct->io[0].len-1; + wrreg(cb, Riotop0lo, i); + wrreg(cb, Riotop0hi, i>>8); + we |= 1<<6; + if(ct->nio == 2 && ct->io[1].start){ + wrreg(cb, Riobtm1lo, ct->io[1].start); + wrreg(cb, Riobtm1hi, ct->io[1].start>>8); + i = ct->io[1].start+ct->io[1].len-1; + wrreg(cb, Riotop1lo, i); + wrreg(cb, Riotop1hi, i>>8); + we |= 1<<7; + } + wrreg(cb, Rwe, we); + + /* only touch Rconfig if it is present */ + if(pi->conf_present & (1<<Rconfig)){ + PCMmap *m; + + /* Reset adapter */ + m = isamap(cb, pi->conf_addr + Rconfig, 1, 1); + p = KADDR(m->isa + pi->conf_addr + Rconfig - m->ca); + + /* set configuration and interrupt type */ + x = ct->index; + if(ct->irqtype & 0x20) + x |= Clevel; + *p = x; + delay(5); + + isaunmap(m); + } + + pi->port = isa->port; + pi->irq = isa->irq; + unlock(cb); + + print("#Y%ld: %s irq %d, port %lX\n", cb - cbslots, pi->verstr, isa->irq, isa->port); + return (int)(cb - cbslots); +} + +static void +pccard_pcmspecialclose(int slotno) +{ + Cardbus *cb = &cbslots[slotno]; + + wrreg(cb, Rwe, 0); /* no windows */ + cb->special = 0; +} + +static Chan* +pccardattach(char *spec) +{ + if (!managerstarted) { + managerstarted = 1; + kproc("cardbus", processevents, nil); + } + return devattach('Y', spec); +} + +enum +{ + Qdir, + Qctl, + + Nents = 1, +}; + +#define SLOTNO(c) ((ulong)((c->qid.path>>8)&0xff)) +#define TYPE(c) ((ulong)(c->qid.path&0xff)) +#define QID(s,t) (((s)<<8)|(t)) + +static int +pccardgen(Chan *c, char*, Dirtab *, int , int i, Dir *dp) +{ + int slotno; + Qid qid; + long len; + int entry; + + if(i == DEVDOTDOT){ + mkqid(&qid, Qdir, 0, QTDIR); + devdir(c, qid, "#Y", 0, eve, 0555, dp); + return 1; + } + + len = 0; + if(i >= Nents * nslots) return -1; + slotno = i / Nents; + entry = i % Nents; + if (entry == 0) { + qid.path = QID(slotno, Qctl); + snprint(up->genbuf, sizeof up->genbuf, "cb%dctl", slotno); + } + else { + /* Entries for memory regions. I'll implement them when + needed. (pb) */ + } + qid.vers = 0; + qid.type = QTFILE; + devdir(c, qid, up->genbuf, len, eve, 0660, dp); + return 1; +} + +static Walkqid* +pccardwalk(Chan *c, Chan *nc, char **name, int nname) +{ + return devwalk(c, nc, name, nname, 0, 0, pccardgen); +} + +static int +pccardstat(Chan *c, uchar *db, int n) +{ + return devstat(c, db, n, 0, 0, pccardgen); +} + +static void +increfp(Cardbus *cb) +{ + lock(&cb->refslock); + cb->refs++; + unlock(&cb->refslock); +} + +static void +decrefp(Cardbus *cb) +{ + lock(&cb->refslock); + cb->refs--; + unlock(&cb->refslock); +} + +static Chan* +pccardopen(Chan *c, int omode) +{ + if (c->qid.type & QTDIR){ + if(omode != OREAD) + error(Eperm); + } else + increfp(&cbslots[SLOTNO(c)]); + c->mode = openmode(omode); + c->flag |= COPEN; + c->offset = 0; + return c; +} + +static void +pccardclose(Chan *c) +{ + if(c->flag & COPEN) + if((c->qid.type & QTDIR) == 0) + decrefp(&cbslots[SLOTNO(c)]); +} + +static long +pccardread(Chan *c, void *a, long n, vlong offset) +{ + Cardbus *cb; + char *buf, *p, *e; + int i; + + switch(TYPE(c)){ + case Qdir: + return devdirread(c, a, n, 0, 0, pccardgen); + + case Qctl: + buf = p = malloc(READSTR); + buf[0] = 0; + e = p + READSTR; + + cb = &cbslots[SLOTNO(c)]; + lock(cb); + p = seprint(p, e, "slot %ld: %s; ", cb - cbslots, states[cb->state]); + + switch (cb->type) { + case -1: + seprint(p, e, "\n"); + break; + + case PC32: + if (cb->pci->bridge) { + Pcidev *pci = cb->pci->bridge; + int i; + + while (pci) { + p = seprint(p, e, "%.4uX %.4uX; irq %d\n", + pci->vid, pci->did, pci->intl); + for (i = 0; i != Nbars; i++) + if (pci->mem[i].size) + p = seprint(p, e, + "\tmem[%d] %.8ulX (%.8uX)\n", + i, pci->mem[i].bar, + pci->mem[i].size); + if (pci->rom.size) + p = seprint(p, e, "\tROM %.8ulX (%.8uX)\n", + pci->rom.bar, pci->rom.size); + pci = pci->list; + } + } + break; + + case PC16: + if (cb->state == SlotConfigured) { + Pcminfo *pi = &cb->linfo; + + p = seprint(p, e, "%s port %X; irq %d;\n", + pi->verstr, pi->port, + pi->irq); + for (i = 0; i != pi->nctab; i++) { + PCMconftab *ct; + int j; + + ct = &pi->ctab[i]; + p = seprint(p, e, + "\tconfiguration[%d] irqs %.4uX; vpp %d, %d; %s\n", + i, ct->irqs, ct->vpp1, ct->vpp2, + (ct == pi->defctab)? "(default);": ""); + for (j = 0; j != ct->nio; j++) + if (ct->io[j].len > 0) + p = seprint(p, e, "\t\tio[%d] %.8ulX %uld\n", + j, ct->io[j].start, ct->io[j].len); + } + } + break; + } + unlock(cb); + + n = readstr(offset, a, n, buf); + free(buf); + return n; + } + return 0; +} + +static long +pccardwrite(Chan *c, void *v, long n, vlong) +{ + Rune r; + ulong n0; + char *device; + Cmdbuf *cbf; + Cmdtab *ct; + Cardbus *cb; + + n0 = n; + switch(TYPE(c)){ + case Qctl: + cb = &cbslots[SLOTNO(c)]; + + cbf = parsecmd(v, n); + if(waserror()){ + free(cbf); + nexterror(); + } + ct = lookupcmd(cbf, pccardctlmsg, nelem(pccardctlmsg)); + switch(ct->index){ + case CMdown: + device = cbf->f[1]; + device += chartorune(&r, device); + if ((n = devno(r, 1)) >= 0 && devtab[n]->config) + devtab[n]->config(0, device, nil); + qengine(cb, CardEjected); + break; + case CMpower: + if ((cb->regs[SocketState] & SS_CCD) == 0) + qengine(cb, CardDetected); + break; + } + poperror(); + free(cbf); + break; + } + return n0 - n; +} + +Dev pccarddevtab = { + 'Y', + "cardbus", + + devreset, + devinit, + devshutdown, + pccardattach, + pccardwalk, + pccardstat, + pccardopen, + devcreate, + pccardclose, + pccardread, + devbread, + pccardwrite, + devbwrite, + devremove, + devwstat, +}; + +static PCMmap * +isamap(Cardbus *cb, ulong offset, int len, int attr) +{ + uchar we, bit; + PCMmap *m, *nm; + Pcminfo *pi; + int i; + ulong e; + + pi = &cb->linfo; + + /* convert offset to granularity */ + if(len <= 0) + len = 1; + e = ROUND(offset+len, Mgran); + offset &= Mmask; + len = e - offset; + + /* look for a map that covers the right area */ + we = rdreg(cb, Rwe); + bit = 1; + nm = 0; + for(m = pi->mmap; m < &pi->mmap[nelem(pi->mmap)]; m++){ + if((we & bit)) + if(m->attr == attr) + if(offset >= m->ca && e <= m->cea){ + + m->ref++; + return m; + } + bit <<= 1; + if(nm == 0 && m->ref == 0) + nm = m; + } + m = nm; + if(m == 0) + return 0; + + /* if isa space isn't big enough, free it and get more */ + if(m->len < len){ + if(m->isa){ + umbfree(m->isa, m->len); + m->len = 0; + } + m->isa = PADDR(umbmalloc(0, len, Mgran)); + if(m->isa == 0){ + print("isamap: out of isa space\n"); + return 0; + } + m->len = len; + } + + /* set up new map */ + m->ca = offset; + m->cea = m->ca + m->len; + m->attr = attr; + i = m - pi->mmap; + bit = 1<<i; + wrreg(cb, Rwe, we & ~bit); /* disable map before changing it */ + wrreg(cb, MAP(i, Mbtmlo), m->isa>>Mshift); + wrreg(cb, MAP(i, Mbtmhi), (m->isa>>(Mshift+8)) | F16bit); + wrreg(cb, MAP(i, Mtoplo), (m->isa+m->len-1)>>Mshift); + wrreg(cb, MAP(i, Mtophi), ((m->isa+m->len-1)>>(Mshift+8))); + offset -= m->isa; + offset &= (1<<25)-1; + offset >>= Mshift; + wrreg(cb, MAP(i, Mofflo), offset); + wrreg(cb, MAP(i, Moffhi), (offset>>8) | (attr ? Fregactive : 0)); + wrreg(cb, Rwe, we | bit); /* enable map */ + m->ref = 1; + + return m; +} + +static void +isaunmap(PCMmap* m) +{ + m->ref--; +} + +/* + * reading and writing card registers + */ +static uchar +rdreg(Cardbus *cb, int index) +{ + outb(cb->lindex, cb->lbase + index); + return inb(cb->ldata); +} + +static void +wrreg(Cardbus *cb, int index, uchar val) +{ + outb(cb->lindex, cb->lbase + index); + outb(cb->ldata, val); +} + +static int +readc(Cisdat *cis, uchar *x) +{ + if(cis->cispos >= cis->cislen) + return 0; + *x = cis->cisbase[cis->cisskip*cis->cispos]; + cis->cispos++; + return 1; +} + +static ulong +getlong(Cisdat *cis, int size) +{ + uchar c; + int i; + ulong x; + + x = 0; + for(i = 0; i < size; i++){ + if(readc(cis, &c) != 1) + break; + x |= c<<(i*8); + } + return x; +} + +static void +tcfig(Cardbus *cb, Cisdat *cis, int ) +{ + uchar size, rasize, rmsize; + uchar last; + Pcminfo *pi; + + if(readc(cis, &size) != 1) + return; + rasize = (size&0x3) + 1; + rmsize = ((size>>2)&0xf) + 1; + if(readc(cis, &last) != 1) + return; + + pi = &cb->linfo; + pi->conf_addr = getlong(cis, rasize); + pi->conf_present = getlong(cis, rmsize); +} + +static void +tvers1(Cardbus *cb, Cisdat *cis, int ) +{ + uchar c, major, minor, last; + int i; + Pcminfo *pi; + + pi = &cb->linfo; + if(readc(cis, &major) != 1) + return; + if(readc(cis, &minor) != 1) + return; + last = 0; + for(i = 0; i < sizeof(pi->verstr) - 1; i++){ + if(readc(cis, &c) != 1) + return; + if(c == 0) + c = ';'; + if(c == '\n') + c = ';'; + if(c == 0xff) + break; + if(c == ';' && last == ';') + continue; + pi->verstr[i] = c; + last = c; + } + pi->verstr[i] = 0; +} + +static ulong +microvolt(Cisdat *cis) +{ + uchar c; + ulong microvolts; + ulong exp; + + if(readc(cis, &c) != 1) + return 0; + exp = exponent[c&0x7]; + microvolts = vmant[(c>>3)&0xf]*exp; + while(c & 0x80){ + if(readc(cis, &c) != 1) + return 0; + switch(c){ + case 0x7d: + break; /* high impedence when sleeping */ + case 0x7e: + case 0x7f: + microvolts = 0; /* no connection */ + break; + default: + exp /= 10; + microvolts += exp*(c&0x7f); + } + } + return microvolts; +} + +static ulong +nanoamps(Cisdat *cis) +{ + uchar c; + ulong nanoamps; + + if(readc(cis, &c) != 1) + return 0; + nanoamps = exponent[c&0x7]*vmant[(c>>3)&0xf]; + while(c & 0x80){ + if(readc(cis, &c) != 1) + return 0; + if(c == 0x7d || c == 0x7e || c == 0x7f) + nanoamps = 0; + } + return nanoamps; +} + +/* + * only nominal voltage (feature 1) is important for config, + * other features must read card to stay in sync. + */ +static ulong +power(Cisdat *cis) +{ + uchar feature; + ulong mv; + + mv = 0; + if(readc(cis, &feature) != 1) + return 0; + if(feature & 1) + mv = microvolt(cis); + if(feature & 2) + microvolt(cis); + if(feature & 4) + microvolt(cis); + if(feature & 8) + nanoamps(cis); + if(feature & 0x10) + nanoamps(cis); + if(feature & 0x20) + nanoamps(cis); + if(feature & 0x40) + nanoamps(cis); + return mv/1000000; +} + +static ulong +ttiming(Cisdat *cis, int scale) +{ + uchar unscaled; + ulong nanosecs; + + if(readc(cis, &unscaled) != 1) + return 0; + nanosecs = (mantissa[(unscaled>>3)&0xf]*exponent[unscaled&7])/10; + nanosecs = nanosecs * exponent[scale]; + return nanosecs; +} + +static void +timing(Cisdat *cis, PCMconftab *ct) +{ + uchar c, i; + + if(readc(cis, &c) != 1) + return; + i = c&0x3; + if(i != 3) + ct->maxwait = ttiming(cis, i); /* max wait */ + i = (c>>2)&0x7; + if(i != 7) + ct->readywait = ttiming(cis, i); /* max ready/busy wait */ + i = (c>>5)&0x7; + if(i != 7) + ct->otherwait = ttiming(cis, i); /* reserved wait */ +} + +static void +iospaces(Cisdat *cis, PCMconftab *ct) +{ + uchar c; + int i, nio; + + ct->nio = 0; + if(readc(cis, &c) != 1) + return; + + ct->bit16 = ((c>>5)&3) >= 2; + if(!(c & 0x80)){ + ct->io[0].start = 0; + ct->io[0].len = 1<<(c&0x1f); + ct->nio = 1; + return; + } + + if(readc(cis, &c) != 1) + return; + + /* + * For each of the range descriptions read the + * start address and the length (value is length-1). + */ + nio = (c&0xf)+1; + for(i = 0; i < nio; i++){ + ct->io[i].start = getlong(cis, (c>>4)&0x3); + ct->io[i].len = getlong(cis, (c>>6)&0x3)+1; + } + ct->nio = nio; +} + +static void +irq(Cisdat *cis, PCMconftab *ct) +{ + uchar c; + + if(readc(cis, &c) != 1) + return; + ct->irqtype = c & 0xe0; + if(c & 0x10) + ct->irqs = getlong(cis, 2); + else + ct->irqs = 1<<(c&0xf); + ct->irqs &= 0xDEB8; /* levels available to card */ +} + +static void +memspace(Cisdat *cis, int asize, int lsize, int host) +{ + ulong haddress, address, len; + + len = getlong(cis, lsize)*256; + address = getlong(cis, asize)*256; + USED(len, address); + if(host){ + haddress = getlong(cis, asize)*256; + USED(haddress); + } +} + +static void +tentry(Cardbus *cb, Cisdat *cis, int ) +{ + uchar c, i, feature; + PCMconftab *ct; + Pcminfo *pi; + + pi = &cb->linfo; + if(pi->nctab >= nelem(pi->ctab)) + return; + if(readc(cis, &c) != 1) + return; + ct = &pi->ctab[pi->nctab++]; + + /* copy from last default config */ + if(pi->defctab) + *ct = *pi->defctab; + + ct->index = c & 0x3f; + + /* is this the new default? */ + if(c & 0x40) + pi->defctab = ct; + + /* memory wait specified? */ + if(c & 0x80){ + if(readc(cis, &i) != 1) + return; + if(i&0x80) + ct->memwait = 1; + } + + if(readc(cis, &feature) != 1) + return; + switch(feature&0x3){ + case 1: + ct->vpp1 = ct->vpp2 = power(cis); + break; + case 2: + power(cis); + ct->vpp1 = ct->vpp2 = power(cis); + break; + case 3: + power(cis); + ct->vpp1 = power(cis); + ct->vpp2 = power(cis); + break; + default: + break; + } + if(feature&0x4) + timing(cis, ct); + if(feature&0x8) + iospaces(cis, ct); + if(feature&0x10) + irq(cis, ct); + switch((feature>>5)&0x3){ + case 1: + memspace(cis, 0, 2, 0); + break; + case 2: + memspace(cis, 2, 2, 0); + break; + case 3: + if(readc(cis, &c) != 1) + return; + for(i = 0; i <= (c&0x7); i++) + memspace(cis, (c>>5)&0x3, (c>>3)&0x3, c&0x80); + break; + } +} + +static void +i82365probe(Cardbus *cb, int lindex, int ldata) +{ + uchar c, id; + int dev = 0; /* According to the Ricoh spec 00->3F _and_ 80->BF seem + to be the same socket A (ditto for B). */ + + outb(lindex, Rid + (dev<<7)); + id = inb(ldata); + if((id & 0xf0) != 0x80) + return; /* not a memory & I/O card */ + if((id & 0x0f) == 0x00) + return; /* no revision number, not possible */ + + cb->lindex = lindex; + cb->ldata = ldata; + cb->ltype = Ti82365; + cb->lbase = (int)(cb - cbslots) * 0x40; + + switch(id){ + case 0x82: + case 0x83: + case 0x84: + /* could be a cirrus */ + outb(cb->lindex, Rchipinfo + (dev<<7)); + outb(cb->ldata, 0); + c = inb(cb->ldata); + if((c & 0xc0) != 0xc0) + break; + c = inb(cb->ldata); + if((c & 0xc0) != 0x00) + break; + if(c & 0x20){ + cb->ltype = Tpd6720; + } else { + cb->ltype = Tpd6710; + } + + /* low power mode */ + outb(cb->lindex, Rmisc2 + (dev<<7)); + c = inb(cb->ldata); + outb(cb->ldata, c & ~Flowpow); + break; + break; + } + + /* if it's not a Cirrus, it could be a Vadem... */ + if(cb->ltype == Ti82365){ + /* unlock the Vadem extended regs */ + outb(cb->lindex, 0x0E + (dev<<7)); + outb(cb->lindex, 0x37 + (dev<<7)); + + /* make the id register show the Vadem id */ + outb(cb->lindex, 0x3A + (dev<<7)); + c = inb(cb->ldata); + outb(cb->ldata, c|0xC0); + outb(cb->lindex, Rid + (dev<<7)); + c = inb(cb->ldata); + if(c & 0x08) + cb->ltype = Tvg46x; + + /* go back to Intel compatible id */ + outb(cb->lindex, 0x3A + (dev<<7)); + c = inb(cb->ldata); + outb(cb->ldata, c & ~0xC0); + } +} + +static int +vcode(int volt) +{ + switch(volt){ + case 5: + return 1; + case 12: + return 2; + default: + return 0; + } +} |