forked from Minki/linux
92 lines
1.9 KiB
C
92 lines
1.9 KiB
C
|
/*
|
||
|
|
* This file is subject to the terms and conditions of the GNU General Public
|
||
|
|
* License. See the file "COPYING" in the main directory of this archive
|
||
|
|
* for more details.
|
||
|
|
*
|
||
|
|
* Copyright (C) 2000, 2001 Keith M Wesolowski
|
||
|
|
*/
|
||
|
|
#include <linux/kernel.h>
|
||
|
|
#include <linux/init.h>
|
||
|
|
#include <linux/pci.h>
|
||
|
|
#include <linux/types.h>
|
||
|
|
#include <asm/pci.h>
|
||
|
|
#include <asm/ip32/mace.h>
|
||
|
|
|
||
|
|
#if 0
|
||
|
|
# define DPRINTK(args...) printk(args);
|
||
|
|
#else
|
||
|
|
# define DPRINTK(args...)
|
||
|
|
#endif
|
||
|
|
|
||
|
|
/*
|
||
|
|
* O2 has up to 5 PCI devices connected into the MACE bridge. The device
|
||
|
|
* map looks like this:
|
||
|
|
*
|
||
|
|
* 0 aic7xxx 0
|
||
|
|
* 1 aic7xxx 1
|
||
|
|
* 2 expansion slot
|
||
|
|
* 3 N/C
|
||
|
|
* 4 N/C
|
||
|
|
*/
|
||
|
|
|
||
|
|
#define chkslot(_bus,_devfn) \
|
||
|
|
do { \
|
||
|
|
if ((_bus)->number > 0 || PCI_SLOT (_devfn) < 1 \
|
||
|
|
|| PCI_SLOT (_devfn) > 3) \
|
||
|
|
return PCIBIOS_DEVICE_NOT_FOUND; \
|
||
|
|
} while (0)
|
||
|
|
|
||
|
|
#define mkaddr(_devfn, _reg) \
|
||
|
|
((((_devfn) & 0xffUL) << 8) | ((_reg) & 0xfcUL))
|
||
|
|
|
||
|
|
static int
|
||
|
|
mace_pci_read_config(struct pci_bus *bus, unsigned int devfn,
|
||
|
|
int reg, int size, u32 *val)
|
||
|
|
{
|
||
|
|
chkslot(bus, devfn);
|
||
|
|
mace->pci.config_addr = mkaddr(devfn, reg);
|
||
|
|
switch (size) {
|
||
|
|
case 1:
|
||
|
|
*val = mace->pci.config_data.b[(reg & 3) ^ 3];
|
||
|
|
break;
|
||
|
|
case 2:
|
||
|
|
*val = mace->pci.config_data.w[((reg >> 1) & 1) ^ 1];
|
||
|
|
break;
|
||
|
|
case 4:
|
||
|
|
*val = mace->pci.config_data.l;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
DPRINTK("read%d: reg=%08x,val=%02x\n", size * 8, reg, *val);
|
||
|
|
|
||
|
|
return PCIBIOS_SUCCESSFUL;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int
|
||
|
|
mace_pci_write_config(struct pci_bus *bus, unsigned int devfn,
|
||
|
|
int reg, int size, u32 val)
|
||
|
|
{
|
||
|
|
chkslot(bus, devfn);
|
||
|
|
mace->pci.config_addr = mkaddr(devfn, reg);
|
||
|
|
switch (size) {
|
||
|
|
case 1:
|
||
|
|
mace->pci.config_data.b[(reg & 3) ^ 3] = val;
|
||
|
|
break;
|
||
|
|
case 2:
|
||
|
|
mace->pci.config_data.w[((reg >> 1) & 1) ^ 1] = val;
|
||
|
|
break;
|
||
|
|
case 4:
|
||
|
|
mace->pci.config_data.l = val;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
DPRINTK("write%d: reg=%08x,val=%02x\n", size * 8, reg, val);
|
||
|
|
|
||
|
|
return PCIBIOS_SUCCESSFUL;
|
||
|
|
}
|
||
|
|
|
||
|
|
struct pci_ops mace_pci_ops = {
|
||
|
|
.read = mace_pci_read_config,
|
||
|
|
.write = mace_pci_write_config,
|
||
|
|
};
|