GNU Linux-libre 4.19.286-gnu1
[releases.git] / arch / mips / pci / ops-emma2rh.c
1 /*
2  *  Copyright (C) NEC Electronics Corporation 2004-2006
3  *
4  *  This file is based on the arch/mips/pci/ops-vr41xx.c
5  *
6  *      Copyright 2001 MontaVista Software Inc.
7  *
8  *  This program is free software; you can redistribute it and/or modify
9  *  it under the terms of the GNU General Public License as published by
10  *  the Free Software Foundation; either version 2 of the License, or
11  *  (at your option) any later version.
12  *
13  *  This program is distributed in the hope that it will be useful,
14  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
15  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  *  GNU General Public License for more details.
17  *
18  *  You should have received a copy of the GNU General Public License
19  *  along with this program; if not, write to the Free Software
20  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
21  */
22
23 #include <linux/pci.h>
24 #include <linux/kernel.h>
25 #include <linux/types.h>
26
27 #include <asm/addrspace.h>
28
29 #include <asm/emma/emma2rh.h>
30
31 #define RTABORT (0x1<<9)
32 #define RMABORT (0x1<<10)
33 #define EMMA2RH_PCI_SLOT_NUM 9  /* 0000:09.0 is final PCI device */
34
35 /*
36  * access config space
37  */
38
39 static int check_args(struct pci_bus *bus, u32 devfn, u32 * bus_num)
40 {
41         /* check if the bus is top-level */
42         if (bus->parent != NULL)
43                 *bus_num = bus->number;
44         else
45                 *bus_num = 0;
46
47         if (*bus_num == 0) {
48                 /* Type 0 */
49                 if (PCI_SLOT(devfn) >= 10)
50                         return PCIBIOS_DEVICE_NOT_FOUND;
51         } else {
52                 /* Type 1 */
53                 if ((*bus_num >= 64) || (PCI_SLOT(devfn) >= 16))
54                         return PCIBIOS_DEVICE_NOT_FOUND;
55         }
56         return 0;
57 }
58
59 static inline int set_pci_configuration_address(unsigned char bus_num,
60                                                 unsigned int devfn, int where)
61 {
62         u32 config_win0;
63
64         emma2rh_out32(EMMA2RH_PCI_INT, ~RMABORT);
65         if (bus_num == 0)
66                 /*
67                  * Type 0 configuration
68                  */
69                 config_win0 = (1 << (22 + PCI_SLOT(devfn))) | (5 << 9);
70         else
71                 /*
72                  * Type 1 configuration
73                  */
74                 config_win0 = (bus_num << 26) | (PCI_SLOT(devfn) << 22) |
75                     (1 << 15) | (5 << 9);
76
77         emma2rh_out32(EMMA2RH_PCI_IWIN0_CTR, config_win0);
78
79         return 0;
80 }
81
82 static int pci_config_read(struct pci_bus *bus, unsigned int devfn, int where,
83                            int size, uint32_t * val)
84 {
85         u32 bus_num;
86         u32 base = KSEG1ADDR(EMMA2RH_PCI_CONFIG_BASE);
87         u32 backup_win0;
88         u32 data;
89
90         *val = 0xffffffffU;
91
92         if (check_args(bus, devfn, &bus_num) == PCIBIOS_DEVICE_NOT_FOUND)
93                 return PCIBIOS_DEVICE_NOT_FOUND;
94
95         backup_win0 = emma2rh_in32(EMMA2RH_PCI_IWIN0_CTR);
96
97         if (set_pci_configuration_address(bus_num, devfn, where) < 0)
98                 return PCIBIOS_DEVICE_NOT_FOUND;
99
100         data =
101             *(volatile u32 *)(base + (PCI_FUNC(devfn) << 8) +
102                               (where & 0xfffffffc));
103
104         switch (size) {
105         case 1:
106                 *val = (data >> ((where & 3) << 3)) & 0xffU;
107                 break;
108         case 2:
109                 *val = (data >> ((where & 2) << 3)) & 0xffffU;
110                 break;
111         case 4:
112                 *val = data;
113                 break;
114         default:
115                 emma2rh_out32(EMMA2RH_PCI_IWIN0_CTR, backup_win0);
116                 return PCIBIOS_FUNC_NOT_SUPPORTED;
117         }
118
119         emma2rh_out32(EMMA2RH_PCI_IWIN0_CTR, backup_win0);
120
121         if (emma2rh_in32(EMMA2RH_PCI_INT) & RMABORT)
122                 return PCIBIOS_DEVICE_NOT_FOUND;
123
124         return PCIBIOS_SUCCESSFUL;
125 }
126
127 static int pci_config_write(struct pci_bus *bus, unsigned int devfn, int where,
128                             int size, u32 val)
129 {
130         u32 bus_num;
131         u32 base = KSEG1ADDR(EMMA2RH_PCI_CONFIG_BASE);
132         u32 backup_win0;
133         u32 data;
134         int shift;
135
136         if (check_args(bus, devfn, &bus_num) == PCIBIOS_DEVICE_NOT_FOUND)
137                 return PCIBIOS_DEVICE_NOT_FOUND;
138
139         backup_win0 = emma2rh_in32(EMMA2RH_PCI_IWIN0_CTR);
140
141         if (set_pci_configuration_address(bus_num, devfn, where) < 0)
142                 return PCIBIOS_DEVICE_NOT_FOUND;
143
144         /* read modify write */
145         data =
146             *(volatile u32 *)(base + (PCI_FUNC(devfn) << 8) +
147                               (where & 0xfffffffc));
148
149         switch (size) {
150         case 1:
151                 shift = (where & 3) << 3;
152                 data &= ~(0xffU << shift);
153                 data |= ((val & 0xffU) << shift);
154                 break;
155         case 2:
156                 shift = (where & 2) << 3;
157                 data &= ~(0xffffU << shift);
158                 data |= ((val & 0xffffU) << shift);
159                 break;
160         case 4:
161                 data = val;
162                 break;
163         default:
164                 emma2rh_out32(EMMA2RH_PCI_IWIN0_CTR, backup_win0);
165                 return PCIBIOS_FUNC_NOT_SUPPORTED;
166         }
167         *(volatile u32 *)(base + (PCI_FUNC(devfn) << 8) +
168                           (where & 0xfffffffc)) = data;
169
170         emma2rh_out32(EMMA2RH_PCI_IWIN0_CTR, backup_win0);
171         if (emma2rh_in32(EMMA2RH_PCI_INT) & RMABORT)
172                 return PCIBIOS_DEVICE_NOT_FOUND;
173
174         return PCIBIOS_SUCCESSFUL;
175 }
176
177 struct pci_ops emma2rh_pci_ops = {
178         .read = pci_config_read,
179         .write = pci_config_write,
180 };