cq.c revision f9baff509f8a05a79626defdbdf4f4aa4efd373b
1225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier/* 2225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * Copyright (c) 2004, 2005 Topspin Communications. All rights reserved. 3225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * Copyright (c) 2005 Sun Microsystems, Inc. All rights reserved. 4225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * Copyright (c) 2005, 2006, 2007 Cisco Systems, Inc. All rights reserved. 551a379d0c8f7a6db7c9e3c9c770d90a6d2d1ef9bJack Morgenstein * Copyright (c) 2005, 2006, 2007, 2008 Mellanox Technologies. All rights reserved. 6225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * Copyright (c) 2004 Voltaire, Inc. All rights reserved. 7225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * 8225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * This software is available to you under a choice of one of two 9225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * licenses. You may choose to be licensed under the terms of the GNU 10225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * General Public License (GPL) Version 2, available from the file 11225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * COPYING in the main directory of this source tree, or the 12225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * OpenIB.org BSD license below: 13225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * 14225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * Redistribution and use in source and binary forms, with or 15225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * without modification, are permitted provided that the following 16225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * conditions are met: 17225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * 18225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * - Redistributions of source code must retain the above 19225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * copyright notice, this list of conditions and the following 20225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * disclaimer. 21225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * 22225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * - Redistributions in binary form must reproduce the above 23225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * copyright notice, this list of conditions and the following 24225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * disclaimer in the documentation and/or other materials 25225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * provided with the distribution. 26225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * 27225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 28225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 29225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 30225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS 31225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN 32225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN 33225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 34225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier * SOFTWARE. 35225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier */ 36225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 37225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#include <linux/hardirq.h> 38ee40fa0656a730491765545ff7550f3c1ceb0fbcPaul Gortmaker#include <linux/export.h> 395a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/gfp.h> 40225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 41225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#include <linux/mlx4/cmd.h> 423fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen#include <linux/mlx4/cq.h> 43225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 44225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#include "mlx4.h" 45225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#include "icm.h" 46225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 47225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreierstruct mlx4_cq_context { 48225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier __be32 flags; 49225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier u16 reserved1[3]; 50225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier __be16 page_offset; 51225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier __be32 logsize_usrpage; 523fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen __be16 cq_period; 533fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen __be16 cq_max_count; 543fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen u8 reserved2[3]; 55225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier u8 comp_eqn; 56225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier u8 log_page_size; 573fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen u8 reserved3[2]; 58225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier u8 mtt_base_addr_h; 59225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier __be32 mtt_base_addr_l; 60225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier __be32 last_notified_index; 61225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier __be32 solicit_producer_index; 62225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier __be32 consumer_index; 63225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier __be32 producer_index; 643fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen u32 reserved4[2]; 65225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier __be64 db_rec_addr; 66225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier}; 67225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 68225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#define MLX4_CQ_STATUS_OK ( 0 << 28) 69225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#define MLX4_CQ_STATUS_OVERFLOW ( 9 << 28) 70225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#define MLX4_CQ_STATUS_WRITE_FAIL (10 << 28) 71225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#define MLX4_CQ_FLAG_CC ( 1 << 18) 72225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#define MLX4_CQ_FLAG_OI ( 1 << 17) 73225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#define MLX4_CQ_STATE_ARMED ( 9 << 8) 74225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#define MLX4_CQ_STATE_ARMED_SOL ( 6 << 8) 75225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#define MLX4_EQ_STATE_FIRED (10 << 8) 76225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 77225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreiervoid mlx4_cq_completion(struct mlx4_dev *dev, u32 cqn) 78225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 79225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cq *cq; 80225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 81225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq = radix_tree_lookup(&mlx4_priv(dev)->cq_table.tree, 82225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cqn & (dev->caps.num_cqs - 1)); 83225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (!cq) { 84225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mlx4_warn(dev, "Completion event for bogus CQ %08x\n", cqn); 85225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier return; 86225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier } 87225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 88225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier ++cq->arm_sn; 89225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 90225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq->comp(cq); 91225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 92225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 93225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreiervoid mlx4_cq_event(struct mlx4_dev *dev, u32 cqn, int event_type) 94225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 95225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cq_table *cq_table = &mlx4_priv(dev)->cq_table; 96225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cq *cq; 97225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 98225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_lock(&cq_table->lock); 99225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 100225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq = radix_tree_lookup(&cq_table->tree, cqn & (dev->caps.num_cqs - 1)); 101225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (cq) 102225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier atomic_inc(&cq->refcount); 103225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 104225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_unlock(&cq_table->lock); 105225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 106225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (!cq) { 107225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mlx4_warn(dev, "Async event for bogus CQ %08x\n", cqn); 108225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier return; 109225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier } 110225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 111225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq->event(cq, event_type); 112225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 113225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (atomic_dec_and_test(&cq->refcount)) 114225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier complete(&cq->free); 115225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 116225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 117225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreierstatic int mlx4_SW2HW_CQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox, 118225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier int cq_num) 119225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 120225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier return mlx4_cmd(dev, mailbox->dma, cq_num, 0, MLX4_CMD_SW2HW_CQ, 121f9baff509f8a05a79626defdbdf4f4aa4efd373bJack Morgenstein MLX4_CMD_TIME_CLASS_A, MLX4_CMD_WRAPPED); 122225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 123225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 1243fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohenstatic int mlx4_MODIFY_CQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox, 1253fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen int cq_num, u32 opmod) 1263fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen{ 1273fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen return mlx4_cmd(dev, mailbox->dma, cq_num, opmod, MLX4_CMD_MODIFY_CQ, 128f9baff509f8a05a79626defdbdf4f4aa4efd373bJack Morgenstein MLX4_CMD_TIME_CLASS_A, MLX4_CMD_WRAPPED); 1293fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen} 1303fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 131225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreierstatic int mlx4_HW2SW_CQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox, 132225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier int cq_num) 133225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 134225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier return mlx4_cmd_box(dev, 0, mailbox ? mailbox->dma : 0, cq_num, 135225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mailbox ? 0 : 1, MLX4_CMD_HW2SW_CQ, 136f9baff509f8a05a79626defdbdf4f4aa4efd373bJack Morgenstein MLX4_CMD_TIME_CLASS_A, MLX4_CMD_WRAPPED); 137225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 138225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 1393fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohenint mlx4_cq_modify(struct mlx4_dev *dev, struct mlx4_cq *cq, 1403fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen u16 count, u16 period) 1413fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen{ 1423fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen struct mlx4_cmd_mailbox *mailbox; 1433fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen struct mlx4_cq_context *cq_context; 1443fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen int err; 1453fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 1463fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen mailbox = mlx4_alloc_cmd_mailbox(dev); 1473fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen if (IS_ERR(mailbox)) 1483fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen return PTR_ERR(mailbox); 1493fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 1503fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen cq_context = mailbox->buf; 1513fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen memset(cq_context, 0, sizeof *cq_context); 1523fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 1533fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen cq_context->cq_max_count = cpu_to_be16(count); 1543fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen cq_context->cq_period = cpu_to_be16(period); 1553fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 1563fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen err = mlx4_MODIFY_CQ(dev, mailbox, cq->cqn, 1); 1573fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 1583fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen mlx4_free_cmd_mailbox(dev, mailbox); 1593fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen return err; 1603fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen} 1613fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli CohenEXPORT_SYMBOL_GPL(mlx4_cq_modify); 1623fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 163bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovskyint mlx4_cq_resize(struct mlx4_dev *dev, struct mlx4_cq *cq, 164bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky int entries, struct mlx4_mtt *mtt) 165bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky{ 166bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky struct mlx4_cmd_mailbox *mailbox; 167bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky struct mlx4_cq_context *cq_context; 168bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky u64 mtt_addr; 169bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky int err; 170bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky 171bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky mailbox = mlx4_alloc_cmd_mailbox(dev); 172bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky if (IS_ERR(mailbox)) 173bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky return PTR_ERR(mailbox); 174bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky 175bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky cq_context = mailbox->buf; 176bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky memset(cq_context, 0, sizeof *cq_context); 177bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky 178bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky cq_context->logsize_usrpage = cpu_to_be32(ilog2(entries) << 24); 179bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky cq_context->log_page_size = mtt->page_shift - 12; 180bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky mtt_addr = mlx4_mtt_addr(dev, mtt); 181bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky cq_context->mtt_base_addr_h = mtt_addr >> 32; 182bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky cq_context->mtt_base_addr_l = cpu_to_be32(mtt_addr & 0xffffffff); 183bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky 184f5b3a096b138940f283907debe9bde6c6f40ebf3Vladimir Sokolovsky err = mlx4_MODIFY_CQ(dev, mailbox, cq->cqn, 0); 185bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky 186bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky mlx4_free_cmd_mailbox(dev, mailbox); 187bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky return err; 188bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky} 189bbf8eed1a0f8949f7385146624f736f829992a70Vladimir SokolovskyEXPORT_SYMBOL_GPL(mlx4_cq_resize); 190bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky 191225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreierint mlx4_cq_alloc(struct mlx4_dev *dev, int nent, struct mlx4_mtt *mtt, 192e463c7b197dbe64b8a99b0612c65f286937e5bf1Yevgeny Petrilin struct mlx4_uar *uar, u64 db_rec, struct mlx4_cq *cq, 193b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin unsigned vector, int collapsed) 194225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 195225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_priv *priv = mlx4_priv(dev); 196225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cq_table *cq_table = &priv->cq_table; 197225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cmd_mailbox *mailbox; 198225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cq_context *cq_context; 199225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier u64 mtt_addr; 200225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier int err; 201225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 2020b7ca5a928e2271bbc225e9e1ac1f22e9fbee54fYevgeny Petrilin if (vector > dev->caps.num_comp_vectors + dev->caps.comp_pool) 203b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin return -EINVAL; 204b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin 205b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin cq->vector = vector; 206b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin 207225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq->cqn = mlx4_bitmap_alloc(&cq_table->bitmap); 208225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (cq->cqn == -1) 209225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier return -ENOMEM; 210225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 211225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier err = mlx4_table_get(dev, &cq_table->table, cq->cqn); 212225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (err) 213225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier goto err_out; 214225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 215225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier err = mlx4_table_get(dev, &cq_table->cmpt_table, cq->cqn); 216225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (err) 217225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier goto err_put; 218225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 219225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_lock_irq(&cq_table->lock); 220225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier err = radix_tree_insert(&cq_table->tree, cq->cqn, cq); 221225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_unlock_irq(&cq_table->lock); 222225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (err) 223225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier goto err_cmpt_put; 224225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 225225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mailbox = mlx4_alloc_cmd_mailbox(dev); 226225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (IS_ERR(mailbox)) { 227225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier err = PTR_ERR(mailbox); 228225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier goto err_radix; 229225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier } 230225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 231225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq_context = mailbox->buf; 232225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier memset(cq_context, 0, sizeof *cq_context); 233225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 234e463c7b197dbe64b8a99b0612c65f286937e5bf1Yevgeny Petrilin cq_context->flags = cpu_to_be32(!!collapsed << 18); 235225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq_context->logsize_usrpage = cpu_to_be32((ilog2(nent) << 24) | uar->index); 236b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin cq_context->comp_eqn = priv->eq_table.eq[vector].eqn; 237225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq_context->log_page_size = mtt->page_shift - MLX4_ICM_PAGE_SHIFT; 238225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 239225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mtt_addr = mlx4_mtt_addr(dev, mtt); 240225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq_context->mtt_base_addr_h = mtt_addr >> 32; 241225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq_context->mtt_base_addr_l = cpu_to_be32(mtt_addr & 0xffffffff); 242225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq_context->db_rec_addr = cpu_to_be64(db_rec); 243225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 244225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier err = mlx4_SW2HW_CQ(dev, mailbox, cq->cqn); 245225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mlx4_free_cmd_mailbox(dev, mailbox); 246225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (err) 247225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier goto err_radix; 248225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 249225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq->cons_index = 0; 250225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq->arm_sn = 1; 251225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq->uar = uar; 252225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier atomic_set(&cq->refcount, 1); 253225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier init_completion(&cq->free); 254225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 255225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier return 0; 256225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 257225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreiererr_radix: 258225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_lock_irq(&cq_table->lock); 259225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier radix_tree_delete(&cq_table->tree, cq->cqn); 260225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_unlock_irq(&cq_table->lock); 261225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 262225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreiererr_cmpt_put: 263225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mlx4_table_put(dev, &cq_table->cmpt_table, cq->cqn); 264225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 265225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreiererr_put: 266225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mlx4_table_put(dev, &cq_table->table, cq->cqn); 267225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 268225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreiererr_out: 269225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mlx4_bitmap_free(&cq_table->bitmap, cq->cqn); 270225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 271225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier return err; 272225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 273225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland DreierEXPORT_SYMBOL_GPL(mlx4_cq_alloc); 274225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 275225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreiervoid mlx4_cq_free(struct mlx4_dev *dev, struct mlx4_cq *cq) 276225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 277225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_priv *priv = mlx4_priv(dev); 278225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cq_table *cq_table = &priv->cq_table; 279225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier int err; 280225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 281225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier err = mlx4_HW2SW_CQ(dev, NULL, cq->cqn); 282225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (err) 283225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mlx4_warn(dev, "HW2SW_CQ failed (%d) for CQN %06x\n", err, cq->cqn); 284225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 285b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin synchronize_irq(priv->eq_table.eq[cq->vector].irq); 286225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 287225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_lock_irq(&cq_table->lock); 288225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier radix_tree_delete(&cq_table->tree, cq->cqn); 289225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_unlock_irq(&cq_table->lock); 290225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 291225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (atomic_dec_and_test(&cq->refcount)) 292225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier complete(&cq->free); 293225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier wait_for_completion(&cq->free); 294225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 295225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mlx4_table_put(dev, &cq_table->table, cq->cqn); 296225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mlx4_bitmap_free(&cq_table->bitmap, cq->cqn); 297225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 298225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland DreierEXPORT_SYMBOL_GPL(mlx4_cq_free); 299225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 3003d73c2884f45f9a297cbc956cea101405a9703f2Roland Dreierint mlx4_init_cq_table(struct mlx4_dev *dev) 301225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 302225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cq_table *cq_table = &mlx4_priv(dev)->cq_table; 303225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier int err; 304225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 305225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_lock_init(&cq_table->lock); 306225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier INIT_RADIX_TREE(&cq_table->tree, GFP_ATOMIC); 307225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 308225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier err = mlx4_bitmap_init(&cq_table->bitmap, dev->caps.num_cqs, 30993fc9e1bb6507dde945c2eab68c93e1066ac3691Yevgeny Petrilin dev->caps.num_cqs - 1, dev->caps.reserved_cqs, 0); 310225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (err) 311225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier return err; 312225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 313225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier return 0; 314225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 315225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 316225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreiervoid mlx4_cleanup_cq_table(struct mlx4_dev *dev) 317225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 318225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier /* Nothing to do to clean up radix_tree */ 319225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mlx4_bitmap_cleanup(&mlx4_priv(dev)->cq_table.bitmap); 320225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 321