From patchwork Fri Apr 21 15:50:14 2017 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Gary R Hook X-Patchwork-Id: 9693117 X-Patchwork-Delegate: herbert@gondor.apana.org.au 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 EA9B3601D4 for ; Fri, 21 Apr 2017 15:51:54 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id DC54D28632 for ; Fri, 21 Apr 2017 15:51:54 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id D0DB328651; Fri, 21 Apr 2017 15:51:54 +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.9 required=2.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,RCVD_IN_DNSWL_HI 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 DD8CE28652 for ; Fri, 21 Apr 2017 15:51:52 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1161731AbdDUPvt (ORCPT ); Fri, 21 Apr 2017 11:51:49 -0400 Received: from mail-bn3nam01on0053.outbound.protection.outlook.com ([104.47.33.53]:14560 "EHLO NAM01-BN3-obe.outbound.protection.outlook.com" rhost-flags-OK-OK-OK-FAIL) by vger.kernel.org with ESMTP id S1161729AbdDUPvr (ORCPT ); Fri, 21 Apr 2017 11:51:47 -0400 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=amdcloud.onmicrosoft.com; s=selector1-amd-com; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version; bh=2sPV0sqPPm719uEZpkTh18c72lwBpA2SuTbosHxmz5E=; b=eaKN5cPL9cJUglDZuvDKOkzD6/0DZ+eS497lu6AwI2IBbh4SVq3gU0HOufSlLmO3fGUt5pe4FvqnrTGAZiRdUf1oerX7LXA/rBrPmujuuXv8y5Xyonq3UV4O3YYnA0vlgLjfqp543aCcSm64uOEadyPLRaiWzAI0X+/9dZVKXNM= Authentication-Results: amd.com; dkim=none (message not signed) header.d=none;amd.com; dmarc=none action=none header.from=amd.com; Received: from taos.amd.com (165.204.77.1) by DM5PR12MB1323.namprd12.prod.outlook.com (10.168.238.10) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_128_CBC_SHA256_P256) id 15.1.1047.13; Fri, 21 Apr 2017 15:50:19 +0000 Subject: [PATCH 2/2] crypto: ccp - Change ISR handler method for a v5 CCP From: Gary R Hook To: CC: , , Date: Fri, 21 Apr 2017 10:50:14 -0500 Message-ID: <20170421155014.11643.57345.stgit@taos.amd.com> In-Reply-To: <20170421151225.11643.91749.stgit@taos.amd.com> References: <20170421151225.11643.91749.stgit@taos.amd.com> User-Agent: StGit/0.17.1-dirty MIME-Version: 1.0 X-Originating-IP: [165.204.77.1] X-ClientProxiedBy: MWHPR21CA0057.namprd21.prod.outlook.com (10.172.93.147) To DM5PR12MB1323.namprd12.prod.outlook.com (10.168.238.10) X-MS-PublicTrafficType: Email X-MS-Office365-Filtering-Correlation-Id: 3d724d3f-9d62-4a50-7ee1-08d488ce1d89 X-MS-Office365-Filtering-HT: Tenant X-Microsoft-Antispam: UriScan:; BCL:0; PCL:0; RULEID:(22001)(48565401081)(201703131423075)(201703031133081); SRVR:DM5PR12MB1323; X-Microsoft-Exchange-Diagnostics: 1; DM5PR12MB1323; 3:pGLpGxkfrmlcYTnNpNkkV2X3fGIzS2YMroIJq4R7n7hr8Hva+fY/JB4bAJl0OUEOUR/YyyBeaRC1xVnfxsOQYy5TyfvkbaX6GItqx1WCgB5R7V4+3heRtVDh4YBwVrV66ZjpNRxYmAbeHZB/G54Q9MVtLCtWBq4mu9K2gSOv/rNwvU/pIPbRtchyh19Q7JAeufVZiiDn4/KIOrmm6OhOXtjDXI3nKroImfcFhxG2mmtneC8ZlTi9Z76HWuHEm/FKFtKgtpv/Wptg239lIdiBL9jieL0R5gEhAfDq6C77JqTvyJvL5BxK30iosE2C7j7ovBDA/um27mlcU9gMet/1NnFeJab2IgtOjsArnEuDwa4=; 25:IuaADw1AExhHUyZd6+MqIc0SF2lwj/l9UxnNv66f2wO5LOf5PxU9RYZ859DGjKyTa6ZIAf1lFkUsLZzpeTgF6a/D0Vcxo4WZ9V3IxOCryuaXSOJYBdSZOP02GIHfSC/RwXB6jyOeI/047kEsbsGzUrp3GCBuKaw7QbOJtK8j77aZF6ZJIWzyUqLNmCq0EhwQ9kqIvR7qRVLit6aXa1Z7JyUPbeioerzk1oL0Mt3vcvYpN1pWQUFaPu4wb9lzHvvspnxolwt5gnKqGh3JEWXjN/qM0c22mZXNv/3z63EgHpeamfT5uooqD59eBwmMLL8OpLPNFrkWZbGaRY7Acu1bMxD3z8A0JhVjyNU8fnancvWvI145EXTBPAG8pMpY560md2cbTF+30JoEizIrOYi26j9O6/kG6sbsOUqFyZTZ+J6fAWQUEucEY4inXDMew+XgXBkU1FHOGqc5ssGV43N2WQ== X-Microsoft-Exchange-Diagnostics: 1; DM5PR12MB1323; 31:kO+4PndENSlbfnsarRxthv/grBbkxBXmlWL+ak2HjxCoF2TE3YH2Q8OKsXN7ExvExbBGb8lrE86qQgwA/AeIdltdhEQyrOI2VSLo/l08CUqIV1mFQ2lh6ZmoG7eRZa5nMjY7o9r1BajhXk2zt8OHzplbabNGwZaxF8Fj+/02xEvjRXTxYiq8NDGv8DqMug+OPSlgt+RDP536Y4hXHxsQ1Gyji/GSdOMyu9MEYoZ7qQVJYCqt/P43TP4ZJS+fqBQ4; 20:5kibD14Z/BO3fcCWhuSE5RLeLsOHx9h66pqM8VKJ24T7vMhnjZ4uvfVhYzTz6no0Onwq4S7CbHKZtslEgBa4TCH/kcYTMl5S0nXApsQbZHEYWhJdAPuqmDHHVqUaH1B3yyPzWwjz5vqtl3KZqhR8nX79S0W6WuAgx6ukcdXMMxah7le4hMy/h6iTTI9XOjCUKAf0npyk6QC7I6M36kCm/RVn65QuP6AvHVJ7pyTP+00Wu7oTveKDfDQ5Q8nosbiZMF7M0lN+wqkCatTuRCgiKq6WMzUgUpOxNvKiwvgRNlD6H1L9vPtVxBtDAxRgOP7chedYEM15g1mJr/zpujCgm0BqN3/JqkV8/s/gM5p5NkP+1I6QwqF0LX3QQivEJPdun5tuanSHONt9trHCSgWoZ4b8w1BRUfEsImkM7QqX47kbZ06aPCO2ybzW2+Z32OI5HMgi4xhJwv35zTzxVMJZYfK/VkF/KYlIb3YlubT6e5dYKcf0Uik4jGnigrwTD8X+ X-Microsoft-Antispam-PRVS: X-Exchange-Antispam-Report-Test: UriScan:(9452136761055)(767451399110); X-Exchange-Antispam-Report-CFA-Test: BCL:0; PCL:0; RULEID:(6040450)(601004)(2401047)(8121501046)(5005006)(3002001)(10201501046)(93006095)(93001095)(6055026)(6041248)(20161123562025)(201703131423075)(201702281528075)(201703061421075)(20161123555025)(20161123560025)(20161123564025)(6072148); SRVR:DM5PR12MB1323; BCL:0; PCL:0; RULEID:; SRVR:DM5PR12MB1323; X-Microsoft-Exchange-Diagnostics: 1; DM5PR12MB1323; 4:e8TmpV1n8y/Oz4hhQshyJjTuVjWxBKZcTgRjv2RFklNHa4q5KyIBg0Qav4Q37ldDeg05Cc3ZcfpbuhkfmzBmyfUHNisXdR+2GwJCSwOarqZBVH9PPZN+tRDe6xeqOiakbdMdSyTMJYlS8qfmpT8RUqDzifKY1rrIauw1KBbLKFcc5VdM5K5ScDaAg801hP9zFdX5OF28aCM558FJ9XN0VSflAOiY9SdJgbWfIBfDv6DlKITQQdnTBZaOODy9o2B7SzCtNtSvUDFoNtu0bdECPx2ogY0lDc3u9K+xBmsQtNfOY+3L2RtFZatYPIhkmUFIFRKdlYR85dSOiEYmO50h9FCHVKyzjHErq1S3kbgcaqSEWLUog6K23OjODRcb07GFq8EacK/lK8CBBiQtwSI88b5HZwtkBkaaiWrsajd988FmAUiwkXKqbZ8+EC3YwSvpJXWxDdZCvfEQ1ZBXMdwxcLqb6cKZs6Nkh3UEMOyekmuy35ducPtd6EENl/W2XnJz3sH23M85wZF9ZuAToqxGfgSQqwem8NWbuMLXxJ76WVUKHzw6f1p5FkuRHWkXRvz/VMcJGsBw45bPFFCK9EX+tJdhCGUK1Aht/ExXcWk7DqVc2LO5/RBu9vf2lX6PseBHaNNG5jIAKiiWDjTVOWhCSNYT3nc5rWnxw5ykdEfyYjrfKAxdjby08Fi8qsh4oS6SH60JmkvVs4ZxF9K6q/iVeNPJXI75MsFrtPkRwt/vvRt7+rozbh612aB8FbWr1/6oWGw1O43LSVrAuss+qcgs7R1JqYOHRCjHXf1KkvXUE9AfgoJE8+JjoPF7ZQ1Ofd61 X-Forefront-PRVS: 02843AA9E0 X-Forefront-Antispam-Report: SFV:NSPM; SFS:(10009020)(4630300001)(6009001)(39860400002)(39840400002)(39410400002)(39450400003)(39400400002)(39850400002)(4326008)(1076002)(50986999)(76176999)(54356999)(97746001)(53416004)(33646002)(53936002)(189998001)(6116002)(2351001)(230700001)(2906002)(55016002)(54906002)(86362001)(3846002)(5660300001)(50466002)(42186005)(2950100002)(23676002)(6916009)(47776003)(305945005)(8676002)(66066001)(103116003)(38730400002)(83506001)(110136004)(7736002)(4001350100001)(81166006)(6666003)(25786009)(71626007); DIR:OUT; SFP:1101; SCL:1; SRVR:DM5PR12MB1323; H:taos.amd.com; FPR:; SPF:None; MLV:sfv; LANG:en; X-Microsoft-Exchange-Diagnostics: =?utf-8?B?MTtETTVQUjEyTUIxMzIzOzIzOktlY1pZTFdGR1RvSWw4MVpjTTNVLzVPaGJx?= =?utf-8?B?Z05CTkFMdTJ1UlJ6NlVoK3E2aGFrZXFaRTRhZm5BK3pHUHZ0VzAwOVMvTGFW?= =?utf-8?B?MGNvVHJSRENWSzAwdU5qTzE3bXhJc2ZQOTd1N0xmcFAwcGtnZ3BUZHJjQ0Yv?= =?utf-8?B?TUNTdEtnemkzNkhYc0ZwS3ExZTFtU2c1d09uYWpZd0Z1dDVqbEltL01GdmV0?= =?utf-8?B?WkRxMmpmSnNEMGpCaHFXY0pxL1hldXFsZE1EV0RxdW1JdFVEeWNyZW42Zkw3?= =?utf-8?B?SFJTUnRqUDh0ellLdW9YQTh5YkFyNzlkQlFFZGZnQUdPVXcvZ251ZGtya045?= =?utf-8?B?N2JsemFTWmZvTTVrMWYxSENEM0FqQzZwMlVEdlN1N1dmblNrWDl0RHRiOFRE?= =?utf-8?B?ZVJnZnFybVdiRkxEdEVwQzdHUkgwWmdneVNML3M1c25ZZGwvUXdmMmlVczUx?= =?utf-8?B?ZEpJQitCaDdOekxEc2NVR2RMZmhTNzNmZ01GTyt4TE16M3A5aXRmV3ZtN29J?= =?utf-8?B?QnJlUDJHcFV2MHk4aVV6V2UvelFLYWJmY2xPVzk0M3docDVXVGZCcFp2YlFz?= =?utf-8?B?cHMvbWNhS0Q4YUVhM0taSGMvNjM2RzRUS1RyM2J6U2UxVXczdUlYMlg0a29n?= =?utf-8?B?dVJhNzZOZ1NMYUhJd3B2M2FtaGpNT0gwZHUvMVpWUFlvNWdUSXBPMEhRd3gx?= =?utf-8?B?c21kVUQxdlBtV2NKaG4zUElCTEhTbXN0NkZvM0pzQzVMU1JVaWVoUjdNL25m?= =?utf-8?B?WG45WDN6eFcyRGxLa1Bjdk1uc295SmNXbTZrWjJFUWNENy85QjhLTlhOQ0Ry?= =?utf-8?B?MmFTUkphNUdHN3JGUFpsd2hxY2NaWnhrM2dock9kUWp4TmFwN1dLRzc5M0hW?= =?utf-8?B?RzV2Nm5IeUVCeUtQNDE0eGpxcjNJb0VxOWR2MTF4NXIvc1pyVmhHRmVTWmxG?= =?utf-8?B?SlVhcmRvSmhqQ0hmVEQyK2tSZkY5UjdpUjFzamlyWkNWUUxDdTl6dHVFT3pT?= =?utf-8?B?YWFlbzVJMjBBUGZvNW9Pb3JVaVFTY2NnSEtob1FYTTNxNDdFU0dXR2xKYjRB?= =?utf-8?B?Wm1HZE96Ykd6eG1WQVE0T2Uvcll5V2U0b2diNGNxY0JNeGJQcG4wTHczWnVI?= =?utf-8?B?dHVmd2JRbHRHbFdUNEkzb3llSjdIWm13RmNPMFRSeHNoNlVKSHFzdy9GQ3dn?= =?utf-8?B?bTNuZFByb3pXVWk0N3N3UnVMVGU3NHQyR1owWVRwWUFjUlhpMGFjcjN0UnpE?= =?utf-8?B?Q2ZoUUpNMlBkUkdKRU9lRE4yUWFDQnhMa0tVZlg0cjdtNUxJeFY2dzFkRWxi?= =?utf-8?B?NjNqZzI5RFBsMkRWWDJSaTA5RFZMN2VDRnhMaUl5cDJlcHhsYzZKc2lKNTVt?= =?utf-8?B?bXEyMy9WelZUbmJROVVUUmdIWGdTRlZMQ3REZUVpNjFrbkovTnpnZDV3M0hi?= =?utf-8?B?RExsdm1PN2RkOUlwd0NRYldUZ04xelZuSlRMZlZTSjE5VXFROE11dEtjbU14?= =?utf-8?B?R2JhQzYwUzNzZGQ4cDE4cWgxQ0JuSlFSUVFSTE5sVnowL3l2UUJXcGl3ZVps?= =?utf-8?B?T1JBdC94dFo5L09RQ0FHd0tlUXJBNHc9PQ==?= X-Microsoft-Exchange-Diagnostics: 1; DM5PR12MB1323; 6:9+VOZrzZ3xZRgE4Xp4CmuwJ8/wB2vBwoO6ZCc3Jr04DKJLOqnAchOQidPxbG5XKjHA4U03Od6i2oVhh0H/Nr21KMywc8pLUQjDHz/h6WkPMH1YsEXf5oCAYwPSkUuJ75tuG+ama1i/SXzvo4vh/HXyt6FnKWp3zGCTiIAnkRqj3gLL3jSIPI2vYI7ViWAqzhRkG8Ezkd+MHkO78FDEnNpO5nH1UG+AnCcbVIzy75tcWrLKQep/QTxqle0cJzLhNFeiwLVcFrssIDIXf2/z1pNviKqsM3mGsiiAkvFdiOA77yV7b8mUeeztpv8/EhMP+jaUrobzNufHANiGJF+WZJqWo2hq2CBzKOeNPS4tqJ1Sy/iB8W8zpq+X34OVeKLE+J0st8eQmzTof7p5OQJLSjk9fiLCVFCQXXdLU/FRYriTslVtdORYCKAJ4s5lQ3ZyBHj9AqPx32V1ghyEVwELHM/w/Hokvs6BQUx2o+oygAUgRtv2tbaoa3cHNtxIZ0L83QH0QVeyt3wqrQh7/+HMvkl0fmuuiNF55DVfgn0QXvQyM=; 5:XzNCEF3naVHnspH1vYEPHTKSev8eo+XWwck8mh8qIOZAq/vmZIXrerOKK5bc/L52nZFx7NUwEm3sbAf6l8TDXGggpMFurrSKPazUgHtvleoAr5oNRfLpQX/W8VzQgZ/k3Hw7mmeNyn7J8M3CGRqQsg==; 24:kPGMe3hNCskpAJz46R+ekNbn2S1HZWRHbHy8l60pWbNArH8vM8FV7/QTia2i2QltWMOOX+FSfFD7ZNRdQ4HVt5ZzS6AVhDnq8ZcPeU+shPI= SpamDiagnosticOutput: 1:99 SpamDiagnosticMetadata: NSPM X-Microsoft-Exchange-Diagnostics: 1; DM5PR12MB1323; 7:TbbHuT9ZsQV0J8mNaEkfmBkz2TVweeqFwgscuHd16pBCT7rL+J/Z+Fym0ir83wBy3KoR2q/P+8qOdCHkp+6/6Z7KXqlSxn6YqbIJxT4qOOD/EsNsmT2leytU9ji4bIRvCyL9z34/8bf0bGWccYF1b2R5w856rZpOee971uHRdkXkt2YIugb4qI/101tRJtAJjaNMBnm4K4K8h/5Rbq1af4/uk9z5LTkzxhM2QLs87yoh2XAhonKJn9twRwMlCgB+5yIIY9YyE2+HLf0rJ2NhAKO6nVlhgueMjIsDL0VkRq266eKNrdPosg+msmRQEg+vDfWO/0siSjcCUaa+P4yQOQ==; 20:Gjsm8HSbEB9muUi40QGzr79KZ7YP2G50MvY9VqYN7QljLCf3SwMyjsSYftb12/XdcNw4ACoDQoErHGjWIbMpwGab5o7bDaSF2OA6VQVLzdQ+NwlMRQrJ6P8FnwosRe0dagT71sNSAbKxEDc6utKwAJNlA6bn26C+WOj/r6r5eWxdlLDE7k+pJzOnOHSJRTsXlFmDHZj2hwwid4AoaJ6YHeRs7mErRh1nV1rbwr9E/lgVcPCwwyH3yY3JOEX8JhH/ X-OriginatorOrg: amd.com X-MS-Exchange-CrossTenant-OriginalArrivalTime: 21 Apr 2017 15:50:19.8416 (UTC) X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted X-MS-Exchange-Transport-CrossTenantHeadersStamped: DM5PR12MB1323 Sender: linux-crypto-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-crypto@vger.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP The CCP has the ability to perform several operations simultaneously, but only one interrupt. When implemented as a PCI device and using MSI-X/MSI interrupts, use a tasklet model to service interrupts. By disabling and enabling interrupts from the CCP, coupled with the queuing that tasklets provide, we can ensure that all events (occurring on the device) are recognized and serviced. This change fixes a problem wherein 2 or more busy queues can cause notification bits to change state while a (CCP) interrupt is being serviced, but after the queue state has been evaluated. This results in the event being 'lost' and the queue hanging, waiting to be serviced. Since the status bits are never fully de-asserted, the CCP never generates another interrupt (all bits zero -> one or more bits one), and no further CCP operations will be executed. Cc: # 4.9.x+ Signed-off-by: Gary R Hook --- drivers/crypto/ccp/ccp-dev-v5.c | 111 ++++++++++++++++++++++++--------------- 1 file changed, 67 insertions(+), 44 deletions(-) diff --git a/drivers/crypto/ccp/ccp-dev-v5.c b/drivers/crypto/ccp/ccp-dev-v5.c index 13b81a1c1184..ccbe32d5dd1c 100644 --- a/drivers/crypto/ccp/ccp-dev-v5.c +++ b/drivers/crypto/ccp/ccp-dev-v5.c @@ -705,6 +705,65 @@ static int ccp_assign_lsbs(struct ccp_device *ccp) return rc; } +static void ccp5_disable_queue_interrupts(struct ccp_device *ccp) +{ + unsigned int i; + + for (i = 0; i < ccp->cmd_q_count; i++) + iowrite32(0x0, ccp->cmd_q[i].reg_int_enable); +} + +static void ccp5_enable_queue_interrupts(struct ccp_device *ccp) +{ + unsigned int i; + + for (i = 0; i < ccp->cmd_q_count; i++) + iowrite32(SUPPORTED_INTERRUPTS, ccp->cmd_q[i].reg_int_enable); +} + +static void ccp5_irq_bh(unsigned long data) +{ + struct ccp_device *ccp = (struct ccp_device *)data; + u32 status; + unsigned int i; + + for (i = 0; i < ccp->cmd_q_count; i++) { + struct ccp_cmd_queue *cmd_q = &ccp->cmd_q[i]; + + status = ioread32(cmd_q->reg_interrupt_status); + + if (status) { + cmd_q->int_status = status; + cmd_q->q_status = ioread32(cmd_q->reg_status); + cmd_q->q_int_status = ioread32(cmd_q->reg_int_status); + + /* On error, only save the first error value */ + if ((status & INT_ERROR) && !cmd_q->cmd_error) + cmd_q->cmd_error = CMD_Q_ERROR(cmd_q->q_status); + + cmd_q->int_rcvd = 1; + + /* Acknowledge the interrupt and wake the kthread */ + iowrite32(status, cmd_q->reg_interrupt_status); + wake_up_interruptible(&cmd_q->int_queue); + } + } + ccp5_enable_queue_interrupts(ccp); +} + +static irqreturn_t ccp5_irq_handler(int irq, void *data) +{ + struct device *dev = data; + struct ccp_device *ccp = dev_get_drvdata(dev); + + ccp5_disable_queue_interrupts(ccp); + if (ccp->use_tasklet) + tasklet_schedule(&ccp->irq_tasklet); + else + ccp5_irq_bh((unsigned long)ccp); + return IRQ_HANDLED; +} + static int ccp5_init(struct ccp_device *ccp) { struct device *dev = ccp->dev; @@ -789,18 +848,17 @@ static int ccp5_init(struct ccp_device *ccp) } /* Turn off the queues and disable interrupts until ready */ + ccp5_disable_queue_interrupts(ccp); for (i = 0; i < ccp->cmd_q_count; i++) { cmd_q = &ccp->cmd_q[i]; cmd_q->qcontrol = 0; /* Start with nothing */ iowrite32(cmd_q->qcontrol, cmd_q->reg_control); - /* Disable the interrupts */ - iowrite32(0x00, cmd_q->reg_int_enable); ioread32(cmd_q->reg_int_status); ioread32(cmd_q->reg_status); - /* Clear the interrupts */ + /* Clear the interrupt status */ iowrite32(SUPPORTED_INTERRUPTS, cmd_q->reg_interrupt_status); } @@ -811,6 +869,10 @@ static int ccp5_init(struct ccp_device *ccp) dev_err(dev, "unable to allocate an IRQ\n"); goto e_pool; } + /* Initialize the ISR tasklet */ + if (ccp->use_tasklet) + tasklet_init(&ccp->irq_tasklet, ccp5_irq_bh, + (unsigned long)ccp); dev_dbg(dev, "Loading LSB map...\n"); /* Copy the private LSB mask to the public registers */ @@ -879,11 +941,7 @@ static int ccp5_init(struct ccp_device *ccp) } dev_dbg(dev, "Enabling interrupts...\n"); - /* Enable interrupts */ - for (i = 0; i < ccp->cmd_q_count; i++) { - cmd_q = &ccp->cmd_q[i]; - iowrite32(SUPPORTED_INTERRUPTS, cmd_q->reg_int_enable); - } + ccp5_enable_queue_interrupts(ccp); dev_dbg(dev, "Registering device...\n"); /* Put this on the unit list to make it available */ @@ -935,15 +993,13 @@ static void ccp5_destroy(struct ccp_device *ccp) ccp_del_device(ccp); /* Disable and clear interrupts */ + ccp5_disable_queue_interrupts(ccp); for (i = 0; i < ccp->cmd_q_count; i++) { cmd_q = &ccp->cmd_q[i]; /* Turn off the run bit */ iowrite32(cmd_q->qcontrol & ~CMD5_Q_RUN, cmd_q->reg_control); - /* Disable the interrupts */ - iowrite32(0x00, cmd_q->reg_int_enable); - /* Clear the interrupt status */ iowrite32(SUPPORTED_INTERRUPTS, cmd_q->reg_interrupt_status); ioread32(cmd_q->reg_int_status); @@ -978,39 +1034,6 @@ static void ccp5_destroy(struct ccp_device *ccp) } } -static irqreturn_t ccp5_irq_handler(int irq, void *data) -{ - struct device *dev = data; - struct ccp_device *ccp = dev_get_drvdata(dev); - u32 status; - unsigned int i; - - for (i = 0; i < ccp->cmd_q_count; i++) { - struct ccp_cmd_queue *cmd_q = &ccp->cmd_q[i]; - - status = ioread32(cmd_q->reg_interrupt_status); - - if (status) { - cmd_q->int_status = status; - cmd_q->q_status = ioread32(cmd_q->reg_status); - cmd_q->q_int_status = ioread32(cmd_q->reg_int_status); - - /* On error, only save the first error value */ - if ((status & INT_ERROR) && !cmd_q->cmd_error) - cmd_q->cmd_error = CMD_Q_ERROR(cmd_q->q_status); - - cmd_q->int_rcvd = 1; - - /* Acknowledge the interrupt and wake the kthread */ - iowrite32(SUPPORTED_INTERRUPTS, - cmd_q->reg_interrupt_status); - wake_up_interruptible(&cmd_q->int_queue); - } - } - - return IRQ_HANDLED; -} - static void ccp5_config(struct ccp_device *ccp) { /* Public side */