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 Dreier#define MLX4_CQ_STATUS_OK ( 0 << 28) 48225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#define MLX4_CQ_STATUS_OVERFLOW ( 9 << 28) 49225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#define MLX4_CQ_STATUS_WRITE_FAIL (10 << 28) 50225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#define MLX4_CQ_FLAG_CC ( 1 << 18) 51225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#define MLX4_CQ_FLAG_OI ( 1 << 17) 52225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#define MLX4_CQ_STATE_ARMED ( 9 << 8) 53225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#define MLX4_CQ_STATE_ARMED_SOL ( 6 << 8) 54225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier#define MLX4_EQ_STATE_FIRED (10 << 8) 55225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 56225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreiervoid mlx4_cq_completion(struct mlx4_dev *dev, u32 cqn) 57225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 58225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cq *cq; 59225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 60225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq = radix_tree_lookup(&mlx4_priv(dev)->cq_table.tree, 61225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cqn & (dev->caps.num_cqs - 1)); 62225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (!cq) { 63d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein mlx4_dbg(dev, "Completion event for bogus CQ %08x\n", cqn); 64225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier return; 65225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier } 66225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 67225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier ++cq->arm_sn; 68225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 69225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq->comp(cq); 70225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 71225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 72225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreiervoid mlx4_cq_event(struct mlx4_dev *dev, u32 cqn, int event_type) 73225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 74225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cq_table *cq_table = &mlx4_priv(dev)->cq_table; 75225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cq *cq; 76225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 77225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_lock(&cq_table->lock); 78225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 79225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq = radix_tree_lookup(&cq_table->tree, cqn & (dev->caps.num_cqs - 1)); 80225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (cq) 81225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier atomic_inc(&cq->refcount); 82225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 83225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_unlock(&cq_table->lock); 84225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 85225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (!cq) { 86225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mlx4_warn(dev, "Async event for bogus CQ %08x\n", cqn); 87225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier return; 88225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier } 89225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 90225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq->event(cq, event_type); 91225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 92225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (atomic_dec_and_test(&cq->refcount)) 93225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier complete(&cq->free); 94225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 95225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 96225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreierstatic int mlx4_SW2HW_CQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox, 97225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier int cq_num) 98225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 99eb41049f2f5eee1525fe1c699e6b1f03c8c51532Marcel Apfelbaum return mlx4_cmd(dev, mailbox->dma, cq_num, 0, 100d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein MLX4_CMD_SW2HW_CQ, MLX4_CMD_TIME_CLASS_A, 101d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein MLX4_CMD_WRAPPED); 102225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 103225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 1043fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohenstatic int mlx4_MODIFY_CQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox, 1053fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen int cq_num, u32 opmod) 1063fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen{ 1073fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen return mlx4_cmd(dev, mailbox->dma, cq_num, opmod, MLX4_CMD_MODIFY_CQ, 108f9baff509f8a05a79626defdbdf4f4aa4efd373bJack Morgenstein MLX4_CMD_TIME_CLASS_A, MLX4_CMD_WRAPPED); 1093fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen} 1103fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 111225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreierstatic int mlx4_HW2SW_CQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox, 112225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier int cq_num) 113225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 114eb41049f2f5eee1525fe1c699e6b1f03c8c51532Marcel Apfelbaum return mlx4_cmd_box(dev, 0, mailbox ? mailbox->dma : 0, 115d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein cq_num, mailbox ? 0 : 1, MLX4_CMD_HW2SW_CQ, 116f9baff509f8a05a79626defdbdf4f4aa4efd373bJack Morgenstein MLX4_CMD_TIME_CLASS_A, MLX4_CMD_WRAPPED); 117225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 118225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 1193fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohenint mlx4_cq_modify(struct mlx4_dev *dev, struct mlx4_cq *cq, 1203fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen u16 count, u16 period) 1213fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen{ 1223fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen struct mlx4_cmd_mailbox *mailbox; 1233fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen struct mlx4_cq_context *cq_context; 1243fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen int err; 1253fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 1263fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen mailbox = mlx4_alloc_cmd_mailbox(dev); 1273fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen if (IS_ERR(mailbox)) 1283fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen return PTR_ERR(mailbox); 1293fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 1303fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen cq_context = mailbox->buf; 1313fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen memset(cq_context, 0, sizeof *cq_context); 1323fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 1333fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen cq_context->cq_max_count = cpu_to_be16(count); 1343fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen cq_context->cq_period = cpu_to_be16(period); 1353fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 1363fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen err = mlx4_MODIFY_CQ(dev, mailbox, cq->cqn, 1); 1373fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 1383fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen mlx4_free_cmd_mailbox(dev, mailbox); 1393fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen return err; 1403fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen} 1413fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli CohenEXPORT_SYMBOL_GPL(mlx4_cq_modify); 1423fdcb97f0b8d8a29117dc36acd0b15965d2a2160Eli Cohen 143bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovskyint mlx4_cq_resize(struct mlx4_dev *dev, struct mlx4_cq *cq, 144bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky int entries, struct mlx4_mtt *mtt) 145bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky{ 146bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky struct mlx4_cmd_mailbox *mailbox; 147bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky struct mlx4_cq_context *cq_context; 148bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky u64 mtt_addr; 149bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky int err; 150bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky 151bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky mailbox = mlx4_alloc_cmd_mailbox(dev); 152bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky if (IS_ERR(mailbox)) 153bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky return PTR_ERR(mailbox); 154bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky 155bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky cq_context = mailbox->buf; 156bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky memset(cq_context, 0, sizeof *cq_context); 157bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky 158bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky cq_context->logsize_usrpage = cpu_to_be32(ilog2(entries) << 24); 159bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky cq_context->log_page_size = mtt->page_shift - 12; 160bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky mtt_addr = mlx4_mtt_addr(dev, mtt); 161bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky cq_context->mtt_base_addr_h = mtt_addr >> 32; 162bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky cq_context->mtt_base_addr_l = cpu_to_be32(mtt_addr & 0xffffffff); 163bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky 164f5b3a096b138940f283907debe9bde6c6f40ebf3Vladimir Sokolovsky err = mlx4_MODIFY_CQ(dev, mailbox, cq->cqn, 0); 165bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky 166bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky mlx4_free_cmd_mailbox(dev, mailbox); 167bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky return err; 168bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky} 169bbf8eed1a0f8949f7385146624f736f829992a70Vladimir SokolovskyEXPORT_SYMBOL_GPL(mlx4_cq_resize); 170bbf8eed1a0f8949f7385146624f736f829992a70Vladimir Sokolovsky 171c82e9aa0a8bcf7a1643ccb71678bab57f3cb4bc6Eli Cohenint __mlx4_cq_alloc_icm(struct mlx4_dev *dev, int *cqn) 172d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein{ 173d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein struct mlx4_priv *priv = mlx4_priv(dev); 174d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein struct mlx4_cq_table *cq_table = &priv->cq_table; 175d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein int err; 176d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 177d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein *cqn = mlx4_bitmap_alloc(&cq_table->bitmap); 178d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein if (*cqn == -1) 179d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return -ENOMEM; 180d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 181d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein err = mlx4_table_get(dev, &cq_table->table, *cqn); 182d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein if (err) 183d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein goto err_out; 184d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 185d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein err = mlx4_table_get(dev, &cq_table->cmpt_table, *cqn); 186d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein if (err) 187d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein goto err_put; 188d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return 0; 189d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 190d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgensteinerr_put: 191d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein mlx4_table_put(dev, &cq_table->table, *cqn); 192d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 193d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgensteinerr_out: 194d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein mlx4_bitmap_free(&cq_table->bitmap, *cqn); 195d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return err; 196d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein} 197d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 198d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgensteinstatic int mlx4_cq_alloc_icm(struct mlx4_dev *dev, int *cqn) 199d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein{ 200d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein u64 out_param; 201d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein int err; 202d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 203d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein if (mlx4_is_mfunc(dev)) { 204d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein err = mlx4_cmd_imm(dev, 0, &out_param, RES_CQ, 205d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein RES_OP_RESERVE_AND_MAP, MLX4_CMD_ALLOC_RES, 206d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein MLX4_CMD_TIME_CLASS_A, MLX4_CMD_WRAPPED); 207d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein if (err) 208d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return err; 209d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein else { 210d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein *cqn = get_param_l(&out_param); 211d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return 0; 212d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein } 213d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein } 214d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return __mlx4_cq_alloc_icm(dev, cqn); 215d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein} 216d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 217c82e9aa0a8bcf7a1643ccb71678bab57f3cb4bc6Eli Cohenvoid __mlx4_cq_free_icm(struct mlx4_dev *dev, int cqn) 218d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein{ 219d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein struct mlx4_priv *priv = mlx4_priv(dev); 220d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein struct mlx4_cq_table *cq_table = &priv->cq_table; 221d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 222d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein mlx4_table_put(dev, &cq_table->cmpt_table, cqn); 223d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein mlx4_table_put(dev, &cq_table->table, cqn); 224d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein mlx4_bitmap_free(&cq_table->bitmap, cqn); 225d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein} 226d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 227d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgensteinstatic void mlx4_cq_free_icm(struct mlx4_dev *dev, int cqn) 228d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein{ 229d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein u64 in_param; 230d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein int err; 231d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 232d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein if (mlx4_is_mfunc(dev)) { 233d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein set_param_l(&in_param, cqn); 234d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein err = mlx4_cmd(dev, in_param, RES_CQ, RES_OP_RESERVE_AND_MAP, 235d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein MLX4_CMD_FREE_RES, 236d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein MLX4_CMD_TIME_CLASS_A, MLX4_CMD_WRAPPED); 237d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein if (err) 238d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein mlx4_warn(dev, "Failed freeing cq:%d\n", cqn); 239d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein } else 240d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein __mlx4_cq_free_icm(dev, cqn); 241d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein} 242d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein 243225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreierint mlx4_cq_alloc(struct mlx4_dev *dev, int nent, struct mlx4_mtt *mtt, 244e463c7b197dbe64b8a99b0612c65f286937e5bf1Yevgeny Petrilin struct mlx4_uar *uar, u64 db_rec, struct mlx4_cq *cq, 245b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin unsigned vector, int collapsed) 246225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 247225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_priv *priv = mlx4_priv(dev); 248225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cq_table *cq_table = &priv->cq_table; 249225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cmd_mailbox *mailbox; 250225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cq_context *cq_context; 251225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier u64 mtt_addr; 252225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier int err; 253225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 2540b7ca5a928e2271bbc225e9e1ac1f22e9fbee54fYevgeny Petrilin if (vector > dev->caps.num_comp_vectors + dev->caps.comp_pool) 255b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin return -EINVAL; 256b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin 257b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin cq->vector = vector; 258b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin 259d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein err = mlx4_cq_alloc_icm(dev, &cq->cqn); 260225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (err) 261d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return err; 262225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 263225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_lock_irq(&cq_table->lock); 264225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier err = radix_tree_insert(&cq_table->tree, cq->cqn, cq); 265225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_unlock_irq(&cq_table->lock); 266225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (err) 267d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein goto err_icm; 268225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 269225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mailbox = mlx4_alloc_cmd_mailbox(dev); 270225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (IS_ERR(mailbox)) { 271225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier err = PTR_ERR(mailbox); 272225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier goto err_radix; 273225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier } 274225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 275225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq_context = mailbox->buf; 276225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier memset(cq_context, 0, sizeof *cq_context); 277225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 278e463c7b197dbe64b8a99b0612c65f286937e5bf1Yevgeny Petrilin cq_context->flags = cpu_to_be32(!!collapsed << 18); 279225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq_context->logsize_usrpage = cpu_to_be32((ilog2(nent) << 24) | uar->index); 280b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin cq_context->comp_eqn = priv->eq_table.eq[vector].eqn; 281225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq_context->log_page_size = mtt->page_shift - MLX4_ICM_PAGE_SHIFT; 282225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 283225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mtt_addr = mlx4_mtt_addr(dev, mtt); 284225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq_context->mtt_base_addr_h = mtt_addr >> 32; 285225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq_context->mtt_base_addr_l = cpu_to_be32(mtt_addr & 0xffffffff); 286225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq_context->db_rec_addr = cpu_to_be64(db_rec); 287225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 288225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier err = mlx4_SW2HW_CQ(dev, mailbox, cq->cqn); 289225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mlx4_free_cmd_mailbox(dev, mailbox); 290225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (err) 291225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier goto err_radix; 292225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 293225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq->cons_index = 0; 294225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq->arm_sn = 1; 295225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier cq->uar = uar; 296225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier atomic_set(&cq->refcount, 1); 297225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier init_completion(&cq->free); 298225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 299225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier return 0; 300225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 301225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreiererr_radix: 302225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_lock_irq(&cq_table->lock); 303225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier radix_tree_delete(&cq_table->tree, cq->cqn); 304225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_unlock_irq(&cq_table->lock); 305225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 306d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgensteinerr_icm: 307d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein mlx4_cq_free_icm(dev, cq->cqn); 308225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 309225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier return err; 310225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 311225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland DreierEXPORT_SYMBOL_GPL(mlx4_cq_alloc); 312225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 313225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreiervoid mlx4_cq_free(struct mlx4_dev *dev, struct mlx4_cq *cq) 314225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 315225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_priv *priv = mlx4_priv(dev); 316225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cq_table *cq_table = &priv->cq_table; 317225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier int err; 318225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 319225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier err = mlx4_HW2SW_CQ(dev, NULL, cq->cqn); 320225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (err) 321225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mlx4_warn(dev, "HW2SW_CQ failed (%d) for CQN %06x\n", err, cq->cqn); 322225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 323b8dd786f9417e5885929bfe33a235c76a9c1c569Yevgeny Petrilin synchronize_irq(priv->eq_table.eq[cq->vector].irq); 324225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 325225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_lock_irq(&cq_table->lock); 326225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier radix_tree_delete(&cq_table->tree, cq->cqn); 327225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_unlock_irq(&cq_table->lock); 328225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 329225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (atomic_dec_and_test(&cq->refcount)) 330225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier complete(&cq->free); 331225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier wait_for_completion(&cq->free); 332225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 333d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein mlx4_cq_free_icm(dev, cq->cqn); 334225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 335225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland DreierEXPORT_SYMBOL_GPL(mlx4_cq_free); 336225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 3373d73c2884f45f9a297cbc956cea101405a9703f2Roland Dreierint mlx4_init_cq_table(struct mlx4_dev *dev) 338225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 339225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier struct mlx4_cq_table *cq_table = &mlx4_priv(dev)->cq_table; 340225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier int err; 341225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 342225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier spin_lock_init(&cq_table->lock); 343225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier INIT_RADIX_TREE(&cq_table->tree, GFP_ATOMIC); 344d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein if (mlx4_is_slave(dev)) 345d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return 0; 346225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 347225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier err = mlx4_bitmap_init(&cq_table->bitmap, dev->caps.num_cqs, 34893fc9e1bb6507dde945c2eab68c93e1066ac3691Yevgeny Petrilin dev->caps.num_cqs - 1, dev->caps.reserved_cqs, 0); 349225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier if (err) 350225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier return err; 351225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 352225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier return 0; 353225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 354225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier 355225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreiervoid mlx4_cleanup_cq_table(struct mlx4_dev *dev) 356225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier{ 357d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein if (mlx4_is_slave(dev)) 358d7233386b21775a8b099d7d5dcc36d1e4642b896Jack Morgenstein return; 359225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier /* Nothing to do to clean up radix_tree */ 360225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier mlx4_bitmap_cleanup(&mlx4_priv(dev)->cq_table.bitmap); 361225c7b1feef1b41170f7037a5b10a65cd8a42c54Roland Dreier} 362