This source file includes following definitions.
- mkaddr
- mace_pci_read_config
- mace_pci_write_config
1
2
3
4
5
6
7
8 #include <linux/kernel.h>
9 #include <linux/pci.h>
10 #include <linux/types.h>
11 #include <asm/ip32/mace.h>
12
13 #if 0
14 # define DPRINTK(args...) printk(args);
15 #else
16 # define DPRINTK(args...)
17 #endif
18
19
20
21
22
23
24
25
26
27
28
29
30 static inline int mkaddr(struct pci_bus *bus, unsigned int devfn,
31 unsigned int reg)
32 {
33 return ((bus->number & 0xff) << 16) |
34 ((devfn & 0xff) << 8) |
35 (reg & 0xfc);
36 }
37
38
39 static int
40 mace_pci_read_config(struct pci_bus *bus, unsigned int devfn,
41 int reg, int size, u32 *val)
42 {
43 u32 control = mace->pci.control;
44
45
46 mace->pci.control = control & ~MACEPCI_CONTROL_MAR_INT;
47 mace->pci.config_addr = mkaddr(bus, devfn, reg);
48 switch (size) {
49 case 1:
50 *val = mace->pci.config_data.b[(reg & 3) ^ 3];
51 break;
52 case 2:
53 *val = mace->pci.config_data.w[((reg >> 1) & 1) ^ 1];
54 break;
55 case 4:
56 *val = mace->pci.config_data.l;
57 break;
58 }
59
60 mace->pci.error &= ~MACEPCI_ERROR_MASTER_ABORT;
61 mace->pci.control = control;
62
63
64
65
66 if (bus->number == 0 && reg == 0x40 && size == 4 &&
67 (devfn == (1 << 3) || devfn == (2 << 3)))
68 *val |= 0x1000;
69
70 DPRINTK("read%d: reg=%08x,val=%02x\n", size * 8, reg, *val);
71
72 return PCIBIOS_SUCCESSFUL;
73 }
74
75 static int
76 mace_pci_write_config(struct pci_bus *bus, unsigned int devfn,
77 int reg, int size, u32 val)
78 {
79 mace->pci.config_addr = mkaddr(bus, devfn, reg);
80 switch (size) {
81 case 1:
82 mace->pci.config_data.b[(reg & 3) ^ 3] = val;
83 break;
84 case 2:
85 mace->pci.config_data.w[((reg >> 1) & 1) ^ 1] = val;
86 break;
87 case 4:
88 mace->pci.config_data.l = val;
89 break;
90 }
91
92 DPRINTK("write%d: reg=%08x,val=%02x\n", size * 8, reg, val);
93
94 return PCIBIOS_SUCCESSFUL;
95 }
96
97 struct pci_ops mace_pci_ops = {
98 .read = mace_pci_read_config,
99 .write = mace_pci_write_config,
100 };