cq.c revision d7233386b21775a8b099d7d5dcc36d1e4642b896
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 37d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein#include <linux/init.h> 38225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#include <linux/hardirq.h> 39ee40fa0656a730491765545ff7550f3c1ceb0fbcPaul Gortmaker#include <linux/export.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) { 84d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein mlx4_dbg(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{ 120d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return mlx4_cmd(dev, mailbox->dma | dev->caps.function, cq_num, 0, 121d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein MLX4_CMD_SW2HW_CQ, MLX4_CMD_TIME_CLASS_A, 122d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein MLX4_CMD_WRAPPED); 123225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 124225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 1253fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohenstatic int mlx4_MODIFY_CQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox, 1263fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen int cq_num, u32 opmod) 1273fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen{ 1283fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen return mlx4_cmd(dev, mailbox->dma, cq_num, opmod, MLX4_CMD_MODIFY_CQ, 129f9baff509f8a05a79626defdbdf4f4aa4efd373bJack Morgenstein MLX4_CMD_TIME_CLASS_A, MLX4_CMD_WRAPPED); 1303fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen} 1313fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 132225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreierstatic int mlx4_HW2SW_CQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox, 133225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier int cq_num) 134225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 135d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return mlx4_cmd_box(dev, dev->caps.function, mailbox ? mailbox->dma : 0, 136d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein cq_num, mailbox ? 0 : 1, MLX4_CMD_HW2SW_CQ, 137f9baff509f8a05a79626defdbdf4f4aa4efd373bJack Morgenstein MLX4_CMD_TIME_CLASS_A, MLX4_CMD_WRAPPED); 138225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 139225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 1403fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohenint mlx4_cq_modify(struct mlx4_dev *dev, struct mlx4_cq *cq, 1413fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen u16 count, u16 period) 1423fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen{ 1433fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen struct mlx4_cmd_mailbox *mailbox; 1443fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen struct mlx4_cq_context *cq_context; 1453fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen int err; 1463fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 1473fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen mailbox = mlx4_alloc_cmd_mailbox(dev); 1483fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen if (IS_ERR(mailbox)) 1493fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen return PTR_ERR(mailbox); 1503fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 1513fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen cq_context = mailbox->buf; 1523fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen memset(cq_context, 0, sizeof *cq_context); 1533fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 1543fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen cq_context->cq_max_count = cpu_to_be16(count); 1553fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen cq_context->cq_period = cpu_to_be16(period); 1563fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 1573fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen err = mlx4_MODIFY_CQ(dev, mailbox, cq->cqn, 1); 1583fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 1593fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen mlx4_free_cmd_mailbox(dev, mailbox); 1603fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen return err; 1613fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen} 1623fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli CohenEXPORT_SYMBOL_GPL(mlx4_cq_modify); 1633fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 164bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovskyint mlx4_cq_resize(struct mlx4_dev *dev, struct mlx4_cq *cq, 165bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky int entries, struct mlx4_mtt *mtt) 166bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky{ 167bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky struct mlx4_cmd_mailbox *mailbox; 168bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky struct mlx4_cq_context *cq_context; 169bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky u64 mtt_addr; 170bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky int err; 171bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky 172bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky mailbox = mlx4_alloc_cmd_mailbox(dev); 173bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky if (IS_ERR(mailbox)) 174bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky return PTR_ERR(mailbox); 175bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky 176bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky cq_context = mailbox->buf; 177bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky memset(cq_context, 0, sizeof *cq_context); 178bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky 179bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky cq_context->logsize_usrpage = cpu_to_be32(ilog2(entries) << 24); 180bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky cq_context->log_page_size = mtt->page_shift - 12; 181bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky mtt_addr = mlx4_mtt_addr(dev, mtt); 182bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky cq_context->mtt_base_addr_h = mtt_addr >> 32; 183bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky cq_context->mtt_base_addr_l = cpu_to_be32(mtt_addr & 0xffffffff); 184bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky 185f5b3a096b138940f283907debe9bde6c6f40ebf3Vladimir Sokolovsky err = mlx4_MODIFY_CQ(dev, mailbox, cq->cqn, 0); 186bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky 187bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky mlx4_free_cmd_mailbox(dev, mailbox); 188bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky return err; 189bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky} 190bbf8eed1a0f8949f7385146624f736f829992a70Vladimir SokolovskyEXPORT_SYMBOL_GPL(mlx4_cq_resize); 191bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky 192d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgensteinstatic int __mlx4_cq_alloc_icm(struct mlx4_dev *dev, int *cqn) 193d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein{ 194d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein struct mlx4_priv *priv = mlx4_priv(dev); 195d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein struct mlx4_cq_table *cq_table = &priv->cq_table; 196d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein int err; 197d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 198d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein *cqn = mlx4_bitmap_alloc(&cq_table->bitmap); 199d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein if (*cqn == -1) 200d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return -ENOMEM; 201d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 202d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein err = mlx4_table_get(dev, &cq_table->table, *cqn); 203d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein if (err) 204d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein goto err_out; 205d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 206d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein err = mlx4_table_get(dev, &cq_table->cmpt_table, *cqn); 207d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein if (err) 208d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein goto err_put; 209d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return 0; 210d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 211d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgensteinerr_put: 212d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein mlx4_table_put(dev, &cq_table->table, *cqn); 213d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 214d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgensteinerr_out: 215d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein mlx4_bitmap_free(&cq_table->bitmap, *cqn); 216d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return err; 217d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein} 218d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 219d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgensteinstatic int mlx4_cq_alloc_icm(struct mlx4_dev *dev, int *cqn) 220d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein{ 221d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein u64 out_param; 222d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein int err; 223d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 224d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein if (mlx4_is_mfunc(dev)) { 225d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein err = mlx4_cmd_imm(dev, 0, &out_param, RES_CQ, 226d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein RES_OP_RESERVE_AND_MAP, MLX4_CMD_ALLOC_RES, 227d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein MLX4_CMD_TIME_CLASS_A, MLX4_CMD_WRAPPED); 228d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein if (err) 229d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return err; 230d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein else { 231d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein *cqn = get_param_l(&out_param); 232d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return 0; 233d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein } 234d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein } 235d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return __mlx4_cq_alloc_icm(dev, cqn); 236d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein} 237d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 238d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgensteinstatic void __mlx4_cq_free_icm(struct mlx4_dev *dev, int cqn) 239d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein{ 240d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein struct mlx4_priv *priv = mlx4_priv(dev); 241d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein struct mlx4_cq_table *cq_table = &priv->cq_table; 242d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 243d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein mlx4_table_put(dev, &cq_table->cmpt_table, cqn); 244d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein mlx4_table_put(dev, &cq_table->table, cqn); 245d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein mlx4_bitmap_free(&cq_table->bitmap, cqn); 246d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein} 247d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 248d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgensteinstatic void mlx4_cq_free_icm(struct mlx4_dev *dev, int cqn) 249d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein{ 250d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein u64 in_param; 251d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein int err; 252d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 253d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein if (mlx4_is_mfunc(dev)) { 254d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein set_param_l(&in_param, cqn); 255d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein err = mlx4_cmd(dev, in_param, RES_CQ, RES_OP_RESERVE_AND_MAP, 256d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein MLX4_CMD_FREE_RES, 257d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein MLX4_CMD_TIME_CLASS_A, MLX4_CMD_WRAPPED); 258d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein if (err) 259d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein mlx4_warn(dev, "Failed freeing cq:%d\n", cqn); 260d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein } else 261d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein __mlx4_cq_free_icm(dev, cqn); 262d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein} 263d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 264225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreierint mlx4_cq_alloc(struct mlx4_dev *dev, int nent, struct mlx4_mtt *mtt, 265e463c7b197dbe64b8a99b0612c65f286937e5bf1Yevgeny Petrilin struct mlx4_uar *uar, u64 db_rec, struct mlx4_cq *cq, 266b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin unsigned vector, int collapsed) 267225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 268225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_priv *priv = mlx4_priv(dev); 269225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cq_table *cq_table = &priv->cq_table; 270225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cmd_mailbox *mailbox; 271225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cq_context *cq_context; 272225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier u64 mtt_addr; 273225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier int err; 274225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 2750b7ca5a928e2271bbc225e9e1ac1f22e9fbee54fYevgeny Petrilin if (vector > dev->caps.num_comp_vectors + dev->caps.comp_pool) 276b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin return -EINVAL; 277b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin 278b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin cq->vector = vector; 279b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin 280d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein err = mlx4_cq_alloc_icm(dev, &cq->cqn); 281225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (err) 282d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return err; 283225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 284225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_lock_irq(&cq_table->lock); 285225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier err = radix_tree_insert(&cq_table->tree, cq->cqn, cq); 286225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_unlock_irq(&cq_table->lock); 287225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (err) 288d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein goto err_icm; 289225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 290225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mailbox = mlx4_alloc_cmd_mailbox(dev); 291225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (IS_ERR(mailbox)) { 292225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier err = PTR_ERR(mailbox); 293225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier goto err_radix; 294225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier } 295225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 296225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq_context = mailbox->buf; 297225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier memset(cq_context, 0, sizeof *cq_context); 298225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 299e463c7b197dbe64b8a99b0612c65f286937e5bf1Yevgeny Petrilin cq_context->flags = cpu_to_be32(!!collapsed << 18); 300225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq_context->logsize_usrpage = cpu_to_be32((ilog2(nent) << 24) | uar->index); 301b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin cq_context->comp_eqn = priv->eq_table.eq[vector].eqn; 302225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq_context->log_page_size = mtt->page_shift - MLX4_ICM_PAGE_SHIFT; 303225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 304225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mtt_addr = mlx4_mtt_addr(dev, mtt); 305225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq_context->mtt_base_addr_h = mtt_addr >> 32; 306225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq_context->mtt_base_addr_l = cpu_to_be32(mtt_addr & 0xffffffff); 307225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq_context->db_rec_addr = cpu_to_be64(db_rec); 308225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 309225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier err = mlx4_SW2HW_CQ(dev, mailbox, cq->cqn); 310225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mlx4_free_cmd_mailbox(dev, mailbox); 311225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (err) 312225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier goto err_radix; 313225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 314225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq->cons_index = 0; 315225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq->arm_sn = 1; 316225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq->uar = uar; 317225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier atomic_set(&cq->refcount, 1); 318225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier init_completion(&cq->free); 319225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 320225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier return 0; 321225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 322225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreiererr_radix: 323225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_lock_irq(&cq_table->lock); 324225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier radix_tree_delete(&cq_table->tree, cq->cqn); 325225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_unlock_irq(&cq_table->lock); 326225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 327d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgensteinerr_icm: 328d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein mlx4_cq_free_icm(dev, cq->cqn); 329225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 330225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier return err; 331225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 332225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland DreierEXPORT_SYMBOL_GPL(mlx4_cq_alloc); 333225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 334225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreiervoid mlx4_cq_free(struct mlx4_dev *dev, struct mlx4_cq *cq) 335225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 336225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_priv *priv = mlx4_priv(dev); 337225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cq_table *cq_table = &priv->cq_table; 338225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier int err; 339225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 340225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier err = mlx4_HW2SW_CQ(dev, NULL, cq->cqn); 341225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (err) 342225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mlx4_warn(dev, "HW2SW_CQ failed (%d) for CQN %06x\n", err, cq->cqn); 343225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 344b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin synchronize_irq(priv->eq_table.eq[cq->vector].irq); 345225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 346225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_lock_irq(&cq_table->lock); 347225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier radix_tree_delete(&cq_table->tree, cq->cqn); 348225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_unlock_irq(&cq_table->lock); 349225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 350225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (atomic_dec_and_test(&cq->refcount)) 351225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier complete(&cq->free); 352225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier wait_for_completion(&cq->free); 353225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 354d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein mlx4_cq_free_icm(dev, cq->cqn); 355225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 356225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland DreierEXPORT_SYMBOL_GPL(mlx4_cq_free); 357225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 3583d73c2884f45f9a297cbc956cea101405a9703f2Roland Dreierint mlx4_init_cq_table(struct mlx4_dev *dev) 359225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 360225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cq_table *cq_table = &mlx4_priv(dev)->cq_table; 361225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier int err; 362225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 363225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_lock_init(&cq_table->lock); 364225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier INIT_RADIX_TREE(&cq_table->tree, GFP_ATOMIC); 365d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein if (mlx4_is_slave(dev)) 366d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return 0; 367225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 368225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier err = mlx4_bitmap_init(&cq_table->bitmap, dev->caps.num_cqs, 36993fc9e1bb6507dde945c2eab68c93e1066ac3691Yevgeny Petrilin dev->caps.num_cqs - 1, dev->caps.reserved_cqs, 0); 370225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (err) 371225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier return err; 372225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 373225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier return 0; 374225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 375225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 376225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreiervoid mlx4_cleanup_cq_table(struct mlx4_dev *dev) 377225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 378d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein if (mlx4_is_slave(dev)) 379d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return; 380225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier /* Nothing to do to clean up radix_tree */ 381225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mlx4_bitmap_cleanup(&mlx4_priv(dev)->cq_table.bitmap); 382225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 383