Lines Matching refs:aq
123 struct efa_com_admin_queue *aq = &edev->aq; in efa_com_admin_init_sq() local
124 struct efa_com_admin_sq *sq = &aq->sq; in efa_com_admin_init_sq()
125 u16 size = aq->depth * sizeof(*sq->entries); in efa_com_admin_init_sq()
131 dma_alloc_coherent(aq->dmadev, size, &sq->dma_addr, GFP_KERNEL); in efa_com_admin_init_sq()
149 EFA_SET(&aq_caps, EFA_REGS_AQ_CAPS_AQ_DEPTH, aq->depth); in efa_com_admin_init_sq()
160 struct efa_com_admin_queue *aq = &edev->aq; in efa_com_admin_init_cq() local
161 struct efa_com_admin_cq *cq = &aq->cq; in efa_com_admin_init_cq()
162 u16 size = aq->depth * sizeof(*cq->entries); in efa_com_admin_init_cq()
168 dma_alloc_coherent(aq->dmadev, size, &cq->dma_addr, GFP_KERNEL); in efa_com_admin_init_cq()
183 EFA_SET(&acq_caps, EFA_REGS_ACQ_CAPS_ACQ_DEPTH, aq->depth); in efa_com_admin_init_cq()
187 aq->msix_vector_idx); in efa_com_admin_init_cq()
241 static u16 efa_com_alloc_ctx_id(struct efa_com_admin_queue *aq) in efa_com_alloc_ctx_id() argument
245 spin_lock(&aq->comp_ctx_lock); in efa_com_alloc_ctx_id()
246 ctx_id = aq->comp_ctx_pool[aq->comp_ctx_pool_next]; in efa_com_alloc_ctx_id()
247 aq->comp_ctx_pool_next++; in efa_com_alloc_ctx_id()
248 spin_unlock(&aq->comp_ctx_lock); in efa_com_alloc_ctx_id()
253 static void efa_com_dealloc_ctx_id(struct efa_com_admin_queue *aq, in efa_com_dealloc_ctx_id() argument
256 spin_lock(&aq->comp_ctx_lock); in efa_com_dealloc_ctx_id()
257 aq->comp_ctx_pool_next--; in efa_com_dealloc_ctx_id()
258 aq->comp_ctx_pool[aq->comp_ctx_pool_next] = ctx_id; in efa_com_dealloc_ctx_id()
259 spin_unlock(&aq->comp_ctx_lock); in efa_com_dealloc_ctx_id()
262 static inline void efa_com_put_comp_ctx(struct efa_com_admin_queue *aq, in efa_com_put_comp_ctx() argument
267 u16 ctx_id = cmd_id & (aq->depth - 1); in efa_com_put_comp_ctx()
269 ibdev_dbg(aq->efa_dev, "Put completion command_id %#x\n", cmd_id); in efa_com_put_comp_ctx()
271 efa_com_dealloc_ctx_id(aq, ctx_id); in efa_com_put_comp_ctx()
274 static struct efa_comp_ctx *efa_com_get_comp_ctx(struct efa_com_admin_queue *aq, in efa_com_get_comp_ctx() argument
277 u16 ctx_id = cmd_id & (aq->depth - 1); in efa_com_get_comp_ctx()
279 if (aq->comp_ctx[ctx_id].occupied && capture) { in efa_com_get_comp_ctx()
281 aq->efa_dev, in efa_com_get_comp_ctx()
288 aq->comp_ctx[ctx_id].occupied = 1; in efa_com_get_comp_ctx()
289 ibdev_dbg(aq->efa_dev, in efa_com_get_comp_ctx()
293 return &aq->comp_ctx[ctx_id]; in efa_com_get_comp_ctx()
296 static struct efa_comp_ctx *__efa_com_submit_admin_cmd(struct efa_com_admin_queue *aq, in __efa_com_submit_admin_cmd() argument
309 queue_size_mask = aq->depth - 1; in __efa_com_submit_admin_cmd()
310 pi = aq->sq.pc & queue_size_mask; in __efa_com_submit_admin_cmd()
312 ctx_id = efa_com_alloc_ctx_id(aq); in __efa_com_submit_admin_cmd()
316 cmd_id |= aq->sq.pc & ~queue_size_mask; in __efa_com_submit_admin_cmd()
321 EFA_ADMIN_AQ_COMMON_DESC_PHASE, aq->sq.phase); in __efa_com_submit_admin_cmd()
323 comp_ctx = efa_com_get_comp_ctx(aq, cmd_id, true); in __efa_com_submit_admin_cmd()
325 efa_com_dealloc_ctx_id(aq, ctx_id); in __efa_com_submit_admin_cmd()
336 aqe = &aq->sq.entries[pi]; in __efa_com_submit_admin_cmd()
340 aq->sq.pc++; in __efa_com_submit_admin_cmd()
341 atomic64_inc(&aq->stats.submitted_cmd); in __efa_com_submit_admin_cmd()
343 if ((aq->sq.pc & queue_size_mask) == 0) in __efa_com_submit_admin_cmd()
344 aq->sq.phase = !aq->sq.phase; in __efa_com_submit_admin_cmd()
347 writel(aq->sq.pc, aq->sq.db_addr); in __efa_com_submit_admin_cmd()
352 static inline int efa_com_init_comp_ctxt(struct efa_com_admin_queue *aq) in efa_com_init_comp_ctxt() argument
354 size_t pool_size = aq->depth * sizeof(*aq->comp_ctx_pool); in efa_com_init_comp_ctxt()
355 size_t size = aq->depth * sizeof(struct efa_comp_ctx); in efa_com_init_comp_ctxt()
359 aq->comp_ctx = devm_kzalloc(aq->dmadev, size, GFP_KERNEL); in efa_com_init_comp_ctxt()
360 aq->comp_ctx_pool = devm_kzalloc(aq->dmadev, pool_size, GFP_KERNEL); in efa_com_init_comp_ctxt()
361 if (!aq->comp_ctx || !aq->comp_ctx_pool) { in efa_com_init_comp_ctxt()
362 devm_kfree(aq->dmadev, aq->comp_ctx_pool); in efa_com_init_comp_ctxt()
363 devm_kfree(aq->dmadev, aq->comp_ctx); in efa_com_init_comp_ctxt()
367 for (i = 0; i < aq->depth; i++) { in efa_com_init_comp_ctxt()
368 comp_ctx = efa_com_get_comp_ctx(aq, i, false); in efa_com_init_comp_ctxt()
372 aq->comp_ctx_pool[i] = i; in efa_com_init_comp_ctxt()
375 spin_lock_init(&aq->comp_ctx_lock); in efa_com_init_comp_ctxt()
377 aq->comp_ctx_pool_next = 0; in efa_com_init_comp_ctxt()
382 static struct efa_comp_ctx *efa_com_submit_admin_cmd(struct efa_com_admin_queue *aq, in efa_com_submit_admin_cmd() argument
390 spin_lock(&aq->sq.lock); in efa_com_submit_admin_cmd()
391 if (!test_bit(EFA_AQ_STATE_RUNNING_BIT, &aq->state)) { in efa_com_submit_admin_cmd()
392 ibdev_err_ratelimited(aq->efa_dev, "Admin queue is closed\n"); in efa_com_submit_admin_cmd()
393 spin_unlock(&aq->sq.lock); in efa_com_submit_admin_cmd()
397 comp_ctx = __efa_com_submit_admin_cmd(aq, cmd, cmd_size_in_bytes, comp, in efa_com_submit_admin_cmd()
399 spin_unlock(&aq->sq.lock); in efa_com_submit_admin_cmd()
401 clear_bit(EFA_AQ_STATE_RUNNING_BIT, &aq->state); in efa_com_submit_admin_cmd()
406 static void efa_com_handle_single_admin_completion(struct efa_com_admin_queue *aq, in efa_com_handle_single_admin_completion() argument
415 comp_ctx = efa_com_get_comp_ctx(aq, cmd_id, false); in efa_com_handle_single_admin_completion()
417 ibdev_err(aq->efa_dev, in efa_com_handle_single_admin_completion()
419 clear_bit(EFA_AQ_STATE_RUNNING_BIT, &aq->state); in efa_com_handle_single_admin_completion()
428 if (!test_bit(EFA_AQ_STATE_POLLING_BIT, &aq->state)) in efa_com_handle_single_admin_completion()
432 static void efa_com_handle_admin_completion(struct efa_com_admin_queue *aq) in efa_com_handle_admin_completion() argument
440 queue_size_mask = aq->depth - 1; in efa_com_handle_admin_completion()
442 ci = aq->cq.cc & queue_size_mask; in efa_com_handle_admin_completion()
443 phase = aq->cq.phase; in efa_com_handle_admin_completion()
445 cqe = &aq->cq.entries[ci]; in efa_com_handle_admin_completion()
455 efa_com_handle_single_admin_completion(aq, cqe); in efa_com_handle_admin_completion()
459 if (ci == aq->depth) { in efa_com_handle_admin_completion()
464 cqe = &aq->cq.entries[ci]; in efa_com_handle_admin_completion()
467 aq->cq.cc += comp_num; in efa_com_handle_admin_completion()
468 aq->cq.phase = phase; in efa_com_handle_admin_completion()
469 aq->sq.cc += comp_num; in efa_com_handle_admin_completion()
470 atomic64_add(comp_num, &aq->stats.completed_cmd); in efa_com_handle_admin_completion()
493 struct efa_com_admin_queue *aq) in efa_com_wait_and_process_admin_cq_polling() argument
499 timeout = jiffies + usecs_to_jiffies(aq->completion_timeout); in efa_com_wait_and_process_admin_cq_polling()
502 spin_lock_irqsave(&aq->cq.lock, flags); in efa_com_wait_and_process_admin_cq_polling()
503 efa_com_handle_admin_completion(aq); in efa_com_wait_and_process_admin_cq_polling()
504 spin_unlock_irqrestore(&aq->cq.lock, flags); in efa_com_wait_and_process_admin_cq_polling()
511 aq->efa_dev, in efa_com_wait_and_process_admin_cq_polling()
514 atomic64_inc(&aq->stats.no_completion); in efa_com_wait_and_process_admin_cq_polling()
516 clear_bit(EFA_AQ_STATE_RUNNING_BIT, &aq->state); in efa_com_wait_and_process_admin_cq_polling()
521 msleep(aq->poll_interval); in efa_com_wait_and_process_admin_cq_polling()
526 efa_com_put_comp_ctx(aq, comp_ctx); in efa_com_wait_and_process_admin_cq_polling()
531 struct efa_com_admin_queue *aq) in efa_com_wait_and_process_admin_cq_interrupts() argument
537 usecs_to_jiffies(aq->completion_timeout)); in efa_com_wait_and_process_admin_cq_interrupts()
546 spin_lock_irqsave(&aq->cq.lock, flags); in efa_com_wait_and_process_admin_cq_interrupts()
547 efa_com_handle_admin_completion(aq); in efa_com_wait_and_process_admin_cq_interrupts()
548 spin_unlock_irqrestore(&aq->cq.lock, flags); in efa_com_wait_and_process_admin_cq_interrupts()
550 atomic64_inc(&aq->stats.no_completion); in efa_com_wait_and_process_admin_cq_interrupts()
554 aq->efa_dev, in efa_com_wait_and_process_admin_cq_interrupts()
558 comp_ctx, aq->sq.pc, aq->sq.cc, aq->cq.cc); in efa_com_wait_and_process_admin_cq_interrupts()
561 aq->efa_dev, in efa_com_wait_and_process_admin_cq_interrupts()
565 comp_ctx, aq->sq.pc, aq->sq.cc, aq->cq.cc); in efa_com_wait_and_process_admin_cq_interrupts()
567 clear_bit(EFA_AQ_STATE_RUNNING_BIT, &aq->state); in efa_com_wait_and_process_admin_cq_interrupts()
574 efa_com_put_comp_ctx(aq, comp_ctx); in efa_com_wait_and_process_admin_cq_interrupts()
587 struct efa_com_admin_queue *aq) in efa_com_wait_and_process_admin_cq() argument
589 if (test_bit(EFA_AQ_STATE_POLLING_BIT, &aq->state)) in efa_com_wait_and_process_admin_cq()
590 return efa_com_wait_and_process_admin_cq_polling(comp_ctx, aq); in efa_com_wait_and_process_admin_cq()
592 return efa_com_wait_and_process_admin_cq_interrupts(comp_ctx, aq); in efa_com_wait_and_process_admin_cq()
608 int efa_com_cmd_exec(struct efa_com_admin_queue *aq, in efa_com_cmd_exec() argument
620 down(&aq->avail_cmds); in efa_com_cmd_exec()
622 ibdev_dbg(aq->efa_dev, "%s (opcode %d)\n", in efa_com_cmd_exec()
625 comp_ctx = efa_com_submit_admin_cmd(aq, cmd, cmd_size, comp, comp_size); in efa_com_cmd_exec()
628 aq->efa_dev, in efa_com_cmd_exec()
633 up(&aq->avail_cmds); in efa_com_cmd_exec()
634 atomic64_inc(&aq->stats.cmd_err); in efa_com_cmd_exec()
638 err = efa_com_wait_and_process_admin_cq(comp_ctx, aq); in efa_com_cmd_exec()
641 aq->efa_dev, in efa_com_cmd_exec()
646 atomic64_inc(&aq->stats.cmd_err); in efa_com_cmd_exec()
649 up(&aq->avail_cmds); in efa_com_cmd_exec()
660 struct efa_com_admin_queue *aq = &edev->aq; in efa_com_admin_destroy() local
662 struct efa_com_admin_cq *cq = &aq->cq; in efa_com_admin_destroy()
663 struct efa_com_admin_sq *sq = &aq->sq; in efa_com_admin_destroy()
666 clear_bit(EFA_AQ_STATE_RUNNING_BIT, &aq->state); in efa_com_admin_destroy()
668 devm_kfree(edev->dmadev, aq->comp_ctx_pool); in efa_com_admin_destroy()
669 devm_kfree(edev->dmadev, aq->comp_ctx); in efa_com_admin_destroy()
671 size = aq->depth * sizeof(*sq->entries); in efa_com_admin_destroy()
674 size = aq->depth * sizeof(*cq->entries); in efa_com_admin_destroy()
697 set_bit(EFA_AQ_STATE_POLLING_BIT, &edev->aq.state); in efa_com_set_admin_polling_mode()
699 clear_bit(EFA_AQ_STATE_POLLING_BIT, &edev->aq.state); in efa_com_set_admin_polling_mode()
704 atomic64_t *s = (atomic64_t *)&edev->aq.stats; in efa_com_stats_init()
707 for (i = 0; i < sizeof(edev->aq.stats) / sizeof(*s); i++, s++) in efa_com_stats_init()
724 struct efa_com_admin_queue *aq = &edev->aq; in efa_com_admin_init() local
737 aq->depth = EFA_ADMIN_QUEUE_DEPTH; in efa_com_admin_init()
739 aq->dmadev = edev->dmadev; in efa_com_admin_init()
740 aq->efa_dev = edev->efa_dev; in efa_com_admin_init()
741 set_bit(EFA_AQ_STATE_POLLING_BIT, &aq->state); in efa_com_admin_init()
743 sema_init(&aq->avail_cmds, aq->depth); in efa_com_admin_init()
747 err = efa_com_init_comp_ctxt(aq); in efa_com_admin_init()
769 aq->completion_timeout = timeout * 100000; in efa_com_admin_init()
771 aq->completion_timeout = ADMIN_CMD_TIMEOUT_US; in efa_com_admin_init()
773 aq->poll_interval = EFA_POLL_INTERVAL_MS; in efa_com_admin_init()
775 set_bit(EFA_AQ_STATE_RUNNING_BIT, &aq->state); in efa_com_admin_init()
780 dma_free_coherent(edev->dmadev, aq->depth * sizeof(*aq->cq.entries), in efa_com_admin_init()
781 aq->cq.entries, aq->cq.dma_addr); in efa_com_admin_init()
783 dma_free_coherent(edev->dmadev, aq->depth * sizeof(*aq->sq.entries), in efa_com_admin_init()
784 aq->sq.entries, aq->sq.dma_addr); in efa_com_admin_init()
786 devm_kfree(edev->dmadev, aq->comp_ctx); in efa_com_admin_init()
804 spin_lock_irqsave(&edev->aq.cq.lock, flags); in efa_com_admin_q_comp_intr_handler()
805 efa_com_handle_admin_completion(&edev->aq); in efa_com_admin_q_comp_intr_handler()
806 spin_unlock_irqrestore(&edev->aq.cq.lock, flags); in efa_com_admin_q_comp_intr_handler()
1085 edev->aq.completion_timeout = timeout * 100000; in efa_com_dev_reset()
1087 edev->aq.completion_timeout = ADMIN_CMD_TIMEOUT_US; in efa_com_dev_reset()