From patchwork Wed Aug 3 23:27:37 2016 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Adit Ranadive X-Patchwork-Id: 9262339 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork.web.codeaurora.org (Postfix) with ESMTP id 006B16048F for ; Wed, 3 Aug 2016 23:32:28 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id E59D727FA1 for ; Wed, 3 Aug 2016 23:32:27 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id D9D712807E; Wed, 3 Aug 2016 23:32:27 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-6.8 required=2.0 tests=BAYES_00,DKIM_SIGNED, RCVD_IN_DNSWL_HI,T_DKIM_INVALID autolearn=ham version=3.3.1 Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 1DB4327FA1 for ; Wed, 3 Aug 2016 23:32:25 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S932518AbcHCXcX (ORCPT ); Wed, 3 Aug 2016 19:32:23 -0400 Received: from ex13-edg-ou-001.vmware.com ([208.91.0.189]:3386 "EHLO EX13-EDG-OU-001.vmware.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S932416AbcHCXcU (ORCPT ); Wed, 3 Aug 2016 19:32:20 -0400 Received: from sc9-mailhost3.vmware.com (10.113.161.73) by EX13-EDG-OU-001.vmware.com (10.113.208.155) with Microsoft SMTP Server id 15.0.1156.6; Wed, 3 Aug 2016 16:27:36 -0700 Received: from EX13-CAS-006.vmware.com (ex13-cas-006.vmware.com [10.113.191.56]) by sc9-mailhost3.vmware.com (Postfix) with ESMTP id 93AD440498; Wed, 3 Aug 2016 16:28:26 -0700 (PDT) Received: from EX13-CAS-002.vmware.com (10.113.191.52) by EX13-MBX-026.vmware.com (10.113.191.46) with Microsoft SMTP Server (TLS) id 15.0.1156.6; Wed, 3 Aug 2016 16:28:26 -0700 Received: from NAM03-DM3-obe.outbound.protection.outlook.com (10.113.170.11) by EX13-CAS-002.vmware.com (10.113.191.52) with Microsoft SMTP Server (TLS) id 15.0.1156.6 via Frontend Transport; Wed, 3 Aug 2016 16:28:26 -0700 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=onevmw.onmicrosoft.com; s=selector1-vmware-com; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version; bh=Klw8cuCBtSeDk4DNLiixRY61M0D/g4GH6c5n+sfcqvs=; b=buK0xnGfnELl6HFJCuqYToZbePWtsBQP8YYS7wlOMY4dDwDUPMztv2iPRSw1EHxtak3C9jwwl1vgAe8TJABm33L/KCVC+6oBDjL234UCmPQmtwv4513mSS/9YOz5rHR8+cyLBICmC3q03lyfASTCfKxXhE8dc7K5Brlqz2ZbjQM= Authentication-Results: spf=none (sender IP is ) smtp.mailfrom=aditr@vmware.com; Received: from promb-2s-dhcp95-136.eng.vmware.com (208.91.1.34) by SN2PR0501MB847.namprd05.prod.outlook.com (10.160.14.145) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_CBC_SHA384_P384) id 15.1.549.15; Wed, 3 Aug 2016 23:28:19 +0000 From: Adit Ranadive To: , , CC: Adit Ranadive , , , , Subject: [PATCH v3 08/15] IB/pvrdma: Add support for Completion Queues Date: Wed, 3 Aug 2016 16:27:37 -0700 Message-ID: <1470266864-16888-9-git-send-email-aditr@vmware.com> X-Mailer: git-send-email 2.7.4 In-Reply-To: <1470266864-16888-1-git-send-email-aditr@vmware.com> References: <1470266864-16888-1-git-send-email-aditr@vmware.com> MIME-Version: 1.0 X-Originating-IP: [208.91.1.34] X-ClientProxiedBy: CY1PR12CA0084.namprd12.prod.outlook.com (10.163.230.52) To SN2PR0501MB847.namprd05.prod.outlook.com (10.160.14.145) X-MS-Office365-Filtering-Correlation-Id: a6b4ddab-09d3-4666-2cc3-08d3bbf5db36 X-Microsoft-Exchange-Diagnostics: 1; SN2PR0501MB847; 2:T1YfJItcgrY7lcotV1xJM8JshJmYa4DG1P5r6sdyitmKSZhx9sOYS1v/AZeeGWSVvgCkYY6BCnC0pE1j1sYRiSs3Q6rIIgrWPPBeyzkv0jxecQNKBQVb8ixa/znDLkyBZeAJFJgYrWKNU1lUTKu+9IqXNVPoYwhACSh+cBXcVxy35cqDkEKXCjGvD8XTEsSh; 3:243/KwgXPaj5fgGwRD0lE7+EDWLzVxQx035ZT6K5qjJZIgP9H1faPHCnUrfsi1r2qKLCllzATwO0xl80eSEyo8G6yoKiKG08xwcQALz5SOUVmn0g/lZCbwWvREeftCyQ X-Microsoft-Antispam: UriScan:;BCL:0;PCL:0;RULEID:;SRVR:SN2PR0501MB847; X-Microsoft-Exchange-Diagnostics: 1; SN2PR0501MB847; 25:kM4OkfY8nkgfQCxjlML4HTGzPKXzukoqmp3xvOqKruyVAcXp8O40C1G+LkxLvLSYY8pbAWwpWroO9TCmiWRTVu9zgpebYmgN3KQa6nowjWNi4t3swgEs4Hoz1VPByrdaFKQOxQ50eB77uQQbt9OiRc+dt7RwqUBEdUhtnHFVSN75+hKssHQ7zCoR57yahQS6YvA/k1pzZvHC7SjicL4wJigdylGWHqOCsxmq3Vk84/FZ7V6BVtwGpfWflOcSKE9k89UVzCBf/KW/5R6n1qDz1lwmUDazZArp8lcvD6lYjFPk5LxGKegESqn82IZYCUSi6VgCrLFmwBWG/ukKFVbd8r6W4uW90m/6TD5ahJmN0cp0RkDIMGLx1w1kzE+Q9SDqM1rYEG72WEA2NvhQyFI8EsW6degodjR492Qt9kA6W5eox2K0bVjOIZIJO4SazUqV1IEkIn8dxWzzscTYPb632Y7umJ8On/rXUqhGPoxLhyiEVbhcmm0M8leboUZvNbJIZlyc+lxes7xpP2o4veyhrbAWrCKgMSqbjiBUfkPlB92zKux1l4KmEi5hQsl0H1XfIxvkDb4tCCZLAGVON6glBiKS0pNzkZYkfQsWwS9xJavwgzWplKA++XZuXirSGnRCitU3neKbQPjWwq2AqWLs6yceVfQ/iltOuxCFXrCLQmfjEvO7myApLHlyLxZBMXxhGqppC98qXpM5HLFWXlR4ojZtqf61CtDHoyF7MqW2PPrcJkkKno/aFsChU5MNdwtrx8k4pYz5xTAWelwgauUVhbwJstxT7rrJVR4YO4EKO4oMt4gNTDs3m6ifSOh9agfP X-Microsoft-Exchange-Diagnostics: 1; SN2PR0501MB847; 31:Tw1RM4PlpTOdocvVrJSUtBn2lMjZf4lm7+/l4wZTd6PQnLFobLQbGreBUo7wSECEqq4VlK5JpSDjlug9yRNZrwleJm6ARw1ZF70rGOCXRzCM4eagGyxtZKltkAXNBtXVAr+7LptAZcZu4Y2otBKaVxlnPofyM7Hl76oNt0tAry3WLLtPmkoWyRgoZAfxIUW6qPFyb1bi9o8cgQyymqS0QCeDNUGKHJYerW2kZkp+XaU=; 20:ggcx9VXPWzfrIQuQvb7R3z2oJSJ3JNpH6DH6pn1Wmj2BcPQyeulFUZgKVtQH+d93mhDqPFopRFDJkjZxPcZBpi7ZicDhGDkNBgOsESRJaJtBoORP+ympKZtnw+H2G7n7Riy7vRHEWPsLQ5kMJzTvc1VEHUhSRimkPZFabW1mt05yfte+TuGm7lIguS3yrF1RGAq2y58fhHmER/rGl7dAdv0KxkpyZDwMX7ZzFwITzsu4OvYe5EKvZzENH4ffDDnI X-Microsoft-Antispam-PRVS: X-Exchange-Antispam-Report-Test: UriScan:(250305191791016)(61668805478150)(22074186197030); X-Exchange-Antispam-Report-CFA-Test: BCL:0; PCL:0; RULEID:(601004)(2401047)(8121501046)(5005006)(10201501046)(3002001); SRVR:SN2PR0501MB847; BCL:0; PCL:0; RULEID:; SRVR:SN2PR0501MB847; X-Microsoft-Exchange-Diagnostics: 1; SN2PR0501MB847; 4:UkvYRN0dBFk3yGPA/4ATxYzbniOpOIAWhOBkHS/SxSOK9dhtV35md2IroCQxpkn+g17l/OIqZrm+Ye6Uji4lxt35ECuE/1Yxq98yPYwhoH85XrecyOogjNPWzdRMH7yuECtKLjg5PVzIO5q55BGZVAC67YXgh1dedlSbds6Biio88kkUfSqI82ZLe1jAYDnjyp863CugDbVaAYZN74oClRL6pccfpxMWn8/9Kz31wigpkcVIljvJrQ2ZgpNXq12TFAboLkbTxmIDlP/3oTFYmnMry1LX4TrcGohjnieg10hgUvwB4ZY2X6Kj8KAP/0EhBKa+B7UMX6GXKrXZN85jnhrnFZBZFNuaBaggqyET+kQTO0Q4wFv+OAmRCfnz6T4CVUqpanWRhgoKv3tJqBsKwQAabiX3BnuWQJnUzYThpgaN0kWV/bXkrabiA0bUhDrz30U0sOYilCsV71ANjC0mvBGtpPrXYf5GB5nOSrZ4iJE= X-Forefront-PRVS: 00235A1EEF X-Forefront-Antispam-Report: SFV:NSPM; SFS:(10009020)(4630300001)(6009001)(7916002)(199003)(189002)(4001450100002)(66066001)(106356001)(189998001)(33646002)(92566002)(107886002)(5001770100001)(77096005)(15975445007)(229853001)(48376002)(50466002)(101416001)(97736004)(2950100001)(42186005)(586003)(47776003)(68736007)(76176999)(50986999)(4001430100002)(2906002)(105586002)(7846002)(7736002)(305945005)(81156014)(50226002)(86362001)(81166006)(8676002)(6116002)(36756003)(3846002)(5003940100001)(19580405001)(19580395003)(2201001)(4326007)(7099028)(2004002); DIR:OUT; SFP:1101; SCL:1; SRVR:SN2PR0501MB847; H:promb-2s-dhcp95-136.eng.vmware.com; FPR:; SPF:None; PTR:InfoNoRecords; A:1; MX:1; LANG:en; Received-SPF: None (EX13-EDG-OU-001.vmware.com: aditr@vmware.com does not designate permitted sender hosts) Received-SPF: None (protection.outlook.com: vmware.com does not designate permitted sender hosts) X-Microsoft-Exchange-Diagnostics: =?us-ascii?Q?1; SN2PR0501MB847; 23:gOnH6QyIy1LSEmYNiFbQvkf+Ao8qd5Xzf3Qt0BUB?= =?us-ascii?Q?7cIAVtrELdtHu55BxalBfIF3LAysXTfKMuXYLW3nm1k1+7hRGSQn2kecmoLW?= =?us-ascii?Q?a8Bwjtz2v21rlAvoGmgvbtb3Ko6PNm5aoqp/E4TviIx+oSfkgs660g4HRkfr?= =?us-ascii?Q?TA7iwzbcv/AgLRwdrEpSJKHZlYh6/bsocNlJ6G/VSFKdGV64yy+1oRoMYlDd?= =?us-ascii?Q?k/7An+VZqOGVWYLMcvfrBgi+CAXcyfXmdT3frGsZkPIZoHoxERBWFt6GmFVz?= =?us-ascii?Q?zyXlp29r2aavLlHzlkzeUP3i8TmRjGORnVMOzJVDand1aMrydO0miY7uV2k5?= =?us-ascii?Q?2mQRNT3pufvxsWcPYsP/CSuKiuBObG+Kb39A+E2vx3tthP3nwVP3bWFzSTy8?= =?us-ascii?Q?skJtay90n6bI1ljFcZZ3p4V2oRQGuBnXRGAcMoY5OFNnWLGFPeA2wBtExjND?= =?us-ascii?Q?rksKLxDxZtbkmbMHjr/1PoOiw5xj31/fSJI8uBuWMzFB+yGSIb+xwBJgHsVK?= =?us-ascii?Q?V7qYVWiihCSBvUNFvC5bTm2ElbzOyXb1KGyLhnEvYuEopJRzUCO0a0uZzCdz?= =?us-ascii?Q?ogH+KekPSamb8OMZAH+/HEjR0iqQ7pWbgE3+Z5ZeUcP5AljMHt6e7+btdzXs?= =?us-ascii?Q?FYqM2EYHcnId0P7/BIM4vznnsRHV1jkOrO3h2jiekCSTN7ibZdLlTySgMPpo?= =?us-ascii?Q?bQKFFjRUVUi6Ok92qU6RVRWVr4WMNuQSLEYqssI6zNpMMR6GRGKrhncLiUcB?= =?us-ascii?Q?RabFMMAlN0AbY8mPN4SriebqmqM9WTbKpQHZtJkaL3jwhIYe9KIf/XMpPm33?= =?us-ascii?Q?iaPC1G9EUf+ebdTaD3/8RuJ2ruIHdWYo4uPWq6yh6YydJPXaaOk1xDTgFf90?= =?us-ascii?Q?uk7szhvVOjKkvusFXspBMG71Mb78Cwbl2ZOzLVIWoQpfvjU0SllFHp6rI6gA?= =?us-ascii?Q?m7EAUr8mjjlGi7epwkBwYVvUoy8qG80mjij0hpVBK2/Z7Ogo44SAhtIfEMHK?= =?us-ascii?Q?G91Y3lCSX8WQW6/oPTJUlHXWjFQPtGrHFdior97N/s+uP0xwmrstELJb/e9n?= =?us-ascii?Q?e2iUk2lIDVCfUrfzE6oTcS+G775q0k/BZbH79TEDWf9w+5JLuXQVqfK2UJuZ?= =?us-ascii?Q?JFOX04fRKVPNUpdwaDAMO0mCMwph9AZDa91A3UMTpH22EwqZd0+MzZCvJFyj?= =?us-ascii?Q?j/6Me3MQPFzZc5P+NIkLzj8CV6KMQtiJZ5impZNvZlBwW1rT5ojJeefCGQ?= =?us-ascii?Q?=3D=3D?= X-Microsoft-Exchange-Diagnostics: 1; SN2PR0501MB847; 6:H6pQPUuXfEQwom35ppkfDE4skPDth59BRiuCya2c9vqAy5hazjiWJ3d/St9RL0fjskPpO73NN2Lv96aocA1grCqeUKmkuZXQ6KowUySK0WlFjkPHVB3leb/X/PGajKJjYojYyiK+gx/kN0oPw+xQ2cKLwchBUxnVrOvXz/7w25WA86BfahXf8C+My8S1cxPNKRu627Eg7mb8uzCj8PiUP47iZr84ydE0LGJg162rDoh+ZcC3jk0AN8j+c4MVr/Kidvn5mv7293mmu+iqBSkVyZeudU2BNQFBvlZK16ew7LU=; 5:nj5N6921tejDBLYZCObkYScN07KqaVF29iiT1ZxAqKxOn/D2HAqnyyUn+UeBZ/LTmJvFOVXIqlzuTx/kwB1uhZ46kLJlBjuUdll6fmvos1i/+cIYje4klAWjVLcnMX/LgVGNlbDzV1dhHLGeHohr/g==; 24:AvhD3HwupIyOBwsWdMVFDZNOWzgq70rCHPZ1i6DCQDvIgzbpPcxYjWj3NyX5L/4UTMQWGHuQeEgs9ddQzSlL2Mt7OlWpeC0ScnGHxY77U8Y=; 7:smS26luKNAxDEJcEw2W425lptcP+7Cz9gwlbdsS2XGfcsLG92YVnwwcqRaYTNOYs0Hsyq6zoth+45u+64NF+3Ks/FVPD/XOFD7Cpl1Jxoi6CjD4a/6xjvlipkJEH9xb3BTJnAnMmvAWaD4NBmoMBoAL46MLPvtcKRZ4T8mU5o02X4kDbF8uDSc8KTwdo07JWAxeYKDczjhc1nYTBATfMdkdto5QGGtraLoMVPcRcBQ32CcgcwT4i3ZrRq0EeC3wb SpamDiagnosticOutput: 1:99 SpamDiagnosticMetadata: NSPM X-Microsoft-Exchange-Diagnostics: 1; SN2PR0501MB847; 20:Q6Ro3ZpY+t7D+1cfDS07nFc9BqB2pddeJr3BL7U8sQCdTJl1zI6xlu0mxocpeJOUSoOVlY52ACe2ZVwk/u3CFWnMXOWBE8xEysx2BY+JGdtVLEQunu55irAyXqgEOKrhuuSmKQxqR7nm8jQtiEdeSEf34HHGkgIEdWWmRWsfs8I= X-MS-Exchange-CrossTenant-OriginalArrivalTime: 03 Aug 2016 23:28:19.7732 (UTC) X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted X-MS-Exchange-Transport-CrossTenantHeadersStamped: SN2PR0501MB847 Sender: linux-rdma-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-rdma@vger.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP This patch adds the support for creating and destroying completion queues on the paravirtual RDMA device. Changes v2->v3: - Removed boolean from pvrdma_cmd_post. - Return -EAGAIN if qp retrieved from CQE is bogus. - Check for invalid index of ring. Reviewed-by: Jorgen Hansen Reviewed-by: George Zhang Reviewed-by: Aditya Sarwade Reviewed-by: Bryan Tan Signed-off-by: Adit Ranadive --- drivers/infiniband/hw/pvrdma/pvrdma_cq.c | 437 +++++++++++++++++++++++++++++++ 1 file changed, 437 insertions(+) create mode 100644 drivers/infiniband/hw/pvrdma/pvrdma_cq.c diff --git a/drivers/infiniband/hw/pvrdma/pvrdma_cq.c b/drivers/infiniband/hw/pvrdma/pvrdma_cq.c new file mode 100644 index 0000000..f7f92fe --- /dev/null +++ b/drivers/infiniband/hw/pvrdma/pvrdma_cq.c @@ -0,0 +1,437 @@ +/* + * Copyright (c) 2012-2016 VMware, Inc. All rights reserved. + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of EITHER the GNU General Public License + * version 2 as published by the Free Software Foundation or the BSD + * 2-Clause License. This program is distributed in the hope that it + * will be useful, but WITHOUT ANY WARRANTY; WITHOUT EVEN THE IMPLIED + * WARRANTY OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. + * See the GNU General Public License version 2 for more details at + * http://www.gnu.org/licenses/old-licenses/gpl-2.0.en.html. + * + * You should have received a copy of the GNU General Public License + * along with this program available in the file COPYING in the main + * directory of this source tree. + * + * The BSD 2-Clause License + * + * Redistribution and use in source and binary forms, with or + * without modification, are permitted provided that the following + * conditions are met: + * + * - Redistributions of source code must retain the above + * copyright notice, this list of conditions and the following + * disclaimer. + * + * - Redistributions in binary form must reproduce the above + * copyright notice, this list of conditions and the following + * disclaimer in the documentation and/or other materials + * provided with the distribution. + * + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS + * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT + * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS + * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE + * COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, + * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES + * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR + * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, + * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) + * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED + * OF THE POSSIBILITY OF SUCH DAMAGE. + */ + +#include +#include +#include +#include +#include +#include + +#include "pvrdma.h" +#include "pvrdma_user.h" + +/** + * pvrdma_req_notify_cq - request notification for a completion queue + * @ibcq: the completion queue + * @notify_flags: notification flags + * + * @return: 0 for success. + */ +int pvrdma_req_notify_cq(struct ib_cq *ibcq, + enum ib_cq_notify_flags notify_flags) +{ + struct pvrdma_dev *dev = to_vdev(ibcq->device); + struct pvrdma_cq *cq = to_vcq(ibcq); + u32 val = cq->cq_handle; + + val |= (notify_flags & IB_CQ_SOLICITED_MASK) == IB_CQ_SOLICITED ? + PVRDMA_UAR_CQ_ARM_SOL : PVRDMA_UAR_CQ_ARM; + + writel(cpu_to_le32(val), dev->driver_uar.map + PVRDMA_UAR_CQ_OFFSET); + + return 0; +} + +/** + * pvrdma_create_cq - create completion queue + * @ibdev: the device + * @attr: completion queue attributes + * @context: user context + * @udata: user data + * + * @return: ib_cq completion queue pointer on success, + * otherwise returns negative errno. + */ +struct ib_cq *pvrdma_create_cq(struct ib_device *ibdev, + const struct ib_cq_init_attr *attr, + struct ib_ucontext *context, + struct ib_udata *udata) +{ + int entries = attr->cqe; + struct pvrdma_dev *dev = to_vdev(ibdev); + struct pvrdma_cq *cq; + int ret; + int npages; + unsigned long flags; + union pvrdma_cmd_req req; + union pvrdma_cmd_resp rsp; + struct pvrdma_cmd_create_cq *cmd = &req.create_cq; + struct pvrdma_cmd_create_cq_resp *resp = &rsp.create_cq_resp; + struct pvrdma_create_cq ucmd; + + BUILD_BUG_ON(sizeof(struct pvrdma_cqe) != 64); + + entries = roundup_pow_of_two(entries); + if (entries < 1 || entries > dev->dsr->caps.max_cqe) + return ERR_PTR(-EINVAL); + + if (!atomic_add_unless(&dev->num_cqs, 1, dev->dsr->caps.max_cq)) + return ERR_PTR(-EINVAL); + + cq = kzalloc(sizeof(*cq), GFP_KERNEL); + if (!cq) { + atomic_dec(&dev->num_cqs); + return ERR_PTR(-ENOMEM); + } + + cq->ibcq.cqe = entries; + + if (context) { + if (ib_copy_from_udata(&ucmd, udata, sizeof(ucmd))) { + ret = -EFAULT; + goto err_cq; + } + + cq->umem = ib_umem_get(context, ucmd.buf_addr, ucmd.buf_size, + IB_ACCESS_LOCAL_WRITE, 1); + if (IS_ERR(cq->umem)) { + ret = PTR_ERR(cq->umem); + goto err_cq; + } + + npages = ib_umem_page_count(cq->umem); + } else { + cq->is_kernel = true; + + /* One extra page for shared ring state */ + npages = 1 + (entries * sizeof(struct pvrdma_cqe) + + PAGE_SIZE - 1) / PAGE_SIZE; + + /* Skip header page. */ + cq->offset = PAGE_SIZE; + } + + if (npages < 0 || npages > PVRDMA_PAGE_DIR_MAX_PAGES) { + dev_warn(&dev->pdev->dev, + "overflow pages in completion queue\n"); + ret = -EINVAL; + goto err_umem; + } + + ret = pvrdma_page_dir_init(dev, &cq->pdir, npages, cq->is_kernel); + if (ret) { + dev_warn(&dev->pdev->dev, + "could not allocate page directory\n"); + goto err_umem; + } + + if (cq->is_kernel) { + /* Ring state is always the first page. */ + cq->ring_state = cq->pdir.pages[0]; + } else { + pvrdma_page_dir_insert_umem(&cq->pdir, cq->umem, 0); + } + + atomic_set(&cq->refcnt, 1); + init_waitqueue_head(&cq->wait); + spin_lock_init(&cq->cq_lock); + + memset(cmd, 0, sizeof(*cmd)); + cmd->hdr.cmd = PVRDMA_CMD_CREATE_CQ; + cmd->nchunks = npages; + cmd->ctx_handle = (context) ? + (u64)to_vucontext(context)->ctx_handle : 0; + cmd->cqe = entries; + cmd->pdir_dma = cq->pdir.dir_dma; + ret = pvrdma_cmd_post(dev, &req, &rsp); + + if (ret < 0 || rsp.hdr.ack != PVRDMA_CMD_CREATE_CQ_RESP) { + dev_warn(&dev->pdev->dev, + "could not create completion queue\n"); + goto err_page_dir; + } + + cq->ibcq.cqe = resp->cqe; + cq->cq_handle = resp->cq_handle; + spin_lock_irqsave(&dev->cq_tbl_lock, flags); + dev->cq_tbl[cq->cq_handle % dev->dsr->caps.max_cq] = cq; + spin_unlock_irqrestore(&dev->cq_tbl_lock, flags); + + if (context) { + cq->uar = &(to_vucontext(context)->uar); + + /* Copy udata back. */ + if (ib_copy_to_udata(udata, &cq->cq_handle, sizeof(__u32))) { + dev_warn(&dev->pdev->dev, + "failed to copy back udata\n"); + ret = -EINVAL; + goto err_page_dir; + } + } + + return &cq->ibcq; + +err_page_dir: + pvrdma_page_dir_cleanup(dev, &cq->pdir); +err_umem: + if (context) + ib_umem_release(cq->umem); +err_cq: + atomic_dec(&dev->num_cqs); + kfree(cq); + + return ERR_PTR(ret); +} + +static void pvrdma_free_cq(struct pvrdma_dev *dev, struct pvrdma_cq *cq) +{ + atomic_dec(&cq->refcnt); + wait_event(cq->wait, !atomic_read(&cq->refcnt)); + + if (!cq->is_kernel) + ib_umem_release(cq->umem); + + pvrdma_page_dir_cleanup(dev, &cq->pdir); + kfree(cq); +} + +/** + * pvrdma_destroy_cq - destroy completion queue + * @cq: the completion queue to destroy. + * + * @return: 0 for success. + */ +int pvrdma_destroy_cq(struct ib_cq *cq) +{ + struct pvrdma_cq *vcq = to_vcq(cq); + union pvrdma_cmd_req req; + struct pvrdma_cmd_destroy_cq *cmd = &req.destroy_cq; + struct pvrdma_dev *dev = to_vdev(cq->device); + unsigned long flags; + int ret; + + memset(cmd, 0, sizeof(*cmd)); + cmd->hdr.cmd = PVRDMA_CMD_DESTROY_CQ; + cmd->cq_handle = vcq->cq_handle; + + ret = pvrdma_cmd_post(dev, &req, NULL); + if (ret < 0) + dev_warn(&dev->pdev->dev, + "could not destroy completion queue\n"); + + /* free cq's resources */ + spin_lock_irqsave(&dev->cq_tbl_lock, flags); + dev->cq_tbl[vcq->cq_handle] = NULL; + spin_unlock_irqrestore(&dev->cq_tbl_lock, flags); + + pvrdma_free_cq(dev, vcq); + atomic_dec(&dev->num_cqs); + + return ret; +} + +/** + * pvrdma_modify_cq - modify the CQ moderation parameters + * @ibcq: the CQ to modify + * @cq_count: number of CQEs that will trigger an event + * @cq_period: max period of time in usec before triggering an event + * + * @return: -EOPNOTSUPP as CQ resize is not supported. + */ +int pvrdma_modify_cq(struct ib_cq *cq, u16 cq_count, u16 cq_period) +{ + return -EOPNOTSUPP; +} + +static inline struct pvrdma_cqe *get_cqe(struct pvrdma_cq *cq, int i) +{ + return (struct pvrdma_cqe *)pvrdma_page_dir_get_ptr( + &cq->pdir, + cq->offset + + sizeof(struct pvrdma_cqe) * i); +} + +void pvrdma_flush_cqe(struct pvrdma_qp *qp, struct pvrdma_cq *cq) +{ + int head; + int has_data; + + if (!cq->is_kernel) + return; + + /* Lock held */ + has_data = pvrdma_idx_ring_has_data(&cq->ring_state->rx, + cq->ibcq.cqe, &head); + if (unlikely(has_data > 0)) { + int items; + int curr; + int tail = pvrdma_idx(&cq->ring_state->rx.prod_tail, + cq->ibcq.cqe); + struct pvrdma_cqe *cqe; + struct pvrdma_cqe *curr_cqe; + + items = (tail > head) ? (tail - head) : + (cq->ibcq.cqe - head + tail); + curr = --tail; + while (items-- > 0) { + if (curr < 0) + curr = cq->ibcq.cqe - 1; + if (tail < 0) + tail = cq->ibcq.cqe - 1; + curr_cqe = get_cqe(cq, curr); + if ((curr_cqe->qp & 0xFFFF) != qp->qp_handle) { + if (curr != tail) { + cqe = get_cqe(cq, tail); + *cqe = *curr_cqe; + } + tail--; + } else { + pvrdma_idx_ring_inc( + &cq->ring_state->rx.cons_head, + cq->ibcq.cqe); + } + curr--; + } + } +} + +static int pvrdma_poll_one(struct pvrdma_cq *cq, struct pvrdma_qp **cur_qp, + struct ib_wc *wc) +{ + struct pvrdma_dev *dev = to_vdev(cq->ibcq.device); + int has_data; + unsigned int head; + bool tried = false; + struct pvrdma_cqe *cqe; + +retry: + has_data = pvrdma_idx_ring_has_data(&cq->ring_state->rx, + cq->ibcq.cqe, &head); + if (has_data == 0) { + u32 val; + + if (tried) + return -EAGAIN; + + /* Pass down POLL to give physical HCA a chance to poll. */ + val = cq->cq_handle | PVRDMA_UAR_CQ_POLL; + writel(cpu_to_le32(val), + dev->driver_uar.map + PVRDMA_UAR_CQ_OFFSET); + + tried = true; + goto retry; + } else if (has_data == PVRDMA_INVALID_IDX) { + /* Ring state could be corrupted. Treat as unrecoverable. */ + return -EINVAL; + } + + cqe = get_cqe(cq, head); + + /* Ensure cqe is valid. */ + rmb(); + if (dev->qp_tbl[cqe->qp & 0xffff]) + *cur_qp = (struct pvrdma_qp *)dev->qp_tbl[cqe->qp & 0xffff]; + else + return -EAGAIN; + + wc->opcode = pvrdma_wc_opcode_to_ib(cqe->opcode); + wc->status = pvrdma_wc_status_to_ib(cqe->status); + wc->wr_id = cqe->wr_id; + wc->qp = &(*cur_qp)->ibqp; + wc->byte_len = cqe->byte_len; + wc->ex.imm_data = cqe->imm_data; + wc->src_qp = cqe->src_qp; + wc->wc_flags = pvrdma_wc_flags_to_ib(cqe->wc_flags); + wc->pkey_index = cqe->pkey_index; + wc->slid = cqe->slid; + wc->sl = cqe->sl; + wc->dlid_path_bits = cqe->dlid_path_bits; + wc->port_num = cqe->port_num; + wc->vendor_err = 0; + + /* Update shared ring state */ + pvrdma_idx_ring_inc(&cq->ring_state->rx.cons_head, cq->ibcq.cqe); + + return 0; +} + +/** + * pvrdma_poll_cq - poll for work completion queue entries + * @ibcq: completion queue + * @num_entries: the maximum number of entries + * @entry: pointer to work completion array + * + * @return: number of polled completion entries + */ +int pvrdma_poll_cq(struct ib_cq *ibcq, int num_entries, struct ib_wc *wc) +{ + struct pvrdma_cq *cq = to_vcq(ibcq); + struct pvrdma_qp *cur_qp = NULL; + unsigned long flags; + int npolled; + int ret; + + if (num_entries < 1) + return -EINVAL; + + spin_lock_irqsave(&cq->cq_lock, flags); + for (npolled = 0; npolled < num_entries; ++npolled) { + ret = pvrdma_poll_one(cq, &cur_qp, wc + npolled); + if (ret) + break; + } + + spin_unlock_irqrestore(&cq->cq_lock, flags); + + if ((ret == 0) || (ret == -EAGAIN)) + return npolled; + else + return ret; +} + +/** + * pvrdma_resize_cq - resize CQ + * @ibcq: the completion queue + * @entries: CQ entries + * @udata: user data + * + * @return: -EOPNOTSUPP as CQ resize is not supported. + */ +int pvrdma_resize_cq(struct ib_cq *ibcq, int entries, struct ib_udata *udata) +{ + return -EOPNOTSUPP; +} +