1#include <linux/types.h>
2#include <linux/pci.h>
3#include <linux/kernel.h>
4
5#include <asm/mips-boards/bonito64.h>
6
7#include <loongson.h>
8
9#define PCI_ACCESS_READ  0
10#define PCI_ACCESS_WRITE 1
11
12#define HT1LO_PCICFG_BASE      0x1a000000
13#define HT1LO_PCICFG_BASE_TP1  0x1b000000
14
15static int loongson3_pci_config_access(unsigned char access_type,
16		struct pci_bus *bus, unsigned int devfn,
17		int where, u32 *data)
18{
19	unsigned char busnum = bus->number;
20	u_int64_t addr, type;
21	void *addrp;
22	int device = PCI_SLOT(devfn);
23	int function = PCI_FUNC(devfn);
24	int reg = where & ~3;
25
26	addr = (busnum << 16) | (device << 11) | (function << 8) | reg;
27	if (busnum == 0) {
28		if (device > 31)
29			return PCIBIOS_DEVICE_NOT_FOUND;
30		addrp = (void *)(TO_UNCAC(HT1LO_PCICFG_BASE) | (addr & 0xffff));
31		type = 0;
32
33	} else {
34		addrp = (void *)(TO_UNCAC(HT1LO_PCICFG_BASE_TP1) | (addr));
35		type = 0x10000;
36	}
37
38	if (access_type == PCI_ACCESS_WRITE)
39		writel(*data, addrp);
40	else {
41		*data = readl(addrp);
42		if (*data == 0xffffffff) {
43			*data = -1;
44			return PCIBIOS_DEVICE_NOT_FOUND;
45		}
46	}
47	return PCIBIOS_SUCCESSFUL;
48}
49
50static int loongson3_pci_pcibios_read(struct pci_bus *bus, unsigned int devfn,
51				 int where, int size, u32 *val)
52{
53	u32 data = 0;
54	int ret = loongson3_pci_config_access(PCI_ACCESS_READ,
55			bus, devfn, where, &data);
56
57	if (ret != PCIBIOS_SUCCESSFUL)
58		return ret;
59
60	if (size == 1)
61		*val = (data >> ((where & 3) << 3)) & 0xff;
62	else if (size == 2)
63		*val = (data >> ((where & 3) << 3)) & 0xffff;
64	else
65		*val = data;
66
67	return PCIBIOS_SUCCESSFUL;
68}
69
70static int loongson3_pci_pcibios_write(struct pci_bus *bus, unsigned int devfn,
71				  int where, int size, u32 val)
72{
73	u32 data = 0;
74	int ret;
75
76	if (size == 4)
77		data = val;
78	else {
79		ret = loongson3_pci_config_access(PCI_ACCESS_READ,
80				bus, devfn, where, &data);
81		if (ret != PCIBIOS_SUCCESSFUL)
82			return ret;
83
84		if (size == 1)
85			data = (data & ~(0xff << ((where & 3) << 3))) |
86			    (val << ((where & 3) << 3));
87		else if (size == 2)
88			data = (data & ~(0xffff << ((where & 3) << 3))) |
89			    (val << ((where & 3) << 3));
90	}
91
92	ret = loongson3_pci_config_access(PCI_ACCESS_WRITE,
93			bus, devfn, where, &data);
94
95	return ret;
96}
97
98struct pci_ops loongson_pci_ops = {
99	.read = loongson3_pci_pcibios_read,
100	.write = loongson3_pci_pcibios_write
101};
102