1
2
3
4
5
6
7
8
9#include <linux/types.h>
10#include <asm/sn/sn_sal.h>
11#include <asm/sn/pcibr_provider.h>
12#include <asm/sn/pcibus_provider_defs.h>
13#include <asm/sn/pcidev.h>
14
15int pcibr_invalidate_ate;
16
17
18
19
20static void mark_ate(struct ate_resource *ate_resource, int start, int number,
21 u64 value)
22{
23 u64 *ate = ate_resource->ate;
24 int index;
25 int length = 0;
26
27 for (index = start; length < number; index++, length++)
28 ate[index] = value;
29}
30
31
32
33
34
35static int find_free_ate(struct ate_resource *ate_resource, int start,
36 int count)
37{
38 u64 *ate = ate_resource->ate;
39 int index;
40 int start_free;
41
42 for (index = start; index < ate_resource->num_ate;) {
43 if (!ate[index]) {
44 int i;
45 int free;
46 free = 0;
47 start_free = index;
48 for (i = start_free; i < ate_resource->num_ate; i++) {
49 if (!ate[i]) {
50 if (++free == count)
51 return start_free;
52 } else {
53 index = i + 1;
54 break;
55 }
56 }
57 if (i >= ate_resource->num_ate)
58 return -1;
59 } else
60 index++;
61 }
62
63 return -1;
64}
65
66
67
68
69static inline void free_ate_resource(struct ate_resource *ate_resource,
70 int start)
71{
72 mark_ate(ate_resource, start, ate_resource->ate[start], 0);
73 if ((ate_resource->lowest_free_index > start) ||
74 (ate_resource->lowest_free_index < 0))
75 ate_resource->lowest_free_index = start;
76}
77
78
79
80
81static inline int alloc_ate_resource(struct ate_resource *ate_resource,
82 int ate_needed)
83{
84 int start_index;
85
86
87
88
89 if (ate_resource->lowest_free_index < 0)
90 return -1;
91
92
93
94
95 start_index =
96 find_free_ate(ate_resource, ate_resource->lowest_free_index,
97 ate_needed);
98 if (start_index >= 0)
99 mark_ate(ate_resource, start_index, ate_needed, ate_needed);
100
101 ate_resource->lowest_free_index =
102 find_free_ate(ate_resource, ate_resource->lowest_free_index, 1);
103
104 return start_index;
105}
106
107
108
109
110
111
112
113
114
115int pcibr_ate_alloc(struct pcibus_info *pcibus_info, int count)
116{
117 int status;
118 unsigned long flags;
119
120 spin_lock_irqsave(&pcibus_info->pbi_lock, flags);
121 status = alloc_ate_resource(&pcibus_info->pbi_int_ate_resource, count);
122 spin_unlock_irqrestore(&pcibus_info->pbi_lock, flags);
123
124 return status;
125}
126
127
128
129
130
131static inline u64 __iomem *pcibr_ate_addr(struct pcibus_info *pcibus_info,
132 int ate_index)
133{
134 if (ate_index < pcibus_info->pbi_int_ate_size) {
135 return pcireg_int_ate_addr(pcibus_info, ate_index);
136 }
137 panic("pcibr_ate_addr: invalid ate_index 0x%x", ate_index);
138}
139
140
141
142
143void inline
144ate_write(struct pcibus_info *pcibus_info, int ate_index, int count,
145 volatile u64 ate)
146{
147 while (count-- > 0) {
148 if (ate_index < pcibus_info->pbi_int_ate_size) {
149 pcireg_int_ate_set(pcibus_info, ate_index, ate);
150 } else {
151 panic("ate_write: invalid ate_index 0x%x", ate_index);
152 }
153 ate_index++;
154 ate += IOPGSIZE;
155 }
156
157 pcireg_tflush_get(pcibus_info);
158}
159
160void pcibr_ate_free(struct pcibus_info *pcibus_info, int index)
161{
162
163 volatile u64 ate;
164 int count;
165 unsigned long flags;
166
167 if (pcibr_invalidate_ate) {
168
169 ate = *pcibr_ate_addr(pcibus_info, index);
170 count = pcibus_info->pbi_int_ate_resource.ate[index];
171 ate_write(pcibus_info, index, count, (ate & ~PCI32_ATE_V));
172 }
173
174 spin_lock_irqsave(&pcibus_info->pbi_lock, flags);
175 free_ate_resource(&pcibus_info->pbi_int_ate_resource, index);
176 spin_unlock_irqrestore(&pcibus_info->pbi_lock, flags);
177}
178