1
2
3
4
5
6
7
8#include <linux/slab.h>
9#include "client.h"
10
11
12
13
14
15
16
17
18
19int ishtp_cl_alloc_rx_ring(struct ishtp_cl *cl)
20{
21 size_t len = cl->device->fw_client->props.max_msg_length;
22 int j;
23 struct ishtp_cl_rb *rb;
24 int ret = 0;
25 unsigned long flags;
26
27 for (j = 0; j < cl->rx_ring_size; ++j) {
28 rb = ishtp_io_rb_init(cl);
29 if (!rb) {
30 ret = -ENOMEM;
31 goto out;
32 }
33 ret = ishtp_io_rb_alloc_buf(rb, len);
34 if (ret)
35 goto out;
36 spin_lock_irqsave(&cl->free_list_spinlock, flags);
37 list_add_tail(&rb->list, &cl->free_rb_list.list);
38 spin_unlock_irqrestore(&cl->free_list_spinlock, flags);
39 }
40
41 return 0;
42
43out:
44 dev_err(&cl->device->dev, "error in allocating Rx buffers\n");
45 ishtp_cl_free_rx_ring(cl);
46 return ret;
47}
48
49
50
51
52
53
54
55
56
57int ishtp_cl_alloc_tx_ring(struct ishtp_cl *cl)
58{
59 size_t len = cl->device->fw_client->props.max_msg_length;
60 int j;
61 unsigned long flags;
62
63 cl->tx_ring_free_size = 0;
64
65
66 for (j = 0; j < cl->tx_ring_size; ++j) {
67 struct ishtp_cl_tx_ring *tx_buf;
68
69 tx_buf = kzalloc(sizeof(struct ishtp_cl_tx_ring), GFP_KERNEL);
70 if (!tx_buf)
71 goto out;
72
73 tx_buf->send_buf.data = kmalloc(len, GFP_KERNEL);
74 if (!tx_buf->send_buf.data) {
75 kfree(tx_buf);
76 goto out;
77 }
78
79 spin_lock_irqsave(&cl->tx_free_list_spinlock, flags);
80 list_add_tail(&tx_buf->list, &cl->tx_free_list.list);
81 ++cl->tx_ring_free_size;
82 spin_unlock_irqrestore(&cl->tx_free_list_spinlock, flags);
83 }
84 return 0;
85out:
86 dev_err(&cl->device->dev, "error in allocating Tx pool\n");
87 ishtp_cl_free_tx_ring(cl);
88 return -ENOMEM;
89}
90
91
92
93
94
95
96
97void ishtp_cl_free_rx_ring(struct ishtp_cl *cl)
98{
99 struct ishtp_cl_rb *rb;
100 unsigned long flags;
101
102
103 spin_lock_irqsave(&cl->free_list_spinlock, flags);
104 while (!list_empty(&cl->free_rb_list.list)) {
105 rb = list_entry(cl->free_rb_list.list.next, struct ishtp_cl_rb,
106 list);
107 list_del(&rb->list);
108 kfree(rb->buffer.data);
109 kfree(rb);
110 }
111 spin_unlock_irqrestore(&cl->free_list_spinlock, flags);
112
113 spin_lock_irqsave(&cl->in_process_spinlock, flags);
114 while (!list_empty(&cl->in_process_list.list)) {
115 rb = list_entry(cl->in_process_list.list.next,
116 struct ishtp_cl_rb, list);
117 list_del(&rb->list);
118 kfree(rb->buffer.data);
119 kfree(rb);
120 }
121 spin_unlock_irqrestore(&cl->in_process_spinlock, flags);
122}
123
124
125
126
127
128
129
130void ishtp_cl_free_tx_ring(struct ishtp_cl *cl)
131{
132 struct ishtp_cl_tx_ring *tx_buf;
133 unsigned long flags;
134
135 spin_lock_irqsave(&cl->tx_free_list_spinlock, flags);
136
137 while (!list_empty(&cl->tx_free_list.list)) {
138 tx_buf = list_entry(cl->tx_free_list.list.next,
139 struct ishtp_cl_tx_ring, list);
140 list_del(&tx_buf->list);
141 --cl->tx_ring_free_size;
142 kfree(tx_buf->send_buf.data);
143 kfree(tx_buf);
144 }
145 spin_unlock_irqrestore(&cl->tx_free_list_spinlock, flags);
146
147 spin_lock_irqsave(&cl->tx_list_spinlock, flags);
148
149 while (!list_empty(&cl->tx_list.list)) {
150 tx_buf = list_entry(cl->tx_list.list.next,
151 struct ishtp_cl_tx_ring, list);
152 list_del(&tx_buf->list);
153 kfree(tx_buf->send_buf.data);
154 kfree(tx_buf);
155 }
156 spin_unlock_irqrestore(&cl->tx_list_spinlock, flags);
157}
158
159
160
161
162
163
164
165void ishtp_io_rb_free(struct ishtp_cl_rb *rb)
166{
167 if (rb == NULL)
168 return;
169
170 kfree(rb->buffer.data);
171 kfree(rb);
172}
173
174
175
176
177
178
179
180
181
182struct ishtp_cl_rb *ishtp_io_rb_init(struct ishtp_cl *cl)
183{
184 struct ishtp_cl_rb *rb;
185
186 rb = kzalloc(sizeof(struct ishtp_cl_rb), GFP_KERNEL);
187 if (!rb)
188 return NULL;
189
190 INIT_LIST_HEAD(&rb->list);
191 rb->cl = cl;
192 rb->buf_idx = 0;
193 return rb;
194}
195
196
197
198
199
200
201
202
203
204
205int ishtp_io_rb_alloc_buf(struct ishtp_cl_rb *rb, size_t length)
206{
207 if (!rb)
208 return -EINVAL;
209
210 if (length == 0)
211 return 0;
212
213 rb->buffer.data = kmalloc(length, GFP_KERNEL);
214 if (!rb->buffer.data)
215 return -ENOMEM;
216
217 rb->buffer.size = length;
218 return 0;
219}
220
221
222
223
224
225
226
227
228
229int ishtp_cl_io_rb_recycle(struct ishtp_cl_rb *rb)
230{
231 struct ishtp_cl *cl;
232 int rets = 0;
233 unsigned long flags;
234
235 if (!rb || !rb->cl)
236 return -EFAULT;
237
238 cl = rb->cl;
239 spin_lock_irqsave(&cl->free_list_spinlock, flags);
240 list_add_tail(&rb->list, &cl->free_rb_list.list);
241 spin_unlock_irqrestore(&cl->free_list_spinlock, flags);
242
243
244
245
246
247 if (!cl->out_flow_ctrl_creds)
248 rets = ishtp_cl_read_start(cl);
249
250 return rets;
251}
252EXPORT_SYMBOL(ishtp_cl_io_rb_recycle);
253
254
255
256
257
258
259
260
261
262bool ishtp_cl_tx_empty(struct ishtp_cl *cl)
263{
264 int tx_list_empty;
265 unsigned long tx_flags;
266
267 spin_lock_irqsave(&cl->tx_list_spinlock, tx_flags);
268 tx_list_empty = list_empty(&cl->tx_list.list);
269 spin_unlock_irqrestore(&cl->tx_list_spinlock, tx_flags);
270
271 return !!tx_list_empty;
272}
273EXPORT_SYMBOL(ishtp_cl_tx_empty);
274
275
276
277
278
279
280
281
282
283struct ishtp_cl_rb *ishtp_cl_rx_get_rb(struct ishtp_cl *cl)
284{
285 unsigned long rx_flags;
286 struct ishtp_cl_rb *rb;
287
288 spin_lock_irqsave(&cl->in_process_spinlock, rx_flags);
289 rb = list_first_entry_or_null(&cl->in_process_list.list,
290 struct ishtp_cl_rb, list);
291 if (rb)
292 list_del_init(&rb->list);
293 spin_unlock_irqrestore(&cl->in_process_spinlock, rx_flags);
294
295 return rb;
296}
297EXPORT_SYMBOL(ishtp_cl_rx_get_rb);
298