1 /*
2  * Copyright (c) 2009-2010 Chelsio, Inc. All rights reserved.
3  *
4  * This software is available to you under a choice of one of two
5  * licenses.  You may choose to be licensed under the terms of the GNU
6  * General Public License (GPL) Version 2, available from the file
7  * COPYING in the main directory of this source tree, or the
8  * OpenIB.org BSD license below:
9  *
10  *     Redistribution and use in source and binary forms, with or
11  *     without modification, are permitted provided that the following
12  *     conditions are met:
13  *
14  *      - Redistributions of source code must retain the above
15  *        copyright notice, this list of conditions and the following
16  *        disclaimer.
17  *
18  *      - Redistributions in binary form must reproduce the above
19  *        copyright notice, this list of conditions and the following
20  *        disclaimer in the documentation and/or other materials
21  *        provided with the distribution.
22  *
23  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30  * SOFTWARE.
31  */
32 /* Crude resource management */
33 #include <linux/spinlock.h>
34 #include <linux/genalloc.h>
35 #include <linux/ratelimit.h>
36 #include "iw_cxgb4.h"
37 
c4iw_init_qid_table(struct c4iw_rdev * rdev)38 static int c4iw_init_qid_table(struct c4iw_rdev *rdev)
39 {
40 	u32 i;
41 
42 	if (c4iw_id_table_alloc(&rdev->resource.qid_table,
43 				rdev->lldi.vr->qp.start,
44 				rdev->lldi.vr->qp.size,
45 				rdev->lldi.vr->qp.size, 0))
46 		return -ENOMEM;
47 
48 	for (i = rdev->lldi.vr->qp.start;
49 		i < rdev->lldi.vr->qp.start + rdev->lldi.vr->qp.size; i++)
50 		if (!(i & rdev->qpmask))
51 			c4iw_id_free(&rdev->resource.qid_table, i);
52 	return 0;
53 }
54 
55 /* nr_* must be power of 2 */
c4iw_init_resource(struct c4iw_rdev * rdev,u32 nr_tpt,u32 nr_pdid,u32 nr_srqt)56 int c4iw_init_resource(struct c4iw_rdev *rdev, u32 nr_tpt,
57 		       u32 nr_pdid, u32 nr_srqt)
58 {
59 	int err = 0;
60 	err = c4iw_id_table_alloc(&rdev->resource.tpt_table, 0, nr_tpt, 1,
61 					C4IW_ID_TABLE_F_RANDOM);
62 	if (err)
63 		goto tpt_err;
64 	err = c4iw_init_qid_table(rdev);
65 	if (err)
66 		goto qid_err;
67 	err = c4iw_id_table_alloc(&rdev->resource.pdid_table, 0,
68 					nr_pdid, 1, 0);
69 	if (err)
70 		goto pdid_err;
71 	if (!nr_srqt)
72 		err = c4iw_id_table_alloc(&rdev->resource.srq_table, 0,
73 					  1, 1, 0);
74 	else
75 		err = c4iw_id_table_alloc(&rdev->resource.srq_table, 0,
76 					  nr_srqt, 0, 0);
77 	if (err)
78 		goto srq_err;
79 	return 0;
80  srq_err:
81 	c4iw_id_table_free(&rdev->resource.pdid_table);
82  pdid_err:
83 	c4iw_id_table_free(&rdev->resource.qid_table);
84  qid_err:
85 	c4iw_id_table_free(&rdev->resource.tpt_table);
86  tpt_err:
87 	return -ENOMEM;
88 }
89 
90 /*
91  * returns 0 if no resource available
92  */
c4iw_get_resource(struct c4iw_id_table * id_table)93 u32 c4iw_get_resource(struct c4iw_id_table *id_table)
94 {
95 	u32 entry;
96 	entry = c4iw_id_alloc(id_table);
97 	if (entry == (u32)(-1))
98 		return 0;
99 	return entry;
100 }
101 
c4iw_put_resource(struct c4iw_id_table * id_table,u32 entry)102 void c4iw_put_resource(struct c4iw_id_table *id_table, u32 entry)
103 {
104 	pr_debug("entry 0x%x\n", entry);
105 	c4iw_id_free(id_table, entry);
106 }
107 
c4iw_get_cqid(struct c4iw_rdev * rdev,struct c4iw_dev_ucontext * uctx)108 u32 c4iw_get_cqid(struct c4iw_rdev *rdev, struct c4iw_dev_ucontext *uctx)
109 {
110 	struct c4iw_qid_list *entry;
111 	u32 qid;
112 	int i;
113 
114 	mutex_lock(&uctx->lock);
115 	if (!list_empty(&uctx->cqids)) {
116 		entry = list_entry(uctx->cqids.next, struct c4iw_qid_list,
117 				   entry);
118 		list_del(&entry->entry);
119 		qid = entry->qid;
120 		kfree(entry);
121 	} else {
122 		qid = c4iw_get_resource(&rdev->resource.qid_table);
123 		if (!qid)
124 			goto out;
125 		mutex_lock(&rdev->stats.lock);
126 		rdev->stats.qid.cur += rdev->qpmask + 1;
127 		mutex_unlock(&rdev->stats.lock);
128 		for (i = qid+1; i & rdev->qpmask; i++) {
129 			entry = kmalloc(sizeof(*entry), GFP_KERNEL);
130 			if (!entry)
131 				goto out;
132 			entry->qid = i;
133 			list_add_tail(&entry->entry, &uctx->cqids);
134 		}
135 
136 		/*
137 		 * now put the same ids on the qp list since they all
138 		 * map to the same db/gts page.
139 		 */
140 		entry = kmalloc(sizeof(*entry), GFP_KERNEL);
141 		if (!entry)
142 			goto out;
143 		entry->qid = qid;
144 		list_add_tail(&entry->entry, &uctx->qpids);
145 		for (i = qid+1; i & rdev->qpmask; i++) {
146 			entry = kmalloc(sizeof(*entry), GFP_KERNEL);
147 			if (!entry)
148 				goto out;
149 			entry->qid = i;
150 			list_add_tail(&entry->entry, &uctx->qpids);
151 		}
152 	}
153 out:
154 	mutex_unlock(&uctx->lock);
155 	pr_debug("qid 0x%x\n", qid);
156 	mutex_lock(&rdev->stats.lock);
157 	if (rdev->stats.qid.cur > rdev->stats.qid.max)
158 		rdev->stats.qid.max = rdev->stats.qid.cur;
159 	mutex_unlock(&rdev->stats.lock);
160 	return qid;
161 }
162 
c4iw_put_cqid(struct c4iw_rdev * rdev,u32 qid,struct c4iw_dev_ucontext * uctx)163 void c4iw_put_cqid(struct c4iw_rdev *rdev, u32 qid,
164 		   struct c4iw_dev_ucontext *uctx)
165 {
166 	struct c4iw_qid_list *entry;
167 
168 	entry = kmalloc(sizeof(*entry), GFP_KERNEL);
169 	if (!entry)
170 		return;
171 	pr_debug("qid 0x%x\n", qid);
172 	entry->qid = qid;
173 	mutex_lock(&uctx->lock);
174 	list_add_tail(&entry->entry, &uctx->cqids);
175 	mutex_unlock(&uctx->lock);
176 }
177 
c4iw_get_qpid(struct c4iw_rdev * rdev,struct c4iw_dev_ucontext * uctx)178 u32 c4iw_get_qpid(struct c4iw_rdev *rdev, struct c4iw_dev_ucontext *uctx)
179 {
180 	struct c4iw_qid_list *entry;
181 	u32 qid;
182 	int i;
183 
184 	mutex_lock(&uctx->lock);
185 	if (!list_empty(&uctx->qpids)) {
186 		entry = list_entry(uctx->qpids.next, struct c4iw_qid_list,
187 				   entry);
188 		list_del(&entry->entry);
189 		qid = entry->qid;
190 		kfree(entry);
191 	} else {
192 		qid = c4iw_get_resource(&rdev->resource.qid_table);
193 		if (!qid) {
194 			mutex_lock(&rdev->stats.lock);
195 			rdev->stats.qid.fail++;
196 			mutex_unlock(&rdev->stats.lock);
197 			goto out;
198 		}
199 		mutex_lock(&rdev->stats.lock);
200 		rdev->stats.qid.cur += rdev->qpmask + 1;
201 		mutex_unlock(&rdev->stats.lock);
202 		for (i = qid+1; i & rdev->qpmask; i++) {
203 			entry = kmalloc(sizeof(*entry), GFP_KERNEL);
204 			if (!entry)
205 				goto out;
206 			entry->qid = i;
207 			list_add_tail(&entry->entry, &uctx->qpids);
208 		}
209 
210 		/*
211 		 * now put the same ids on the cq list since they all
212 		 * map to the same db/gts page.
213 		 */
214 		entry = kmalloc(sizeof(*entry), GFP_KERNEL);
215 		if (!entry)
216 			goto out;
217 		entry->qid = qid;
218 		list_add_tail(&entry->entry, &uctx->cqids);
219 		for (i = qid + 1; i & rdev->qpmask; i++) {
220 			entry = kmalloc(sizeof(*entry), GFP_KERNEL);
221 			if (!entry)
222 				goto out;
223 			entry->qid = i;
224 			list_add_tail(&entry->entry, &uctx->cqids);
225 		}
226 	}
227 out:
228 	mutex_unlock(&uctx->lock);
229 	pr_debug("qid 0x%x\n", qid);
230 	mutex_lock(&rdev->stats.lock);
231 	if (rdev->stats.qid.cur > rdev->stats.qid.max)
232 		rdev->stats.qid.max = rdev->stats.qid.cur;
233 	mutex_unlock(&rdev->stats.lock);
234 	return qid;
235 }
236 
c4iw_put_qpid(struct c4iw_rdev * rdev,u32 qid,struct c4iw_dev_ucontext * uctx)237 void c4iw_put_qpid(struct c4iw_rdev *rdev, u32 qid,
238 		   struct c4iw_dev_ucontext *uctx)
239 {
240 	struct c4iw_qid_list *entry;
241 
242 	entry = kmalloc(sizeof(*entry), GFP_KERNEL);
243 	if (!entry)
244 		return;
245 	pr_debug("qid 0x%x\n", qid);
246 	entry->qid = qid;
247 	mutex_lock(&uctx->lock);
248 	list_add_tail(&entry->entry, &uctx->qpids);
249 	mutex_unlock(&uctx->lock);
250 }
251 
c4iw_destroy_resource(struct c4iw_resource * rscp)252 void c4iw_destroy_resource(struct c4iw_resource *rscp)
253 {
254 	c4iw_id_table_free(&rscp->tpt_table);
255 	c4iw_id_table_free(&rscp->qid_table);
256 	c4iw_id_table_free(&rscp->pdid_table);
257 }
258 
259 /*
260  * PBL Memory Manager.  Uses Linux generic allocator.
261  */
262 
263 #define MIN_PBL_SHIFT 8			/* 256B == min PBL size (32 entries) */
264 
c4iw_pblpool_alloc(struct c4iw_rdev * rdev,int size)265 u32 c4iw_pblpool_alloc(struct c4iw_rdev *rdev, int size)
266 {
267 	unsigned long addr = gen_pool_alloc(rdev->pbl_pool, size);
268 	pr_debug("addr 0x%x size %d\n", (u32)addr, size);
269 	mutex_lock(&rdev->stats.lock);
270 	if (addr) {
271 		rdev->stats.pbl.cur += roundup(size, 1 << MIN_PBL_SHIFT);
272 		if (rdev->stats.pbl.cur > rdev->stats.pbl.max)
273 			rdev->stats.pbl.max = rdev->stats.pbl.cur;
274 		kref_get(&rdev->pbl_kref);
275 	} else
276 		rdev->stats.pbl.fail++;
277 	mutex_unlock(&rdev->stats.lock);
278 	return (u32)addr;
279 }
280 
destroy_pblpool(struct kref * kref)281 static void destroy_pblpool(struct kref *kref)
282 {
283 	struct c4iw_rdev *rdev;
284 
285 	rdev = container_of(kref, struct c4iw_rdev, pbl_kref);
286 	gen_pool_destroy(rdev->pbl_pool);
287 	complete(&rdev->pbl_compl);
288 }
289 
c4iw_pblpool_free(struct c4iw_rdev * rdev,u32 addr,int size)290 void c4iw_pblpool_free(struct c4iw_rdev *rdev, u32 addr, int size)
291 {
292 	pr_debug("addr 0x%x size %d\n", addr, size);
293 	mutex_lock(&rdev->stats.lock);
294 	rdev->stats.pbl.cur -= roundup(size, 1 << MIN_PBL_SHIFT);
295 	mutex_unlock(&rdev->stats.lock);
296 	gen_pool_free(rdev->pbl_pool, (unsigned long)addr, size);
297 	kref_put(&rdev->pbl_kref, destroy_pblpool);
298 }
299 
c4iw_pblpool_create(struct c4iw_rdev * rdev)300 int c4iw_pblpool_create(struct c4iw_rdev *rdev)
301 {
302 	unsigned pbl_start, pbl_chunk, pbl_top;
303 
304 	rdev->pbl_pool = gen_pool_create(MIN_PBL_SHIFT, -1);
305 	if (!rdev->pbl_pool)
306 		return -ENOMEM;
307 
308 	pbl_start = rdev->lldi.vr->pbl.start;
309 	pbl_chunk = rdev->lldi.vr->pbl.size;
310 	pbl_top = pbl_start + pbl_chunk;
311 
312 	while (pbl_start < pbl_top) {
313 		pbl_chunk = min(pbl_top - pbl_start + 1, pbl_chunk);
314 		if (gen_pool_add(rdev->pbl_pool, pbl_start, pbl_chunk, -1)) {
315 			pr_debug("failed to add PBL chunk (%x/%x)\n",
316 				 pbl_start, pbl_chunk);
317 			if (pbl_chunk <= 1024 << MIN_PBL_SHIFT) {
318 				pr_warn("Failed to add all PBL chunks (%x/%x)\n",
319 					pbl_start, pbl_top - pbl_start);
320 				return 0;
321 			}
322 			pbl_chunk >>= 1;
323 		} else {
324 			pr_debug("added PBL chunk (%x/%x)\n",
325 				 pbl_start, pbl_chunk);
326 			pbl_start += pbl_chunk;
327 		}
328 	}
329 
330 	return 0;
331 }
332 
c4iw_pblpool_destroy(struct c4iw_rdev * rdev)333 void c4iw_pblpool_destroy(struct c4iw_rdev *rdev)
334 {
335 	kref_put(&rdev->pbl_kref, destroy_pblpool);
336 }
337 
338 /*
339  * RQT Memory Manager.  Uses Linux generic allocator.
340  */
341 
342 #define MIN_RQT_SHIFT 10	/* 1KB == min RQT size (16 entries) */
343 
c4iw_rqtpool_alloc(struct c4iw_rdev * rdev,int size)344 u32 c4iw_rqtpool_alloc(struct c4iw_rdev *rdev, int size)
345 {
346 	unsigned long addr = gen_pool_alloc(rdev->rqt_pool, size << 6);
347 	pr_debug("addr 0x%x size %d\n", (u32)addr, size << 6);
348 	if (!addr)
349 		pr_warn_ratelimited("%s: Out of RQT memory\n",
350 				    pci_name(rdev->lldi.pdev));
351 	mutex_lock(&rdev->stats.lock);
352 	if (addr) {
353 		rdev->stats.rqt.cur += roundup(size << 6, 1 << MIN_RQT_SHIFT);
354 		if (rdev->stats.rqt.cur > rdev->stats.rqt.max)
355 			rdev->stats.rqt.max = rdev->stats.rqt.cur;
356 		kref_get(&rdev->rqt_kref);
357 	} else
358 		rdev->stats.rqt.fail++;
359 	mutex_unlock(&rdev->stats.lock);
360 	return (u32)addr;
361 }
362 
destroy_rqtpool(struct kref * kref)363 static void destroy_rqtpool(struct kref *kref)
364 {
365 	struct c4iw_rdev *rdev;
366 
367 	rdev = container_of(kref, struct c4iw_rdev, rqt_kref);
368 	gen_pool_destroy(rdev->rqt_pool);
369 	complete(&rdev->rqt_compl);
370 }
371 
c4iw_rqtpool_free(struct c4iw_rdev * rdev,u32 addr,int size)372 void c4iw_rqtpool_free(struct c4iw_rdev *rdev, u32 addr, int size)
373 {
374 	pr_debug("addr 0x%x size %d\n", addr, size << 6);
375 	mutex_lock(&rdev->stats.lock);
376 	rdev->stats.rqt.cur -= roundup(size << 6, 1 << MIN_RQT_SHIFT);
377 	mutex_unlock(&rdev->stats.lock);
378 	gen_pool_free(rdev->rqt_pool, (unsigned long)addr, size << 6);
379 	kref_put(&rdev->rqt_kref, destroy_rqtpool);
380 }
381 
c4iw_rqtpool_create(struct c4iw_rdev * rdev)382 int c4iw_rqtpool_create(struct c4iw_rdev *rdev)
383 {
384 	unsigned rqt_start, rqt_chunk, rqt_top;
385 	int skip = 0;
386 
387 	rdev->rqt_pool = gen_pool_create(MIN_RQT_SHIFT, -1);
388 	if (!rdev->rqt_pool)
389 		return -ENOMEM;
390 
391 	/*
392 	 * If SRQs are supported, then never use the first RQE from
393 	 * the RQT region. This is because HW uses RQT index 0 as NULL.
394 	 */
395 	if (rdev->lldi.vr->srq.size)
396 		skip = T4_RQT_ENTRY_SIZE;
397 
398 	rqt_start = rdev->lldi.vr->rq.start + skip;
399 	rqt_chunk = rdev->lldi.vr->rq.size - skip;
400 	rqt_top = rqt_start + rqt_chunk;
401 
402 	while (rqt_start < rqt_top) {
403 		rqt_chunk = min(rqt_top - rqt_start + 1, rqt_chunk);
404 		if (gen_pool_add(rdev->rqt_pool, rqt_start, rqt_chunk, -1)) {
405 			pr_debug("failed to add RQT chunk (%x/%x)\n",
406 				 rqt_start, rqt_chunk);
407 			if (rqt_chunk <= 1024 << MIN_RQT_SHIFT) {
408 				pr_warn("Failed to add all RQT chunks (%x/%x)\n",
409 					rqt_start, rqt_top - rqt_start);
410 				return 0;
411 			}
412 			rqt_chunk >>= 1;
413 		} else {
414 			pr_debug("added RQT chunk (%x/%x)\n",
415 				 rqt_start, rqt_chunk);
416 			rqt_start += rqt_chunk;
417 		}
418 	}
419 	return 0;
420 }
421 
c4iw_rqtpool_destroy(struct c4iw_rdev * rdev)422 void c4iw_rqtpool_destroy(struct c4iw_rdev *rdev)
423 {
424 	kref_put(&rdev->rqt_kref, destroy_rqtpool);
425 }
426 
c4iw_alloc_srq_idx(struct c4iw_rdev * rdev)427 int c4iw_alloc_srq_idx(struct c4iw_rdev *rdev)
428 {
429 	int idx;
430 
431 	idx = c4iw_id_alloc(&rdev->resource.srq_table);
432 	mutex_lock(&rdev->stats.lock);
433 	if (idx == -1) {
434 		rdev->stats.srqt.fail++;
435 		mutex_unlock(&rdev->stats.lock);
436 		return -ENOMEM;
437 	}
438 	rdev->stats.srqt.cur++;
439 	if (rdev->stats.srqt.cur > rdev->stats.srqt.max)
440 		rdev->stats.srqt.max = rdev->stats.srqt.cur;
441 	mutex_unlock(&rdev->stats.lock);
442 	return idx;
443 }
444 
c4iw_free_srq_idx(struct c4iw_rdev * rdev,int idx)445 void c4iw_free_srq_idx(struct c4iw_rdev *rdev, int idx)
446 {
447 	c4iw_id_free(&rdev->resource.srq_table, idx);
448 	mutex_lock(&rdev->stats.lock);
449 	rdev->stats.srqt.cur--;
450 	mutex_unlock(&rdev->stats.lock);
451 }
452 
453 /*
454  * On-Chip QP Memory.
455  */
456 #define MIN_OCQP_SHIFT 12	/* 4KB == min ocqp size */
457 
c4iw_ocqp_pool_alloc(struct c4iw_rdev * rdev,int size)458 u32 c4iw_ocqp_pool_alloc(struct c4iw_rdev *rdev, int size)
459 {
460 	unsigned long addr = gen_pool_alloc(rdev->ocqp_pool, size);
461 	pr_debug("addr 0x%x size %d\n", (u32)addr, size);
462 	if (addr) {
463 		mutex_lock(&rdev->stats.lock);
464 		rdev->stats.ocqp.cur += roundup(size, 1 << MIN_OCQP_SHIFT);
465 		if (rdev->stats.ocqp.cur > rdev->stats.ocqp.max)
466 			rdev->stats.ocqp.max = rdev->stats.ocqp.cur;
467 		mutex_unlock(&rdev->stats.lock);
468 	}
469 	return (u32)addr;
470 }
471 
c4iw_ocqp_pool_free(struct c4iw_rdev * rdev,u32 addr,int size)472 void c4iw_ocqp_pool_free(struct c4iw_rdev *rdev, u32 addr, int size)
473 {
474 	pr_debug("addr 0x%x size %d\n", addr, size);
475 	mutex_lock(&rdev->stats.lock);
476 	rdev->stats.ocqp.cur -= roundup(size, 1 << MIN_OCQP_SHIFT);
477 	mutex_unlock(&rdev->stats.lock);
478 	gen_pool_free(rdev->ocqp_pool, (unsigned long)addr, size);
479 }
480 
c4iw_ocqp_pool_create(struct c4iw_rdev * rdev)481 int c4iw_ocqp_pool_create(struct c4iw_rdev *rdev)
482 {
483 	unsigned start, chunk, top;
484 
485 	rdev->ocqp_pool = gen_pool_create(MIN_OCQP_SHIFT, -1);
486 	if (!rdev->ocqp_pool)
487 		return -ENOMEM;
488 
489 	start = rdev->lldi.vr->ocq.start;
490 	chunk = rdev->lldi.vr->ocq.size;
491 	top = start + chunk;
492 
493 	while (start < top) {
494 		chunk = min(top - start + 1, chunk);
495 		if (gen_pool_add(rdev->ocqp_pool, start, chunk, -1)) {
496 			pr_debug("failed to add OCQP chunk (%x/%x)\n",
497 				 start, chunk);
498 			if (chunk <= 1024 << MIN_OCQP_SHIFT) {
499 				pr_warn("Failed to add all OCQP chunks (%x/%x)\n",
500 					start, top - start);
501 				return 0;
502 			}
503 			chunk >>= 1;
504 		} else {
505 			pr_debug("added OCQP chunk (%x/%x)\n",
506 				 start, chunk);
507 			start += chunk;
508 		}
509 	}
510 	return 0;
511 }
512 
c4iw_ocqp_pool_destroy(struct c4iw_rdev * rdev)513 void c4iw_ocqp_pool_destroy(struct c4iw_rdev *rdev)
514 {
515 	gen_pool_destroy(rdev->ocqp_pool);
516 }
517