Merge branch 'timer/cleanup' into late/mvebu2
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / infiniband / hw / amso1100 / c2_rnic.c
1 /*
2 * Copyright (c) 2005 Ammasso, Inc. All rights reserved.
3 * Copyright (c) 2005 Open Grid Computing, Inc. All rights reserved.
4 *
5 * This software is available to you under a choice of one of two
6 * licenses. You may choose to be licensed under the terms of the GNU
7 * General Public License (GPL) Version 2, available from the file
8 * COPYING in the main directory of this source tree, or the
9 * OpenIB.org BSD license below:
10 *
11 * Redistribution and use in source and binary forms, with or
12 * without modification, are permitted provided that the following
13 * conditions are met:
14 *
15 * - Redistributions of source code must retain the above
16 * copyright notice, this list of conditions and the following
17 * disclaimer.
18 *
19 * - Redistributions in binary form must reproduce the above
20 * copyright notice, this list of conditions and the following
21 * disclaimer in the documentation and/or other materials
22 * provided with the distribution.
23 *
24 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
25 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
26 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
27 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
28 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
29 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
30 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
31 * SOFTWARE.
32 *
33 */
34
35
36 #include <linux/module.h>
37 #include <linux/moduleparam.h>
38 #include <linux/pci.h>
39 #include <linux/netdevice.h>
40 #include <linux/etherdevice.h>
41 #include <linux/delay.h>
42 #include <linux/ethtool.h>
43 #include <linux/mii.h>
44 #include <linux/if_vlan.h>
45 #include <linux/crc32.h>
46 #include <linux/in.h>
47 #include <linux/ip.h>
48 #include <linux/tcp.h>
49 #include <linux/init.h>
50 #include <linux/dma-mapping.h>
51 #include <linux/mm.h>
52 #include <linux/inet.h>
53 #include <linux/vmalloc.h>
54 #include <linux/slab.h>
55
56 #include <linux/route.h>
57
58 #include <asm/io.h>
59 #include <asm/irq.h>
60 #include <asm/byteorder.h>
61 #include <rdma/ib_smi.h>
62 #include "c2.h"
63 #include "c2_vq.h"
64
65 /* Device capabilities */
66 #define C2_MIN_PAGESIZE 1024
67
68 #define C2_MAX_MRS 32768
69 #define C2_MAX_QPS 16000
70 #define C2_MAX_WQE_SZ 256
71 #define C2_MAX_QP_WR ((128*1024)/C2_MAX_WQE_SZ)
72 #define C2_MAX_SGES 4
73 #define C2_MAX_SGE_RD 1
74 #define C2_MAX_CQS 32768
75 #define C2_MAX_CQES 4096
76 #define C2_MAX_PDS 16384
77
78 /*
79 * Send the adapter INIT message to the amso1100
80 */
81 static int c2_adapter_init(struct c2_dev *c2dev)
82 {
83 struct c2wr_init_req wr;
84 int err;
85
86 memset(&wr, 0, sizeof(wr));
87 c2_wr_set_id(&wr, CCWR_INIT);
88 wr.hdr.context = 0;
89 wr.hint_count = cpu_to_be64(c2dev->hint_count_dma);
90 wr.q0_host_shared = cpu_to_be64(c2dev->req_vq.shared_dma);
91 wr.q1_host_shared = cpu_to_be64(c2dev->rep_vq.shared_dma);
92 wr.q1_host_msg_pool = cpu_to_be64(c2dev->rep_vq.host_dma);
93 wr.q2_host_shared = cpu_to_be64(c2dev->aeq.shared_dma);
94 wr.q2_host_msg_pool = cpu_to_be64(c2dev->aeq.host_dma);
95
96 /* Post the init message */
97 err = vq_send_wr(c2dev, (union c2wr *) & wr);
98
99 return err;
100 }
101
102 /*
103 * Send the adapter TERM message to the amso1100
104 */
105 static void c2_adapter_term(struct c2_dev *c2dev)
106 {
107 struct c2wr_init_req wr;
108
109 memset(&wr, 0, sizeof(wr));
110 c2_wr_set_id(&wr, CCWR_TERM);
111 wr.hdr.context = 0;
112
113 /* Post the init message */
114 vq_send_wr(c2dev, (union c2wr *) & wr);
115 c2dev->init = 0;
116
117 return;
118 }
119
120 /*
121 * Query the adapter
122 */
123 static int c2_rnic_query(struct c2_dev *c2dev, struct ib_device_attr *props)
124 {
125 struct c2_vq_req *vq_req;
126 struct c2wr_rnic_query_req wr;
127 struct c2wr_rnic_query_rep *reply;
128 int err;
129
130 vq_req = vq_req_alloc(c2dev);
131 if (!vq_req)
132 return -ENOMEM;
133
134 c2_wr_set_id(&wr, CCWR_RNIC_QUERY);
135 wr.hdr.context = (unsigned long) vq_req;
136 wr.rnic_handle = c2dev->adapter_handle;
137
138 vq_req_get(c2dev, vq_req);
139
140 err = vq_send_wr(c2dev, (union c2wr *) &wr);
141 if (err) {
142 vq_req_put(c2dev, vq_req);
143 goto bail1;
144 }
145
146 err = vq_wait_for_reply(c2dev, vq_req);
147 if (err)
148 goto bail1;
149
150 reply =
151 (struct c2wr_rnic_query_rep *) (unsigned long) (vq_req->reply_msg);
152 if (!reply)
153 err = -ENOMEM;
154 else
155 err = c2_errno(reply);
156 if (err)
157 goto bail2;
158
159 props->fw_ver =
160 ((u64)be32_to_cpu(reply->fw_ver_major) << 32) |
161 ((be32_to_cpu(reply->fw_ver_minor) & 0xFFFF) << 16) |
162 (be32_to_cpu(reply->fw_ver_patch) & 0xFFFF);
163 memcpy(&props->sys_image_guid, c2dev->netdev->dev_addr, 6);
164 props->max_mr_size = 0xFFFFFFFF;
165 props->page_size_cap = ~(C2_MIN_PAGESIZE-1);
166 props->vendor_id = be32_to_cpu(reply->vendor_id);
167 props->vendor_part_id = be32_to_cpu(reply->part_number);
168 props->hw_ver = be32_to_cpu(reply->hw_version);
169 props->max_qp = be32_to_cpu(reply->max_qps);
170 props->max_qp_wr = be32_to_cpu(reply->max_qp_depth);
171 props->device_cap_flags = c2dev->device_cap_flags;
172 props->max_sge = C2_MAX_SGES;
173 props->max_sge_rd = C2_MAX_SGE_RD;
174 props->max_cq = be32_to_cpu(reply->max_cqs);
175 props->max_cqe = be32_to_cpu(reply->max_cq_depth);
176 props->max_mr = be32_to_cpu(reply->max_mrs);
177 props->max_pd = be32_to_cpu(reply->max_pds);
178 props->max_qp_rd_atom = be32_to_cpu(reply->max_qp_ird);
179 props->max_ee_rd_atom = 0;
180 props->max_res_rd_atom = be32_to_cpu(reply->max_global_ird);
181 props->max_qp_init_rd_atom = be32_to_cpu(reply->max_qp_ord);
182 props->max_ee_init_rd_atom = 0;
183 props->atomic_cap = IB_ATOMIC_NONE;
184 props->max_ee = 0;
185 props->max_rdd = 0;
186 props->max_mw = be32_to_cpu(reply->max_mws);
187 props->max_raw_ipv6_qp = 0;
188 props->max_raw_ethy_qp = 0;
189 props->max_mcast_grp = 0;
190 props->max_mcast_qp_attach = 0;
191 props->max_total_mcast_qp_attach = 0;
192 props->max_ah = 0;
193 props->max_fmr = 0;
194 props->max_map_per_fmr = 0;
195 props->max_srq = 0;
196 props->max_srq_wr = 0;
197 props->max_srq_sge = 0;
198 props->max_pkeys = 0;
199 props->local_ca_ack_delay = 0;
200
201 bail2:
202 vq_repbuf_free(c2dev, reply);
203
204 bail1:
205 vq_req_free(c2dev, vq_req);
206 return err;
207 }
208
209 /*
210 * Add an IP address to the RNIC interface
211 */
212 int c2_add_addr(struct c2_dev *c2dev, __be32 inaddr, __be32 inmask)
213 {
214 struct c2_vq_req *vq_req;
215 struct c2wr_rnic_setconfig_req *wr;
216 struct c2wr_rnic_setconfig_rep *reply;
217 struct c2_netaddr netaddr;
218 int err, len;
219
220 vq_req = vq_req_alloc(c2dev);
221 if (!vq_req)
222 return -ENOMEM;
223
224 len = sizeof(struct c2_netaddr);
225 wr = kmalloc(c2dev->req_vq.msg_size, GFP_KERNEL);
226 if (!wr) {
227 err = -ENOMEM;
228 goto bail0;
229 }
230
231 c2_wr_set_id(wr, CCWR_RNIC_SETCONFIG);
232 wr->hdr.context = (unsigned long) vq_req;
233 wr->rnic_handle = c2dev->adapter_handle;
234 wr->option = cpu_to_be32(C2_CFG_ADD_ADDR);
235
236 netaddr.ip_addr = inaddr;
237 netaddr.netmask = inmask;
238 netaddr.mtu = 0;
239
240 memcpy(wr->data, &netaddr, len);
241
242 vq_req_get(c2dev, vq_req);
243
244 err = vq_send_wr(c2dev, (union c2wr *) wr);
245 if (err) {
246 vq_req_put(c2dev, vq_req);
247 goto bail1;
248 }
249
250 err = vq_wait_for_reply(c2dev, vq_req);
251 if (err)
252 goto bail1;
253
254 reply =
255 (struct c2wr_rnic_setconfig_rep *) (unsigned long) (vq_req->reply_msg);
256 if (!reply) {
257 err = -ENOMEM;
258 goto bail1;
259 }
260
261 err = c2_errno(reply);
262 vq_repbuf_free(c2dev, reply);
263
264 bail1:
265 kfree(wr);
266 bail0:
267 vq_req_free(c2dev, vq_req);
268 return err;
269 }
270
271 /*
272 * Delete an IP address from the RNIC interface
273 */
274 int c2_del_addr(struct c2_dev *c2dev, __be32 inaddr, __be32 inmask)
275 {
276 struct c2_vq_req *vq_req;
277 struct c2wr_rnic_setconfig_req *wr;
278 struct c2wr_rnic_setconfig_rep *reply;
279 struct c2_netaddr netaddr;
280 int err, len;
281
282 vq_req = vq_req_alloc(c2dev);
283 if (!vq_req)
284 return -ENOMEM;
285
286 len = sizeof(struct c2_netaddr);
287 wr = kmalloc(c2dev->req_vq.msg_size, GFP_KERNEL);
288 if (!wr) {
289 err = -ENOMEM;
290 goto bail0;
291 }
292
293 c2_wr_set_id(wr, CCWR_RNIC_SETCONFIG);
294 wr->hdr.context = (unsigned long) vq_req;
295 wr->rnic_handle = c2dev->adapter_handle;
296 wr->option = cpu_to_be32(C2_CFG_DEL_ADDR);
297
298 netaddr.ip_addr = inaddr;
299 netaddr.netmask = inmask;
300 netaddr.mtu = 0;
301
302 memcpy(wr->data, &netaddr, len);
303
304 vq_req_get(c2dev, vq_req);
305
306 err = vq_send_wr(c2dev, (union c2wr *) wr);
307 if (err) {
308 vq_req_put(c2dev, vq_req);
309 goto bail1;
310 }
311
312 err = vq_wait_for_reply(c2dev, vq_req);
313 if (err)
314 goto bail1;
315
316 reply =
317 (struct c2wr_rnic_setconfig_rep *) (unsigned long) (vq_req->reply_msg);
318 if (!reply) {
319 err = -ENOMEM;
320 goto bail1;
321 }
322
323 err = c2_errno(reply);
324 vq_repbuf_free(c2dev, reply);
325
326 bail1:
327 kfree(wr);
328 bail0:
329 vq_req_free(c2dev, vq_req);
330 return err;
331 }
332
333 /*
334 * Open a single RNIC instance to use with all
335 * low level openib calls
336 */
337 static int c2_rnic_open(struct c2_dev *c2dev)
338 {
339 struct c2_vq_req *vq_req;
340 union c2wr wr;
341 struct c2wr_rnic_open_rep *reply;
342 int err;
343
344 vq_req = vq_req_alloc(c2dev);
345 if (vq_req == NULL) {
346 return -ENOMEM;
347 }
348
349 memset(&wr, 0, sizeof(wr));
350 c2_wr_set_id(&wr, CCWR_RNIC_OPEN);
351 wr.rnic_open.req.hdr.context = (unsigned long) (vq_req);
352 wr.rnic_open.req.flags = cpu_to_be16(RNIC_PRIV_MODE);
353 wr.rnic_open.req.port_num = cpu_to_be16(0);
354 wr.rnic_open.req.user_context = (unsigned long) c2dev;
355
356 vq_req_get(c2dev, vq_req);
357
358 err = vq_send_wr(c2dev, &wr);
359 if (err) {
360 vq_req_put(c2dev, vq_req);
361 goto bail0;
362 }
363
364 err = vq_wait_for_reply(c2dev, vq_req);
365 if (err) {
366 goto bail0;
367 }
368
369 reply = (struct c2wr_rnic_open_rep *) (unsigned long) (vq_req->reply_msg);
370 if (!reply) {
371 err = -ENOMEM;
372 goto bail0;
373 }
374
375 if ((err = c2_errno(reply)) != 0) {
376 goto bail1;
377 }
378
379 c2dev->adapter_handle = reply->rnic_handle;
380
381 bail1:
382 vq_repbuf_free(c2dev, reply);
383 bail0:
384 vq_req_free(c2dev, vq_req);
385 return err;
386 }
387
388 /*
389 * Close the RNIC instance
390 */
391 static int c2_rnic_close(struct c2_dev *c2dev)
392 {
393 struct c2_vq_req *vq_req;
394 union c2wr wr;
395 struct c2wr_rnic_close_rep *reply;
396 int err;
397
398 vq_req = vq_req_alloc(c2dev);
399 if (vq_req == NULL) {
400 return -ENOMEM;
401 }
402
403 memset(&wr, 0, sizeof(wr));
404 c2_wr_set_id(&wr, CCWR_RNIC_CLOSE);
405 wr.rnic_close.req.hdr.context = (unsigned long) vq_req;
406 wr.rnic_close.req.rnic_handle = c2dev->adapter_handle;
407
408 vq_req_get(c2dev, vq_req);
409
410 err = vq_send_wr(c2dev, &wr);
411 if (err) {
412 vq_req_put(c2dev, vq_req);
413 goto bail0;
414 }
415
416 err = vq_wait_for_reply(c2dev, vq_req);
417 if (err) {
418 goto bail0;
419 }
420
421 reply = (struct c2wr_rnic_close_rep *) (unsigned long) (vq_req->reply_msg);
422 if (!reply) {
423 err = -ENOMEM;
424 goto bail0;
425 }
426
427 if ((err = c2_errno(reply)) != 0) {
428 goto bail1;
429 }
430
431 c2dev->adapter_handle = 0;
432
433 bail1:
434 vq_repbuf_free(c2dev, reply);
435 bail0:
436 vq_req_free(c2dev, vq_req);
437 return err;
438 }
439
440 /*
441 * Called by c2_probe to initialize the RNIC. This principally
442 * involves initializing the various limits and resource pools that
443 * comprise the RNIC instance.
444 */
445 int c2_rnic_init(struct c2_dev *c2dev)
446 {
447 int err;
448 u32 qsize, msgsize;
449 void *q1_pages;
450 void *q2_pages;
451 void __iomem *mmio_regs;
452
453 /* Device capabilities */
454 c2dev->device_cap_flags =
455 (IB_DEVICE_RESIZE_MAX_WR |
456 IB_DEVICE_CURR_QP_STATE_MOD |
457 IB_DEVICE_SYS_IMAGE_GUID |
458 IB_DEVICE_LOCAL_DMA_LKEY |
459 IB_DEVICE_MEM_WINDOW);
460
461 /* Allocate the qptr_array */
462 c2dev->qptr_array = vzalloc(C2_MAX_CQS * sizeof(void *));
463 if (!c2dev->qptr_array) {
464 return -ENOMEM;
465 }
466
467 /* Initialize the qptr_array */
468 c2dev->qptr_array[0] = (void *) &c2dev->req_vq;
469 c2dev->qptr_array[1] = (void *) &c2dev->rep_vq;
470 c2dev->qptr_array[2] = (void *) &c2dev->aeq;
471
472 /* Initialize data structures */
473 init_waitqueue_head(&c2dev->req_vq_wo);
474 spin_lock_init(&c2dev->vqlock);
475 spin_lock_init(&c2dev->lock);
476
477 /* Allocate MQ shared pointer pool for kernel clients. User
478 * mode client pools are hung off the user context
479 */
480 err = c2_init_mqsp_pool(c2dev, GFP_KERNEL, &c2dev->kern_mqsp_pool);
481 if (err) {
482 goto bail0;
483 }
484
485 /* Allocate shared pointers for Q0, Q1, and Q2 from
486 * the shared pointer pool.
487 */
488
489 c2dev->hint_count = c2_alloc_mqsp(c2dev, c2dev->kern_mqsp_pool,
490 &c2dev->hint_count_dma,
491 GFP_KERNEL);
492 c2dev->req_vq.shared = c2_alloc_mqsp(c2dev, c2dev->kern_mqsp_pool,
493 &c2dev->req_vq.shared_dma,
494 GFP_KERNEL);
495 c2dev->rep_vq.shared = c2_alloc_mqsp(c2dev, c2dev->kern_mqsp_pool,
496 &c2dev->rep_vq.shared_dma,
497 GFP_KERNEL);
498 c2dev->aeq.shared = c2_alloc_mqsp(c2dev, c2dev->kern_mqsp_pool,
499 &c2dev->aeq.shared_dma, GFP_KERNEL);
500 if (!c2dev->hint_count || !c2dev->req_vq.shared ||
501 !c2dev->rep_vq.shared || !c2dev->aeq.shared) {
502 err = -ENOMEM;
503 goto bail1;
504 }
505
506 mmio_regs = c2dev->kva;
507 /* Initialize the Verbs Request Queue */
508 c2_mq_req_init(&c2dev->req_vq, 0,
509 be32_to_cpu((__force __be32) readl(mmio_regs + C2_REGS_Q0_QSIZE)),
510 be32_to_cpu((__force __be32) readl(mmio_regs + C2_REGS_Q0_MSGSIZE)),
511 mmio_regs +
512 be32_to_cpu((__force __be32) readl(mmio_regs + C2_REGS_Q0_POOLSTART)),
513 mmio_regs +
514 be32_to_cpu((__force __be32) readl(mmio_regs + C2_REGS_Q0_SHARED)),
515 C2_MQ_ADAPTER_TARGET);
516
517 /* Initialize the Verbs Reply Queue */
518 qsize = be32_to_cpu((__force __be32) readl(mmio_regs + C2_REGS_Q1_QSIZE));
519 msgsize = be32_to_cpu((__force __be32) readl(mmio_regs + C2_REGS_Q1_MSGSIZE));
520 q1_pages = dma_alloc_coherent(&c2dev->pcidev->dev, qsize * msgsize,
521 &c2dev->rep_vq.host_dma, GFP_KERNEL);
522 if (!q1_pages) {
523 err = -ENOMEM;
524 goto bail1;
525 }
526 dma_unmap_addr_set(&c2dev->rep_vq, mapping, c2dev->rep_vq.host_dma);
527 pr_debug("%s rep_vq va %p dma %llx\n", __func__, q1_pages,
528 (unsigned long long) c2dev->rep_vq.host_dma);
529 c2_mq_rep_init(&c2dev->rep_vq,
530 1,
531 qsize,
532 msgsize,
533 q1_pages,
534 mmio_regs +
535 be32_to_cpu((__force __be32) readl(mmio_regs + C2_REGS_Q1_SHARED)),
536 C2_MQ_HOST_TARGET);
537
538 /* Initialize the Asynchronus Event Queue */
539 qsize = be32_to_cpu((__force __be32) readl(mmio_regs + C2_REGS_Q2_QSIZE));
540 msgsize = be32_to_cpu((__force __be32) readl(mmio_regs + C2_REGS_Q2_MSGSIZE));
541 q2_pages = dma_alloc_coherent(&c2dev->pcidev->dev, qsize * msgsize,
542 &c2dev->aeq.host_dma, GFP_KERNEL);
543 if (!q2_pages) {
544 err = -ENOMEM;
545 goto bail2;
546 }
547 dma_unmap_addr_set(&c2dev->aeq, mapping, c2dev->aeq.host_dma);
548 pr_debug("%s aeq va %p dma %llx\n", __func__, q2_pages,
549 (unsigned long long) c2dev->aeq.host_dma);
550 c2_mq_rep_init(&c2dev->aeq,
551 2,
552 qsize,
553 msgsize,
554 q2_pages,
555 mmio_regs +
556 be32_to_cpu((__force __be32) readl(mmio_regs + C2_REGS_Q2_SHARED)),
557 C2_MQ_HOST_TARGET);
558
559 /* Initialize the verbs request allocator */
560 err = vq_init(c2dev);
561 if (err)
562 goto bail3;
563
564 /* Enable interrupts on the adapter */
565 writel(0, c2dev->regs + C2_IDIS);
566
567 /* create the WR init message */
568 err = c2_adapter_init(c2dev);
569 if (err)
570 goto bail4;
571 c2dev->init++;
572
573 /* open an adapter instance */
574 err = c2_rnic_open(c2dev);
575 if (err)
576 goto bail4;
577
578 /* Initialize cached the adapter limits */
579 if (c2_rnic_query(c2dev, &c2dev->props))
580 goto bail5;
581
582 /* Initialize the PD pool */
583 err = c2_init_pd_table(c2dev);
584 if (err)
585 goto bail5;
586
587 /* Initialize the QP pool */
588 c2_init_qp_table(c2dev);
589 return 0;
590
591 bail5:
592 c2_rnic_close(c2dev);
593 bail4:
594 vq_term(c2dev);
595 bail3:
596 dma_free_coherent(&c2dev->pcidev->dev,
597 c2dev->aeq.q_size * c2dev->aeq.msg_size,
598 q2_pages, dma_unmap_addr(&c2dev->aeq, mapping));
599 bail2:
600 dma_free_coherent(&c2dev->pcidev->dev,
601 c2dev->rep_vq.q_size * c2dev->rep_vq.msg_size,
602 q1_pages, dma_unmap_addr(&c2dev->rep_vq, mapping));
603 bail1:
604 c2_free_mqsp_pool(c2dev, c2dev->kern_mqsp_pool);
605 bail0:
606 vfree(c2dev->qptr_array);
607
608 return err;
609 }
610
611 /*
612 * Called by c2_remove to cleanup the RNIC resources.
613 */
614 void c2_rnic_term(struct c2_dev *c2dev)
615 {
616
617 /* Close the open adapter instance */
618 c2_rnic_close(c2dev);
619
620 /* Send the TERM message to the adapter */
621 c2_adapter_term(c2dev);
622
623 /* Disable interrupts on the adapter */
624 writel(1, c2dev->regs + C2_IDIS);
625
626 /* Free the QP pool */
627 c2_cleanup_qp_table(c2dev);
628
629 /* Free the PD pool */
630 c2_cleanup_pd_table(c2dev);
631
632 /* Free the verbs request allocator */
633 vq_term(c2dev);
634
635 /* Free the asynchronus event queue */
636 dma_free_coherent(&c2dev->pcidev->dev,
637 c2dev->aeq.q_size * c2dev->aeq.msg_size,
638 c2dev->aeq.msg_pool.host,
639 dma_unmap_addr(&c2dev->aeq, mapping));
640
641 /* Free the verbs reply queue */
642 dma_free_coherent(&c2dev->pcidev->dev,
643 c2dev->rep_vq.q_size * c2dev->rep_vq.msg_size,
644 c2dev->rep_vq.msg_pool.host,
645 dma_unmap_addr(&c2dev->rep_vq, mapping));
646
647 /* Free the MQ shared pointer pool */
648 c2_free_mqsp_pool(c2dev, c2dev->kern_mqsp_pool);
649
650 /* Free the qptr_array */
651 vfree(c2dev->qptr_array);
652
653 return;
654 }