int pci_config_write(unsigned char bus, unsigned char dev, unsigned char func,
unsigned char cmd, int len, unsigned long val)
{
int ret;
ret = enable_app_io();
if (ret != 0)
return ret;
switch(len)
{
case 4:
pci_config_write_long(bus, dev, func, cmd, val);
break;
case 2:
pci_config_write_word(bus, dev, func, cmd, val);
break;
case 1:
pci_config_write_byte(bus, dev, func, cmd, val);
break;
default:
printf("libdha_pci: wrong length to read: %u\n",len);
}
disable_app_io();
return 0;
}
int pci_config_read(unsigned char bus, unsigned char dev, unsigned char func,
unsigned char cmd, int len, unsigned long *val)
{
int ret;
ret = enable_app_io();
if (ret != 0)
return(ret);
switch(len)
{
case 4:
ret = pci_config_read_long(bus, dev, func, cmd);
break;
case 2:
ret = pci_config_read_word(bus, dev, func, cmd);
break;
case 1:
ret = pci_config_read_byte(bus, dev, func, cmd);
break;
default:
printf("libdha_pci: wrong length to read: %u\n",len);
}
disable_app_io();
*val = ret;
return(0);
}
int pci_config_write(unsigned char bus, unsigned char dev, unsigned char func,
unsigned char cmd, int len, unsigned long val)
{
int ret;
int dhahelper_fd;
if ( (dhahelper_fd = open("/dev/dhahelper",O_RDWR)) > 0)
{
int retval;
dhahelper_pci_config_t pcic;
pcic.operation = PCI_OP_WRITE;
pcic.bus = bus;
pcic.dev = dev;
pcic.func = func;
pcic.cmd = cmd;
pcic.size = len;
pcic.ret = val;
retval = ioctl(dhahelper_fd, DHAHELPER_PCI_CONFIG, &pcic);
close(dhahelper_fd);
return retval;
}
ret = enable_app_io();
if (ret != 0)
return ret;
switch(len)
{
case 4:
pci_config_write_long(bus, dev, func, cmd, val);
break;
case 2:
pci_config_write_word(bus, dev, func, cmd, val);
break;
case 1:
pci_config_write_byte(bus, dev, func, cmd, val);
break;
default:
printf("libdha_pci: wrong length to read: %u\n",len);
}
disable_app_io();
return 0;
}
void vixDestroy(void)
{
int protect;
#ifdef DEBUG_LOGFILE
if(logfile)
fclose(logfile);
#endif
protect=SRINB(0x11);
SROUTB(0x11, 0x92);
CROUTB(0x8E, 0xc4); /* Disable overlay */
SROUTB(0x50,save_colourkey[0]);
SROUTB(0x51,save_colourkey[1]);
SROUTB(0x52,save_colourkey[2]);
SROUTB(0x54,save_colourkey[3]);
SROUTB(0x55,save_colourkey[4]);
SROUTB(0x56,save_colourkey[5]);
SROUTB(0x11, protect);
disable_app_io();
unmap_phys_mem(cyberblade_mem, 0x800000);
}
/*main(int argc, char *argv[])*/
static int __pci_scan(pciinfo_t *pci_list,unsigned *num_pci)
{
unsigned int idx;
struct pci_config_reg pcr;
int do_mode1_scan = 0, do_mode2_scan = 0;
int func, hostbridges=0;
int ret = -1;
pci_lst = pci_list;
pcicards = 0;
ret = enable_app_io();
if (ret != 0)
return(ret);
if((pcr._configtype = pci_config_type()) == 0xFFFF) return ENODEV;
/* Try pci config 1 probe first */
if ((pcr._configtype == 1) || do_mode1_scan) {
/*printf("\nPCI probing configuration type 1\n");*/
pcr._ioaddr = 0xFFFF;
pcr._pcibuses[0] = 0;
pcr._pcinumbus = 1;
pcr._pcibusidx = 0;
idx = 0;
do {
/*printf("Probing for devices on PCI bus %d:\n\n", pcr._pcibusidx);*/
for (pcr._cardnum = 0x0; pcr._cardnum < MAX_PCI_DEVICES_PER_BUS;
pcr._cardnum += 0x1) {
func = 0;
do { /* loop over the different functions, if present */
pcr._device_vendor = pci_get_vendor(pcr._pcibuses[pcr._pcibusidx], pcr._cardnum,
func);
if ((pcr._vendor == 0xFFFF) || (pcr._device == 0xFFFF))
break; /* nothing there */
/*printf("\npci bus 0x%x cardnum 0x%02x function 0x%04x: vendor 0x%04x device 0x%04x\n",
pcr._pcibuses[pcr._pcibusidx], pcr._cardnum, func,
pcr._vendor, pcr._device);*/
pcibus = pcr._pcibuses[pcr._pcibusidx];
pcicard = pcr._cardnum;
pcifunc = func;
pcr._status_command = pci_config_read_long(pcr._pcibuses[pcr._pcibusidx],
pcr._cardnum,func,PCI_CMD_STAT_REG);
pcr._class_revision = pci_config_read_long(pcr._pcibuses[pcr._pcibusidx],
pcr._cardnum,func,PCI_CLASS_REG);
pcr._bist_header_latency_cache = pci_config_read_long(pcr._pcibuses[pcr._pcibusidx],
pcr._cardnum,func,PCI_HEADER_MISC);
pcr._base0 = pci_config_read_long(pcr._pcibuses[pcr._pcibusidx],
pcr._cardnum,func,PCI_MAP_REG_START);
pcr._base1 = pci_config_read_long(pcr._pcibuses[pcr._pcibusidx],
pcr._cardnum,func,PCI_MAP_REG_START+4);
pcr._base2 = pci_config_read_long(pcr._pcibuses[pcr._pcibusidx],
pcr._cardnum,func,PCI_MAP_REG_START+8);
pcr._base3 = pci_config_read_long(pcr._pcibuses[pcr._pcibusidx],
pcr._cardnum,func,PCI_MAP_REG_START+0x0C);
pcr._base4 = pci_config_read_long(pcr._pcibuses[pcr._pcibusidx],
pcr._cardnum,func,PCI_MAP_REG_START+0x10);
pcr._base5 = pci_config_read_long(pcr._pcibuses[pcr._pcibusidx],
pcr._cardnum,func,PCI_MAP_REG_START+0x14);
pcr._baserom = pci_config_read_long(pcr._pcibuses[pcr._pcibusidx],
pcr._cardnum,func,PCI_MAP_ROM_REG);
#if 0
pcr._int_pin = pci_config_read_byte(pcr._pcibuses[pcr._pcibusidx],
pcr._cardnum,func,PCI_INTERRUPT_PIN);
pcr._int_line = pci_config_read_byte(pcr._pcibuses[pcr._pcibusidx],
pcr._cardnum,func,PCI_INTERRUPT_REG);
pcr._min_gnt = pci_config_read_byte(pcr._pcibuses[pcr._pcibusidx],
pcr._cardnum,func,PCI_MIN_GNT);
pcr._max_lat = pci_config_read_byte(pcr._pcibuses[pcr._pcibusidx],
pcr._cardnum,func,PCI_MAX_LAT);
#else
pcr._max_min_ipin_iline = pci_config_read_long(pcr._pcibuses[pcr._pcibusidx],
pcr._cardnum,func,PCI_INTERRUPT_REG);
#endif
pcr._user_config = pci_config_read_long(pcr._pcibuses[pcr._pcibusidx],
pcr._cardnum,func,PCI_REG_USERCONFIG);
/* check for pci-pci bridges */
#define PCI_CLASS_MASK 0xff000000
#define PCI_SUBCLASS_MASK 0x00ff0000
#define PCI_CLASS_BRIDGE 0x06000000
#define PCI_SUBCLASS_BRIDGE_PCI 0x00040000
switch(pcr._class_revision & (PCI_CLASS_MASK|PCI_SUBCLASS_MASK)) {
case PCI_CLASS_BRIDGE|PCI_SUBCLASS_BRIDGE_PCI:
if (pcr._secondary_bus_number > 0) {
pcr._pcibuses[pcr._pcinumbus++] = pcr._secondary_bus_number;
}
break;
case PCI_CLASS_BRIDGE:
if ( ++hostbridges > 1) {
pcr._pcibuses[pcr._pcinumbus] = pcr._pcinumbus;
pcr._pcinumbus++;
}
break;
default:
break;
}
if((func==0) && ((pcr._header_type & PCI_MULTIFUNC_DEV) == 0)) {
/* not a multi function device */
func = 8;
} else {
func++;
}
if (idx++ >= MAX_PCI_DEVICES)
continue;
identify_card(&pcr);
} while( func < 8 );
}
} while (++pcr._pcibusidx < pcr._pcinumbus);
}
#if !defined(__alpha__) && !defined(__powerpc__)
/* Now try pci config 2 probe (deprecated) */
if ((pcr._configtype == 2) || do_mode2_scan) {
OUTPORT8(PCI_MODE2_ENABLE_REG, 0xF1);
OUTPORT8(PCI_MODE2_FORWARD_REG, 0x00); /* bus 0 for now */
/*printf("\nPCI probing configuration type 2\n");*/
pcr._pcibuses[0] = 0;
pcr._pcinumbus = 1;
pcr._pcibusidx = 0;
idx = 0;
do {
for (pcr._ioaddr = 0xC000; pcr._ioaddr < 0xD000; pcr._ioaddr += 0x0100){
OUTPORT8(PCI_MODE2_FORWARD_REG, pcr._pcibuses[pcr._pcibusidx]); /* bus 0 for now */
pcr._device_vendor = INPORT32(pcr._ioaddr);
OUTPORT8(PCI_MODE2_FORWARD_REG, 0x00); /* bus 0 for now */
if ((pcr._vendor == 0xFFFF) || (pcr._device == 0xFFFF))
continue;
if ((pcr._vendor == 0xF0F0) || (pcr._device == 0xF0F0))
continue; /* catch ASUS P55TP4XE motherboards */
/*printf("\npci bus 0x%x slot at 0x%04x, vendor 0x%04x device 0x%04x\n",
pcr._pcibuses[pcr._pcibusidx], pcr._ioaddr, pcr._vendor,
pcr._device);*/
pcibus = pcr._pcibuses[pcr._pcibusidx] ;
pcicard = pcr._ioaddr ; pcifunc = 0 ;
OUTPORT8(PCI_MODE2_FORWARD_REG, pcr._pcibuses[pcr._pcibusidx]); /* bus 0 for now */
pcr._status_command = INPORT32(pcr._ioaddr + 0x04);
pcr._class_revision = INPORT32(pcr._ioaddr + 0x08);
pcr._bist_header_latency_cache = INPORT32(pcr._ioaddr + 0x0C);
pcr._base0 = INPORT32(pcr._ioaddr + 0x10);
pcr._base1 = INPORT32(pcr._ioaddr + 0x14);
pcr._base2 = INPORT32(pcr._ioaddr + 0x18);
pcr._base3 = INPORT32(pcr._ioaddr + 0x1C);
pcr._base4 = INPORT32(pcr._ioaddr + 0x20);
pcr._base5 = INPORT32(pcr._ioaddr + 0x24);
pcr._baserom = INPORT32(pcr._ioaddr + 0x30);
pcr._max_min_ipin_iline = INPORT8(pcr._ioaddr + 0x3C);
pcr._user_config = INPORT32(pcr._ioaddr + 0x40);
OUTPORT8(PCI_MODE2_FORWARD_REG, 0x00); /* bus 0 for now */
/* check for pci-pci bridges (currently we only know Digital) */
if ((pcr._vendor == 0x1011) && (pcr._device == 0x0001))
if (pcr._secondary_bus_number > 0)
pcr._pcibuses[pcr._pcinumbus++] = pcr._secondary_bus_number;
if (idx++ >= MAX_PCI_DEVICES)
continue;
identify_card(&pcr);
}
} while (++pcr._pcibusidx < pcr._pcinumbus);
OUTPORT8(PCI_MODE2_ENABLE_REG, 0x00);
}
#endif /* __alpha__ */
disable_app_io();
*num_pci = pcicards;
return 0 ;
}
