From patchwork Mon Jun 15 14:36:22 2015 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Punnaiah Choudary Kalluri X-Patchwork-Id: 6609911 Return-Path: X-Original-To: patchwork-linux-arm@patchwork.kernel.org Delivered-To: patchwork-parsemail@patchwork2.web.kernel.org Received: from mail.kernel.org (mail.kernel.org [198.145.29.136]) by patchwork2.web.kernel.org (Postfix) with ESMTP id C30C8C0020 for ; Mon, 15 Jun 2015 14:39:51 +0000 (UTC) Received: from mail.kernel.org (localhost [127.0.0.1]) by mail.kernel.org (Postfix) with ESMTP id 48CB0201FE for ; Mon, 15 Jun 2015 14:39:49 +0000 (UTC) Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.9]) (using TLSv1.2 with cipher DHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mail.kernel.org (Postfix) with ESMTPS id BA0F820462 for ; Mon, 15 Jun 2015 14:39:46 +0000 (UTC) Received: from localhost ([127.0.0.1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.80.1 #2 (Red Hat Linux)) id 1Z4VVs-0007ue-9d; Mon, 15 Jun 2015 14:37:24 +0000 Received: from mail-bn1bon0067.outbound.protection.outlook.com ([157.56.111.67] helo=na01-bn1-obe.outbound.protection.outlook.com) by bombadil.infradead.org with esmtps (Exim 4.80.1 #2 (Red Hat Linux)) id 1Z4VVW-0007iw-NF for linux-arm-kernel@lists.infradead.org; Mon, 15 Jun 2015 14:37:06 +0000 Received: from BL2FFO11FD039.protection.gbl (10.173.160.30) by BL2FFO11HUB008.protection.gbl (10.173.160.228) with Microsoft SMTP Server (TLS) id 15.1.190.9; Mon, 15 Jun 2015 14:36:38 +0000 Authentication-Results: spf=pass (sender IP is 149.199.60.83) smtp.mailfrom=xilinx.com; vger.kernel.org; dkim=none (message not signed) header.d=none; Received-SPF: Pass (protection.outlook.com: domain of xilinx.com designates 149.199.60.83 as permitted sender) receiver=protection.outlook.com; client-ip=149.199.60.83; helo=xsj-pvapsmtpgw01; Received: from xsj-pvapsmtpgw01 (149.199.60.83) by BL2FFO11FD039.mail.protection.outlook.com (10.173.161.135) with Microsoft SMTP Server (TLS) id 15.1.190.9 via Frontend Transport; Mon, 15 Jun 2015 14:36:37 +0000 Received: from unknown-38-66.xilinx.com ([149.199.38.66] helo=xsj-pvapsmtp01) by xsj-pvapsmtpgw01 with esmtp (Exim 4.63) (envelope-from ) id 1Z4VV6-0004Bg-Kg; Mon, 15 Jun 2015 07:36:36 -0700 Received: from [127.0.0.1] (helo=localhost) by xsj-pvapsmtp01 with smtp (Exim 4.63) (envelope-from ) id 1Z4VV6-0002CZ-EO; Mon, 15 Jun 2015 07:36:36 -0700 Received: from xsj-pvapsmtp01 (xsj-smtp1.xilinx.com [149.199.38.66]) by xsj-smtp-dlp2.xlnx.xilinx.com (8.13.8/8.13.1) with ESMTP id t5FEa4Sr005273; Mon, 15 Jun 2015 07:36:05 -0700 Received: from [172.23.64.208] (helo=xhdrdevl6.xilinx.com) by xsj-pvapsmtp01 with esmtp (Exim 4.63) (envelope-from ) id 1Z4VUu-0002Ae-Qn; Mon, 15 Jun 2015 07:36:25 -0700 Received: by xhdrdevl6.xilinx.com (Postfix, from userid 12826) id 018D7EF8163; Mon, 15 Jun 2015 20:06:23 +0530 (IST) From: Punnaiah Choudary Kalluri To: , , , , , , , , Subject: [PATCH v2 2/2] dma: Add Xilinx zynqmp dma engine driver support Date: Mon, 15 Jun 2015 20:06:22 +0530 Message-ID: <1434378982-30184-2-git-send-email-punnaia@xilinx.com> X-Mailer: git-send-email 1.7.4 In-Reply-To: <1434378982-30184-1-git-send-email-punnaia@xilinx.com> References: <1434378982-30184-1-git-send-email-punnaia@xilinx.com> X-RCIS-Action: ALLOW X-TM-AS-Product-Ver: IMSS-7.1.0.1224-8.0.0.1202-21614.005 X-TM-AS-User-Approved-Sender: Yes;Yes X-EOPAttributedMessage: 0 X-Microsoft-Exchange-Diagnostics: 1; BL2FFO11FD039; 1:7HmT3y8/wnc1q/U3Z8q0kIcTGWH19hAlh1K7Ef1TMWbYWK+Q77ziDcD1yjhzBeHhUhjXrsB4XfpeDpVQIT8y+Nko7ruSnWqMiHqOrOvbFbw/gbySh0+ImLmYLA/2Uk06s8T6pC+gE01dBZklfS6b4+Wx7jl2hGZi8Pd2FqsYfmGic/xzwkRmi4e+IWcJgeh+0qjuQzKB0cd8zwoZ/fFE0unm8YJbWa1jQjLJjOEtJvw0xGtxrZPWbpTjkYsL2mk63/qJPWQVWUfdxOhDHosL6u4my4eIaf+p6/Kxl0+mD/cIPqXSlBe91FGzqawgZbKugYdspzg+dVs9rc+mN7kAovQP1ojJT2dZ7ngTxaY4Nuk= X-Forefront-Antispam-Report: CIP:149.199.60.83; CTRY:US; IPV:NLI; EFV:NLI; SFV:NSPM; SFS:(10009020)(6009001)(438002)(199003)(189002)(103686003)(48376002)(2201001)(36756003)(551934003)(107886002)(77156002)(229853001)(47776003)(106466001)(2950100001)(50226001)(6806004)(63266004)(19580405001)(33646002)(86362001)(5001770100001)(46386002)(46102003)(52956003)(92566002)(189998001)(50986999)(87936001)(62966003)(5001960100002)(42186005)(50466002)(45336002)(76176999)(19580395003)(107986001)(4001430100001)(90966001); DIR:OUT; SFP:1101; SCL:1; SRVR:BL2FFO11HUB008; H:xsj-pvapsmtpgw01; FPR:; SPF:Pass; MLV:sfv; A:1; MX:1; LANG:en; MIME-Version: 1.0 X-Microsoft-Exchange-Diagnostics: 1; BL2FFO11HUB008; 2:UcGIjLKCKLPOYGXBW8HOwyDlUsh9/pD7VxQNzVRgBBLub47D82qH4gpMyQb20WVV; 2:ymrP65D6J6wfBI65PXY8PKdqbHdCK0cPFYRSe0HR49BFhEDA2G1nOKT/XrY7wFSX+Y2bkbkVSSbz+jmzkH8vNVj1LJSAmrzUZPNTZZW9+qWfbr1nH5fehLUQ/GFt+cT8a3Al5PWjWGlOqjoNThyQE+zbw3sfkP/pHSNru64JzOY/BZ9O2Ogd5o/LP9gHCEbV7UGejuIRvPEixVoABdlBdj4J6JFnap2Kp2TGZrAKZp8=; 6:a0/4JJRH5g4NEGeUGXFgK4tfnQmaR4KquiUmnXU5B/aJ9p2Sy06M+nie4hzzR81HGhowb1MqPzzpR7Y8z64vmwlkR+CcUnRmHsFMkcBAhTWhQUaJtqce8awYDD1R8hEZvMBWwzCqenUqXv+uSApMy3Y29h8ggnBBGYEeR29j9zpcxRnqjpzEnGPbOOVer08TDCh7MQtGVs5ngBm4DO5q3qJAXwzX4Ajv8lzEMZ0Lo4nPxWnbT5iDm847NX5hhpTvz//kAUeI0tmNwIuBLvMa8uATR5vw/JFvutZV7kBWnCf0m+XJ3Nnw4ankTPVNinmBAspic+KcQEV/WH+swWgL5Lvuo3ilG+6VxWKEBAr91j8ImrK8cmQIVXzClIc00yJY+3rmGFbAH0mDri5afUpgAOoHoMXITydFxWbj3aeleZx9OxEUuEf6n8ZMLhyfS6bPsBip7pUCBIJlZABjhx1RSEL3TPyPUcO0FqCgo3weG9L4Ofd0hDeV104VWFUmr7IX X-Microsoft-Antispam: UriScan:;BCL:0;PCL:0;RULEID:;SRVR:BL2FFO11HUB008; X-Microsoft-Antispam-PRVS: X-Exchange-Antispam-Report-Test: UriScan:; X-Exchange-Antispam-Report-CFA-Test: BCL:0; PCL:0; RULEID:(601004)(5005006)(520003)(3002001); SRVR:BL2FFO11HUB008; BCL:0; PCL:0; RULEID:; SRVR:BL2FFO11HUB008; X-Microsoft-Exchange-Diagnostics: 1; BL2FFO11HUB008; 3:B33UDTmPMu9yFtbEtMW5AhLxPQH3uEkDm4xwboA76WJIlKbcWnLXYk/Z5JXZlT2XKj13CvSR7zROcWPN0frss0y7dZ7cU+gfKilzSAvTgCrnx/RDILNBSqlXmpwIX9pgTZlMK4NOKp0bqmtNMnuKjVi1/ushRdrzcWzfZKC6+H1o9roOm/0fj5EiKNyfFGmNOcTzcsceQKi1figxzbwvvP9/jaONHjC4F6LsnHrLUWYCgJI3NCZkZyFlGVL3mm5hw70FLoH8w8bGHQitG/h4lJHRrUJsnIC8WDRGPIFGHd75EN5TBB6SmXpUTkLeqrj2 X-Forefront-PRVS: 0608DEDB67 X-Microsoft-Exchange-Diagnostics: =?us-ascii?Q?1; BL2FFO11HUB008; 9:XubFX2JuMp1kwV/WSSsqwdm+47rTq+luKAWJmd68E?= =?us-ascii?Q?OGHfVtrWSdbDw5dbjx416K2tEMtfX0XIKr0D7N3zczEA6Bnx/z7ouf17dERq?= =?us-ascii?Q?kaO5uMOtoSjiDPvPtFgjMWEt1FuNNjh7UK+MOUKFLE5fP9pPe74heLS2VP7K?= =?us-ascii?Q?NCD4UI2uLVM8SBquuDDpPHgPbQa/FKglD+wzvaXXDrMVaUDLnNxOhMNfO61w?= =?us-ascii?Q?+9GhJFoK94OgCzEYh+m/7DfC3Yen5Xn9yCOFosGge1mL4Wv5pSpqRb9u8byR?= =?us-ascii?Q?ry8xZUTDZCPawKchiUtKkezgyzieJg3oPz26lq4/5xd48ULfoeU88VBaHpzd?= =?us-ascii?Q?K3XoFcOwD877us/wj9pk3kGr2Sbvh9MxpDkrF6WSJ7rylQ6bmWBmWDqP8GIR?= =?us-ascii?Q?KIPC63j4RV0qGTha1uKpvMDHNbH5SmAU26GqeYH2c8U146uVuGBsxdfpW5bL?= =?us-ascii?Q?pqUnL4pSMM8Vbo8WqYR5P+VEwIGRkogSCkQwV3vWm4rcUcqHLHVUR0GneaWd?= =?us-ascii?Q?8ZBBvzdGiW+PmhihxN+Sz7gqbVCn2knpwYyZ6suZ413iJMUWt5jGhrNFSBVU?= =?us-ascii?Q?MIx066bHFtefet9p3Mx9hhW6IO0NSkxb5jzFJKj1/RNw24Oh573adbirfaDi?= =?us-ascii?Q?0ci8XFgQmqlMZ1a6z1SbMCf2L5jmJT+vr+zy3ZalNIxBVsNmiERcY+iVNjx/?= =?us-ascii?Q?XzeYd+iVy7iuW78nfGbV6IZlHZuP79tz8s6LM3lV7w8Dv8Y6+7MawiVNyZ5/?= =?us-ascii?Q?EQljgK5o9C9XArzgriIuvd4TAOtKfXpcSRXo8i1rFZcT8uBTN0xUCXH8aODo?= =?us-ascii?Q?bUagEFfvTG/jqRaa230ihBDjzByKc2/muyZXaJYHqPEsE54brXDOT7KTkPKR?= =?us-ascii?Q?q3HmoxXIL+z1Td5ZbqF1cpJjy6q+EcUF6iowtQIMHZYCPOb6lgImSIsYxGwn?= =?us-ascii?Q?3SP9vwpTT+Bzd0FOFukgSfz7SEUB3c18HtzOG/+IVFDmnz7gmqxEsh3h6d9u?= =?us-ascii?Q?24wylXErroUBhXS5WK31hpL?= X-Microsoft-Exchange-Diagnostics: 1; BL2FFO11HUB008; 3:qlu7nKzIAmTFMSdUn0uZkCZqfk8/JtOW1+fyFU6P2yQXwhPiLP2rApwciPDckFvTsC4TA4g0OzwdKc8cXoMoC2M5ZZB1Mm+bK4Jw6vZC36bCZD3qpJ8YfmyDtWoVQDzg6nhkRSHzQ3j6JUW91wUHrg==; 10:zrBlM3HH805UMWrzsPwIephcL7yb1QC5Lplcwm3AYtvH9WquMIURbZ+QvVKtK17BNtpIn/naTCS56m2Gmr+ZEPbRBIIgiNbiz5ytiWb/gzc= X-OriginatorOrg: xilinx.com X-MS-Exchange-CrossTenant-OriginalArrivalTime: 15 Jun 2015 14:36:37.7030 (UTC) X-MS-Exchange-CrossTenant-Id: 657af505-d5df-48d0-8300-c31994686c5c X-MS-Exchange-CrossTenant-OriginalAttributedTenantConnectingIp: TenantId=657af505-d5df-48d0-8300-c31994686c5c; Ip=[149.199.60.83]; Helo=[xsj-pvapsmtpgw01] X-MS-Exchange-CrossTenant-FromEntityHeader: HybridOnPrem X-MS-Exchange-Transport-CrossTenantHeadersStamped: BL2FFO11HUB008 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20150615_073703_195264_C774FFBC X-CRM114-Status: GOOD ( 15.36 ) X-Spam-Score: -0.0 (/) Cc: devicetree@vger.kernel.org, linux-kernel@vger.kernel.org, kpc528@gmail.com, kalluripunnaiahchoudary@gmail.com, dmaengine@vger.kernel.org, Punnaiah Choudary Kalluri , linux-arm-kernel@lists.infradead.org X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.18-1 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org X-Spam-Status: No, score=-4.7 required=5.0 tests=BAD_ENC_HEADER,BAYES_00, RCVD_IN_DNSWL_MED, RP_MATCHES_RCVD, UNPARSEABLE_RELAY autolearn=unavailable version=3.3.1 X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on mail.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP Added the basic driver for zynqmp dma engine used in Zynq UltraScale+ MPSoC. The initial release of this driver supports only memory to memory transfers. Signed-off-by: Punnaiah Choudary Kalluri --- Changes in v2: - Corrected the function header documentation - Framework expects bus-width value in bytes. so, fixed it. - Removed magic numbers for bus-width --- drivers/dma/Kconfig | 6 + drivers/dma/xilinx/Makefile | 1 + drivers/dma/xilinx/zynqmp_dma.c | 1216 +++++++++++++++++++++++++++++++++++++++ 3 files changed, 1223 insertions(+), 0 deletions(-) create mode 100644 drivers/dma/xilinx/zynqmp_dma.c diff --git a/drivers/dma/Kconfig b/drivers/dma/Kconfig index bda2cb0..d5b57fc 100644 --- a/drivers/dma/Kconfig +++ b/drivers/dma/Kconfig @@ -410,6 +410,12 @@ config XILINX_VDMA channels, Memory Mapped to Stream (MM2S) and Stream to Memory Mapped (S2MM) for the data transfers. +config XILINX_ZYNQMP_DMA + tristate "Xilinx ZynqMP DMA Engine" + select DMA_ENGINE + help + Enable support for Xilinx ZynqMP DMA engine in Zynq UltraScale+ MPSoC. + config DMA_SUN6I tristate "Allwinner A31 SoCs DMA support" depends on MACH_SUN6I || MACH_SUN8I || COMPILE_TEST diff --git a/drivers/dma/xilinx/Makefile b/drivers/dma/xilinx/Makefile index 3c4e9f2..95469dc 100644 --- a/drivers/dma/xilinx/Makefile +++ b/drivers/dma/xilinx/Makefile @@ -1 +1,2 @@ obj-$(CONFIG_XILINX_VDMA) += xilinx_vdma.o +obj-$(CONFIG_XILINX_ZYNQMP_DMA) += zynqmp_dma.o diff --git a/drivers/dma/xilinx/zynqmp_dma.c b/drivers/dma/xilinx/zynqmp_dma.c new file mode 100644 index 0000000..3fcc70e --- /dev/null +++ b/drivers/dma/xilinx/zynqmp_dma.c @@ -0,0 +1,1216 @@ +/* + * DMA driver for Xilinx ZynqMP DMA Engine + * + * Copyright (C) 2015 Xilinx, Inc. All rights reserved. + * + * This program is free software: you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation, either version 2 of the License, or + * (at your option) any later version. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "../dmaengine.h" + +/* Register Offsets */ +#define ISR 0x100 +#define IMR 0x104 +#define IER 0x108 +#define IDS 0x10C +#define CTRL0 0x110 +#define CTRL1 0x114 +#define STATUS 0x11C +#define DATA_ATTR 0x120 +#define DSCR_ATTR 0x124 +#define SRC_DSCR_WRD0 0x128 +#define SRC_DSCR_WRD1 0x12C +#define SRC_DSCR_WRD2 0x130 +#define SRC_DSCR_WRD3 0x134 +#define DST_DSCR_WRD0 0x138 +#define DST_DSCR_WRD1 0x13C +#define DST_DSCR_WRD2 0x140 +#define DST_DSCR_WRD3 0x144 +#define SRC_START_LSB 0x158 +#define SRC_START_MSB 0x15C +#define DST_START_LSB 0x160 +#define DST_START_MSB 0x164 +#define TOTAL_BYTE 0x188 +#define RATE_CTRL 0x18C +#define IRQ_SRC_ACCT 0x190 +#define IRQ_DST_ACCT 0x194 +#define CTRL2 0x200 + +/* Interrupt registers bit field definitions */ +#define DMA_DONE BIT(10) +#define AXI_WR_DATA BIT(9) +#define AXI_RD_DATA BIT(8) +#define AXI_RD_DST_DSCR BIT(7) +#define AXI_RD_SRC_DSCR BIT(6) +#define IRQ_DST_ACCT_ERR BIT(5) +#define IRQ_SRC_ACCT_ERR BIT(4) +#define BYTE_CNT_OVRFL BIT(3) +#define DST_DSCR_DONE BIT(2) +#define INV_APB BIT(0) + +/* Control 0 register bit field definitions */ +#define OVR_FETCH BIT(7) +#define POINT_TYPE_SG BIT(6) +#define RATE_CTRL_EN BIT(3) + +/* Control 1 register bit field definitions */ +#define SRC_ISSUE GENMASK(4, 0) + +/* Channel status register bit field definitions */ +#define STATUS_BUSY 0x2 + +/* Data Attribute register bit field definitions */ +#define ARBURST GENMASK(27, 26) +#define ARCACHE GENMASK(25, 22) +#define ARCACHE_OFST 22 +#define ARQOS GENMASK(21, 18) +#define ARQOS_OFST 18 +#define ARLEN GENMASK(17, 14) +#define ARLEN_OFST 14 +#define AWBURST GENMASK(13, 12) +#define AWCACHE GENMASK(11, 8) +#define AWCACHE_OFST 8 +#define AWQOS GENMASK(7, 4) +#define AWQOS_OFST 4 +#define AWLEN GENMASK(3, 0) +#define AWLEN_OFST 0 + +/* Descriptor Attribute register bit field definitions */ +#define AXCOHRNT BIT(8) +#define AXCACHE GENMASK(7, 4) +#define AXCACHE_OFST 4 +#define AXQOS GENMASK(3, 0) +#define AXQOS_OFST 0 + +/* Control register 2 bit field definitions */ +#define ENABLE BIT(0) + +/* Buffer Descriptor definitions */ +#define DESC_CTRL_STOP 0x10 +#define DESC_CTRL_COMP_INT 0x4 +#define DESC_CTRL_SIZE_256 0x2 +#define DESC_CTRL_COHRNT 0x1 + +/* Interrupt Mask specific definitions */ +#define INT_ERR (AXI_RD_DATA | AXI_WR_DATA | AXI_RD_DST_DSCR | \ + AXI_RD_SRC_DSCR | INV_APB) +#define INT_OVRFL (BYTE_CNT_OVRFL | IRQ_SRC_ACCT_ERR | IRQ_DST_ACCT_ERR) +#define INT_DONE (DMA_DONE | DST_DSCR_DONE) +#define INT_EN_DEFAULT_MASK (INT_DONE | INT_ERR | INT_OVRFL | DST_DSCR_DONE) + +/* Max number of descriptors per channel */ +#define ZYNQMP_DMA_NUM_DESCS 32 + +/* Max transfer size per descriptor */ +#define ZYNQMP_DMA_MAX_TRANS_LEN 0x40000000 + +/* Reset values for data attributes */ +#define ARCACHE_RST_VAL 0x2 +#define ARLEN_RST_VAL 0xF +#define AWCACHE_RST_VAL 0x2 +#define AWLEN_RST_VAL 0xF + +#define SRC_ISSUE_RST_VAL 0x1F + +#define IDS_DEFAULT_MASK 0xFFF + +/* Bus width in bits */ +#define ZYNQMP_DMA_BUS_WIDTH_64 64 +#define ZYNQMP_DMA_BUS_WIDTH_128 128 + +#define DESC_SIZE(chan) (chan->desc_size) + +#define to_chan(chan) container_of(chan, struct zynqmp_dma_chan, \ + common) +#define tx_to_desc(tx) container_of(tx, struct zynqmp_dma_desc_sw, \ + async_tx) + +/** + * struct zynqmp_dma_desc_ll - Hw linked list descriptor + * @addr: Buffer address + * @size: Size of the buffer + * @ctrl: Control word + * @nxtdscraddr: Next descriptor base address + * @rsvd: Reserved field and for Hw internal use. + */ +struct zynqmp_dma_desc_ll { + u64 addr; + u32 size; + u32 ctrl; + u64 nxtdscraddr; + u64 rsvd; +}; __aligned(64) + +/** + * struct zynqmp_dma_chan - Driver specific DMA channel structure + * @xdev: Driver specific device structure + * @regs: Control registers offset + * @lock: Descriptor operation lock + * @pending_list: Descriptors waiting + * @free_list: Descriptors free + * @active_list: Descriptors active + * @sw_desc_pool: SW descriptor pool + * @done_list: Complete descriptors + * @common: DMA common channel + * @desc_pool_v: Statically allocated descriptor base + * @desc_pool_p: Physical allocated descriptor base + * @desc_free_cnt: Descriptor available count + * @dev: The dma device + * @irq: Channel IRQ + * @has_sg: Support scatter gather transfers + * @ovrfetch: Overfetch status + * @ratectrl: Rate control value + * @tasklet: Cleanup work after irq + * @src_issue: Out standing transactions on source + * @dst_issue: Out standing transactions on destination + * @desc_size: Size of the low level descriptor + * @err: Channel has errors + * @bus_width: Bus width + * @desc_axi_cohrnt: Descriptor axi coherent status + * @desc_axi_cache: Descriptor axi cache attribute + * @desc_axi_qos: Descriptor axi qos attribute + * @src_axi_cohrnt: Source data axi coherent status + * @src_axi_cache: Source data axi cache attribute + * @src_axi_qos: Source data axi qos attribute + * @dst_axi_cohrnt: Dest data axi coherent status + * @dst_axi_cache: Dest data axi cache attribute + * @dst_axi_qos: Dest data axi qos attribute + * @src_burst_len: Source burst length + * @dst_burst_len: Dest burst length + */ +struct zynqmp_dma_chan { + struct zynqmp_dma_device *xdev; + void __iomem *regs; + spinlock_t lock; + struct list_head pending_list; + struct list_head free_list; + struct list_head active_list; + struct zynqmp_dma_desc_sw *sw_desc_pool; + struct list_head done_list; + struct dma_chan common; + void *desc_pool_v; + dma_addr_t desc_pool_p; + u32 desc_free_cnt; + struct device *dev; + int irq; + bool has_sg; + bool ovrfetch; + u32 ratectrl; + struct tasklet_struct tasklet; + u32 src_issue; + u32 dst_issue; + u32 desc_size; + bool err; + u32 bus_width; + u32 desc_axi_cohrnt; + u32 desc_axi_cache; + u32 desc_axi_qos; + u32 src_axi_cohrnt; + u32 src_axi_cache; + u32 src_axi_qos; + u32 dst_axi_cohrnt; + u32 dst_axi_cache; + u32 dst_axi_qos; + u32 src_burst_len; + u32 dst_burst_len; +}; + +/** + * struct zynqmp_dma_desc_sw - Per Transaction structure + * @src: Source address for simple mode dma + * @dst: Destination address for simple mode dma + * @len: Transfer length for simple mode dma + * @node: Node in the channel descriptor list + * @tx_list: List head for the current transfer + * @async_tx: Async transaction descriptor + * @src_v: Virtual address of the src descriptor + * @src_p: Physical address of the src descriptor + * @dst_v: Virtual address of the dst descriptor + * @dst_p: Physical address of the dst descriptor + */ +struct zynqmp_dma_desc_sw { + u64 src; + u64 dst; + u32 len; + struct list_head node; + struct list_head tx_list; + struct dma_async_tx_descriptor async_tx; + struct zynqmp_dma_desc_ll *src_v; + dma_addr_t src_p; + struct zynqmp_dma_desc_ll *dst_v; + dma_addr_t dst_p; +}; + +/** + * struct zynqmp_dma_device - DMA device structure + * @dev: Device Structure + * @common: DMA device structure + * @chan: Driver specific DMA channel + */ +struct zynqmp_dma_device { + struct device *dev; + struct dma_device common; + struct zynqmp_dma_chan *chan; +}; + +/** + * zynqmp_dma_chan_is_idle - Provides the channel idle status + * @chan: ZynqMP DMA DMA channel pointer + * + * Return: '1' if the channel is idle otherwise '0' + */ +static int zynqmp_dma_chan_is_idle(struct zynqmp_dma_chan *chan) +{ + u32 regval; + + regval = readl(chan->regs + STATUS); + if (regval & STATUS_BUSY) + return 0; + + return 1; +} + +/** + * zynqmp_dma_update_desc_to_ctrlr - Updates descriptor to the controller + * @chan: ZynqMP DMA DMA channel pointer + * @desc: Transaction descriptor pointer + */ +static void zynqmp_dma_update_desc_to_ctrlr(struct zynqmp_dma_chan *chan, + struct zynqmp_dma_desc_sw *desc) +{ + dma_addr_t addr; + + addr = desc->src_p; + writel(addr, chan->regs + SRC_START_LSB); + writel(upper_32_bits(addr), chan->regs + SRC_START_MSB); + addr = desc->dst_p; + writel(addr, chan->regs + DST_START_LSB); + writel(upper_32_bits(addr), chan->regs + DST_START_MSB); +} + +/** + * zynqmp_dma_desc_config_eod - Mark the descriptor as end descriptor + * @chan: ZynqMP DMA channel pointer + * @desc: Hw descriptor pointer + */ +static void zynqmp_dma_desc_config_eod(struct zynqmp_dma_chan *chan, void *desc) +{ + struct zynqmp_dma_desc_ll *hw = (struct zynqmp_dma_desc_ll *)desc; + + hw->ctrl |= DESC_CTRL_STOP; + hw++; + hw->ctrl |= DESC_CTRL_COMP_INT | DESC_CTRL_STOP; +} + +/** + * zynqmp_dma_config_simple_desc - Configure the transfer params to channel registers + * @chan: ZynqMP DMA channel pointer + * @src: Source buffer address + * @dst: Destination buffer address + * @len: Transfer length + */ +static void zynqmp_dma_config_simple_desc(struct zynqmp_dma_chan *chan, + dma_addr_t src, dma_addr_t dst, + size_t len) +{ + u32 val; + + writel(src, chan->regs + SRC_DSCR_WRD0); + writel(upper_32_bits(src), chan->regs + SRC_DSCR_WRD1); + writel(len, chan->regs + SRC_DSCR_WRD2); + + if (chan->src_axi_cohrnt) + writel(DESC_CTRL_COHRNT, chan->regs + SRC_DSCR_WRD3); + else + writel(0, chan->regs + SRC_DSCR_WRD3); + + writel(dst, chan->regs + DST_DSCR_WRD0); + writel(upper_32_bits(dst), chan->regs + DST_DSCR_WRD1); + writel(len, chan->regs + DST_DSCR_WRD2); + + if (chan->dst_axi_cohrnt) + val = DESC_CTRL_COHRNT | DESC_CTRL_COMP_INT; + else + val = DESC_CTRL_COMP_INT; + writel(val, chan->regs + DST_DSCR_WRD3); +} + +/** + * zynqmp_dma_config_sg_ll_desc - Configure the linked list descriptor + * @chan: ZynqMP DMA channel pointer + * @sdesc: Hw descriptor pointer + * @src: Source buffer address + * @dst: Destination buffer address + * @len: Transfer length + * @prev: Previous hw descriptor pointer + */ +static void zynqmp_dma_config_sg_ll_desc(struct zynqmp_dma_chan *chan, + struct zynqmp_dma_desc_ll *sdesc, + dma_addr_t src, dma_addr_t dst, size_t len, + struct zynqmp_dma_desc_ll *prev) +{ + struct zynqmp_dma_desc_ll *ddesc = sdesc + 1; + + sdesc->size = ddesc->size = len; + sdesc->addr = src; + ddesc->addr = dst; + + sdesc->ctrl = ddesc->ctrl = DESC_CTRL_SIZE_256; + if (chan->src_axi_cohrnt) + sdesc->ctrl |= DESC_CTRL_COHRNT; + else + ddesc->ctrl |= DESC_CTRL_COHRNT; + + if (prev) { + dma_addr_t addr = chan->desc_pool_p + + ((dma_addr_t)sdesc - (dma_addr_t)chan->desc_pool_v); + ddesc = prev + 1; + prev->nxtdscraddr = addr; + ddesc->nxtdscraddr = addr + DESC_SIZE(chan); + } +} + +/** + * zynqmp_dma_init - Initialize the channel + * @chan: ZynqMP DMA channel pointer + */ +static void zynqmp_dma_init(struct zynqmp_dma_chan *chan) +{ + u32 val; + + writel(IDS_DEFAULT_MASK, chan->regs + IDS); + val = readl(chan->regs + ISR); + writel(val, chan->regs + ISR); + writel(0x0, chan->regs + TOTAL_BYTE); + + val = readl(chan->regs + CTRL1); + if (chan->src_issue) + val = (val & ~SRC_ISSUE) | chan->src_issue; + writel(val, chan->regs + CTRL1); + + val = 0; + if (chan->ovrfetch) + val |= OVR_FETCH; + if (chan->has_sg) + val |= POINT_TYPE_SG; + if (chan->ratectrl) { + val |= RATE_CTRL_EN; + writel(chan->ratectrl, chan->regs + RATE_CTRL); + } + writel(val, chan->regs + CTRL0); + + val = 0; + if (chan->desc_axi_cohrnt) + val |= AXCOHRNT; + val |= chan->desc_axi_cache; + val = (val & ~AXCACHE) | (chan->desc_axi_cache << AXCACHE_OFST); + val |= chan->desc_axi_qos; + val = (val & ~AXQOS) | (chan->desc_axi_qos << AXQOS_OFST); + writel(val, chan->regs + DSCR_ATTR); + + val = readl(chan->regs + DATA_ATTR); + val = (val & ~ARCACHE) | (chan->src_axi_cache << ARCACHE_OFST); + val = (val & ~AWCACHE) | (chan->dst_axi_cache << AWCACHE_OFST); + val = (val & ~ARQOS) | (chan->src_axi_qos << ARQOS_OFST); + val = (val & ~AWQOS) | (chan->dst_axi_qos << AWQOS_OFST); + val = (val & ~ARLEN) | (chan->src_burst_len << ARLEN_OFST); + val = (val & ~AWLEN) | (chan->dst_burst_len << AWLEN_OFST); + writel(val, chan->regs + DATA_ATTR); + + /* Clearing the interrupt account rgisters */ + val = readl(chan->regs + IRQ_SRC_ACCT); + val = readl(chan->regs + IRQ_DST_ACCT); +} + +/** + * zynqmp_dma_tx_submit - Submit DMA transaction + * @tx: Async transaction descriptor pointer + * + * Return: cookie value + */ +static dma_cookie_t zynqmp_dma_tx_submit(struct dma_async_tx_descriptor *tx) +{ + struct zynqmp_dma_chan *chan = to_chan(tx->chan); + struct zynqmp_dma_desc_sw *desc = NULL, *new; + dma_cookie_t cookie; + + new = tx_to_desc(tx); + spin_lock_bh(&chan->lock); + cookie = dma_cookie_assign(tx); + if (!list_empty(&chan->pending_list) && chan->has_sg) { + desc = list_last_entry(&chan->pending_list, + struct zynqmp_dma_desc_sw, node); + if (!list_empty(&desc->tx_list)) + desc = list_last_entry(&desc->tx_list, + struct zynqmp_dma_desc_sw, node); + desc->src_v->nxtdscraddr = new->src_p; + desc->src_v->ctrl &= ~DESC_CTRL_STOP; + desc->dst_v->nxtdscraddr = new->dst_p; + desc->dst_v->ctrl &= ~DESC_CTRL_STOP; + } + list_add_tail(&new->node, &chan->pending_list); + spin_unlock_bh(&chan->lock); + + return cookie; +} + +/** + * zynqmp_dma_get_descriptor - Get the sw descriptor from the pool + * @chan: ZynqMP DMA channel pointer + * + * Return: The sw descriptor + */ +static struct zynqmp_dma_desc_sw * +zynqmp_dma_get_descriptor(struct zynqmp_dma_chan *chan) +{ + struct zynqmp_dma_desc_sw *desc; + + spin_lock_bh(&chan->lock); + desc = list_first_entry(&chan->free_list, struct zynqmp_dma_desc_sw, + node); + list_del(&desc->node); + spin_unlock_bh(&chan->lock); + + INIT_LIST_HEAD(&desc->tx_list); + /* Clear the src and dst descriptor memory */ + if (chan->has_sg) { + memset((void *)desc->src_v, 0, DESC_SIZE(chan)); + memset((void *)desc->dst_v, 0, DESC_SIZE(chan)); + } + + return desc; +} + +/** + * zynqmp_dma_free_descriptor - Issue pending transactions + * @chan: ZynqMP DMA channel pointer + * @sdesc: Transaction descriptor pointer + */ +static void zynqmp_dma_free_descriptor(struct zynqmp_dma_chan *chan, + struct zynqmp_dma_desc_sw *sdesc) +{ + struct zynqmp_dma_desc_sw *child, *next; + + chan->desc_free_cnt++; + list_add_tail(&sdesc->node, &chan->free_list); + list_for_each_entry_safe(child, next, &sdesc->tx_list, node) { + chan->desc_free_cnt++; + list_move_tail(&child->node, &chan->free_list); + } +} + +/** + * zynqmp_dma_free_desc_list - Free descriptors list + * @chan: ZynqMP DMA channel pointer + * @list: List to parse and delete the descriptor + */ +static void zynqmp_dma_free_desc_list(struct zynqmp_dma_chan *chan, + struct list_head *list) +{ + struct zynqmp_dma_desc_sw *desc, *next; + + list_for_each_entry_safe(desc, next, list, node) + zynqmp_dma_free_descriptor(chan, desc); +} + +/** + * zynqmp_dma_alloc_chan_resources - Allocate channel resources + * @dchan: DMA channel + * + * Return: '0' on success and failure value on error + */ +static int zynqmp_dma_alloc_chan_resources(struct dma_chan *dchan) +{ + struct zynqmp_dma_chan *chan = to_chan(dchan); + struct zynqmp_dma_desc_sw *desc; + int i; + + chan->sw_desc_pool = kzalloc(sizeof(*desc) * ZYNQMP_DMA_NUM_DESCS, + GFP_KERNEL); + if (!chan->sw_desc_pool) + return -ENOMEM; + + chan->desc_free_cnt = ZYNQMP_DMA_NUM_DESCS; + + INIT_LIST_HEAD(&chan->free_list); + + for (i = 0; i < ZYNQMP_DMA_NUM_DESCS; i++) { + desc = chan->sw_desc_pool + i; + dma_async_tx_descriptor_init(&desc->async_tx, &chan->common); + desc->async_tx.tx_submit = zynqmp_dma_tx_submit; + async_tx_ack(&desc->async_tx); + list_add_tail(&desc->node, &chan->free_list); + } + + if (!chan->has_sg) + return 0; + + chan->desc_pool_v = dma_zalloc_coherent(chan->dev, + (2 * chan->desc_size * ZYNQMP_DMA_NUM_DESCS), + &chan->desc_pool_p, GFP_KERNEL); + if (!chan->desc_pool_v) + return -ENOMEM; + + for (i = 0; i < ZYNQMP_DMA_NUM_DESCS; i++) { + desc = chan->sw_desc_pool + i; + desc->src_v = (struct zynqmp_dma_desc_ll *) (chan->desc_pool_v + + (i * DESC_SIZE(chan) * 2)); + desc->dst_v = (struct zynqmp_dma_desc_ll *) (desc->src_v + 1); + desc->src_p = chan->desc_pool_p + (i * DESC_SIZE(chan) * 2); + desc->dst_p = desc->src_p + DESC_SIZE(chan); + } + + return 0; +} + +/** + * zynqmp_dma_start - Start DMA channel + * @chan: ZynqMP DMA channel pointer + */ +static void zynqmp_dma_start(struct zynqmp_dma_chan *chan) +{ + writel(INT_EN_DEFAULT_MASK, chan->regs + IER); + writel(0, chan->regs + TOTAL_BYTE); + writel(ENABLE, chan->regs + CTRL2); +} + +/** + * zynqmp_dma_handle_ovfl_int - Process the overflow interrupt + * @chan: ZynqMP DMA channel pointer + * @status: Interrupt status value + */ +static void zynqmp_dma_handle_ovfl_int(struct zynqmp_dma_chan *chan, u32 status) +{ + u32 val; + + if (status & BYTE_CNT_OVRFL) { + val = readl(chan->regs + TOTAL_BYTE); + writel(0, chan->regs + TOTAL_BYTE); + } + if (status & IRQ_DST_ACCT_ERR) + val = readl(chan->regs + IRQ_DST_ACCT); + if (status & IRQ_SRC_ACCT_ERR) + val = readl(chan->regs + IRQ_SRC_ACCT); +} + +/** + * zynqmp_dma_start_transfer - Initiate the new transfer + * @chan: ZynqMP DMA channel pointer + */ +static void zynqmp_dma_start_transfer(struct zynqmp_dma_chan *chan) +{ + struct zynqmp_dma_desc_sw *desc; + + if (!zynqmp_dma_chan_is_idle(chan)) + return; + + desc = list_first_entry_or_null(&chan->pending_list, + struct zynqmp_dma_desc_sw, node); + if (!desc) + return; + + if (chan->has_sg) + list_splice_tail_init(&chan->pending_list, &chan->active_list); + else + list_move_tail(&desc->node, &chan->active_list); + + if (chan->has_sg) + zynqmp_dma_update_desc_to_ctrlr(chan, desc); + else + zynqmp_dma_config_simple_desc(chan, desc->src, desc->dst, + desc->len); + zynqmp_dma_start(chan); +} + + +/** + * zynqmp_dma_chan_desc_cleanup - Cleanup the completed descriptors + * @chan: ZynqMP DMA channel + */ +static void zynqmp_dma_chan_desc_cleanup(struct zynqmp_dma_chan *chan) +{ + struct zynqmp_dma_desc_sw *desc, *next; + + list_for_each_entry_safe(desc, next, &chan->done_list, node) { + dma_async_tx_callback callback; + void *callback_param; + + list_del(&desc->node); + + callback = desc->async_tx.callback; + callback_param = desc->async_tx.callback_param; + if (callback) + callback(callback_param); + + /* Run any dependencies, then free the descriptor */ + dma_run_dependencies(&desc->async_tx); + zynqmp_dma_free_descriptor(chan, desc); + } +} + +/** + * zynqmp_dma_complete_descriptor - Mark the active descriptor as complete + * @chan: ZynqMP DMA channel pointer + */ +static void zynqmp_dma_complete_descriptor(struct zynqmp_dma_chan *chan) +{ + struct zynqmp_dma_desc_sw *desc; + + desc = list_first_entry_or_null(&chan->active_list, + struct zynqmp_dma_desc_sw, node); + if (!desc) + return; + list_del(&desc->node); + dma_cookie_complete(&desc->async_tx); + list_add_tail(&desc->node, &chan->done_list); +} + +/** + * zynqmp_dma_issue_pending - Issue pending transactions + * @dchan: DMA channel pointer + */ +static void zynqmp_dma_issue_pending(struct dma_chan *dchan) +{ + struct zynqmp_dma_chan *chan = to_chan(dchan); + + spin_lock_bh(&chan->lock); + zynqmp_dma_start_transfer(chan); + spin_unlock_bh(&chan->lock); +} + +/** + * zynqmp_dma_free_chan_resources - Free channel resources + * @dchan: DMA channel pointer + */ +static void zynqmp_dma_free_chan_resources(struct dma_chan *dchan) +{ + struct zynqmp_dma_chan *chan = to_chan(dchan); + + spin_lock_bh(&chan->lock); + + zynqmp_dma_free_desc_list(chan, &chan->active_list); + zynqmp_dma_free_desc_list(chan, &chan->done_list); + zynqmp_dma_free_desc_list(chan, &chan->pending_list); + + spin_unlock_bh(&chan->lock); + if (chan->has_sg) + dma_free_coherent(chan->dev, + (2 * DESC_SIZE(chan) * ZYNQMP_DMA_NUM_DESCS), + chan->desc_pool_v, chan->desc_pool_p); + kfree(chan->sw_desc_pool); +} + +/** + * zynqmp_dma_tx_status - Get dma transaction status + * @dchan: DMA channel pointer + * @cookie: Transaction identifier + * @txstate: Transaction state + * + * Return: DMA transaction status + */ +static enum dma_status zynqmp_dma_tx_status(struct dma_chan *dchan, + dma_cookie_t cookie, + struct dma_tx_state *txstate) +{ + return dma_cookie_status(dchan, cookie, txstate); +} + +/** + * zynqmp_dma_reset - Reset the channel + * @chan: ZynqMP DMA channel pointer + */ +static void zynqmp_dma_reset(struct zynqmp_dma_chan *chan) +{ + writel(IDS_DEFAULT_MASK, chan->regs + IDS); + + zynqmp_dma_complete_descriptor(chan); + zynqmp_dma_chan_desc_cleanup(chan); + + zynqmp_dma_free_desc_list(chan, &chan->active_list); + zynqmp_dma_free_desc_list(chan, &chan->done_list); + zynqmp_dma_free_desc_list(chan, &chan->pending_list); + zynqmp_dma_init(chan); +} + +/** + * zynqmp_dma_irq_handler - ZynqMP DMA Interrupt handler + * @irq: IRQ number + * @data: Pointer to the ZynqMP DMA channel structure + * + * Return: IRQ_HANDLED/IRQ_NONE + */ +static irqreturn_t zynqmp_dma_irq_handler(int irq, void *data) +{ + struct zynqmp_dma_chan *chan = (struct zynqmp_dma_chan *)data; + u32 isr, imr, status; + irqreturn_t ret = IRQ_NONE; + + isr = readl(chan->regs + ISR); + imr = readl(chan->regs + IMR); + status = isr & ~imr; + writel(isr, chan->regs+ISR); + if (status & INT_DONE) { + writel(INT_DONE, chan->regs + IDS); + tasklet_schedule(&chan->tasklet); + ret = IRQ_HANDLED; + } + + if (status & INT_ERR) { + chan->err = true; + writel(INT_ERR, chan->regs + IDS); + tasklet_schedule(&chan->tasklet); + dev_err(chan->dev, "Channel %p has has errors\n", chan); + ret = IRQ_HANDLED; + } + + if (status & INT_OVRFL) { + writel(INT_OVRFL, chan->regs + IDS); + zynqmp_dma_handle_ovfl_int(chan, status); + dev_info(chan->dev, "Channel %p overflow interrupt\n", chan); + ret = IRQ_HANDLED; + } + + return ret; +} + +/** + * zynqmp_dma_do_tasklet - Schedule completion tasklet + * @data: Pointer to the ZynqMP DMA channel structure + */ +static void zynqmp_dma_do_tasklet(unsigned long data) +{ + struct zynqmp_dma_chan *chan = (struct zynqmp_dma_chan *)data; + u32 count; + + spin_lock(&chan->lock); + + if (chan->err) { + zynqmp_dma_reset(chan); + chan->err = false; + goto unlock; + } + + if (zynqmp_dma_chan_is_idle(chan)) + zynqmp_dma_start_transfer(chan); + else + writel(INT_DONE, chan->regs + IER); + + count = readl(chan->regs + IRQ_DST_ACCT); + while (count) { + zynqmp_dma_complete_descriptor(chan); + zynqmp_dma_chan_desc_cleanup(chan); + count--; + } + +unlock: + spin_unlock(&chan->lock); +} + +/** + * zynqmp_dma_device_terminate_all - Aborts all transfers on a channel + * @dchan: DMA channel pointer + * + * Return: Always '0' + */ +static int zynqmp_dma_device_terminate_all(struct dma_chan *dchan) +{ + struct zynqmp_dma_chan *chan = to_chan(dchan); + + spin_lock_bh(&chan->lock); + zynqmp_dma_reset(chan); + spin_unlock_bh(&chan->lock); + + return 0; +} + +/** + * zynqmp_dma_prep_memcpy - prepare descriptors for memcpy transaction + * @dchan: DMA channel + * @dma_dst: Destination buffer address + * @dma_src: Source buffer address + * @len: Transfer length + * @flags: transfer ack flags + * + * Return: Async transaction descriptor on success and NULL on failure + */ +static struct dma_async_tx_descriptor *zynqmp_dma_prep_memcpy( + struct dma_chan *dchan, dma_addr_t dma_dst, + dma_addr_t dma_src, size_t len, ulong flags) +{ + struct zynqmp_dma_chan *chan; + struct zynqmp_dma_desc_sw *new, *first = NULL; + void *desc = NULL, *prev = NULL; + size_t copy; + u32 desc_cnt; + + chan = to_chan(dchan); + + if ((len > ZYNQMP_DMA_MAX_TRANS_LEN) && !chan->has_sg) + return NULL; + + desc_cnt = DIV_ROUND_UP(len, ZYNQMP_DMA_MAX_TRANS_LEN); + + spin_lock_bh(&chan->lock); + if ((desc_cnt > chan->desc_free_cnt) && chan->has_sg) { + spin_unlock_bh(&chan->lock); + dev_dbg(chan->dev, "chan %p descs are not available\n", chan); + return NULL; + } + chan->desc_free_cnt = chan->desc_free_cnt - desc_cnt; + spin_unlock_bh(&chan->lock); + + do { + new = zynqmp_dma_get_descriptor(chan); + copy = min_t(size_t, len, ZYNQMP_DMA_MAX_TRANS_LEN); + if (chan->has_sg) { + desc = (struct zynqmp_dma_desc_ll *)new->src_v; + zynqmp_dma_config_sg_ll_desc(chan, desc, dma_src, + dma_dst, copy, prev); + } else { + new->src = dma_src; + new->dst = dma_dst; + new->len = len; + } + + prev = desc; + len -= copy; + dma_src += copy; + dma_dst += copy; + if (!first) + first = new; + else + list_add_tail(&new->node, &first->tx_list); + } while (len); + + if (chan->has_sg) + zynqmp_dma_desc_config_eod(chan, desc); + + first->async_tx.flags = flags; + return &first->async_tx; +} + +/** + * zynqmp_dma_prep_slave_sg - prepare descriptors for a memory sg transaction + * @dchan: DMA channel + * @dst_sg: Destination scatter list + * @dst_sg_len: Number of entries in destination scatter list + * @src_sg: Source scatter list + * @src_sg_len: Number of entries in source scatter list + * @flags: transfer ack flags + * + * Return: Async transaction descriptor on success and NULL on failure + */ +static struct dma_async_tx_descriptor *zynqmp_dma_prep_sg( + struct dma_chan *dchan, struct scatterlist *dst_sg, + unsigned int dst_sg_len, struct scatterlist *src_sg, + unsigned int src_sg_len, unsigned long flags) +{ + struct zynqmp_dma_desc_sw *new, *first = NULL; + struct zynqmp_dma_chan *chan = to_chan(dchan); + void *desc = NULL, *prev = NULL; + size_t len, dst_avail, src_avail; + dma_addr_t dma_dst, dma_src; + u32 desc_cnt = 0, i; + struct scatterlist *sg; + + if (!chan->has_sg) + return NULL; + + for_each_sg(src_sg, sg, src_sg_len, i) + desc_cnt += DIV_ROUND_UP(sg_dma_len(sg), + ZYNQMP_DMA_MAX_TRANS_LEN); + + spin_lock_bh(&chan->lock); + if (desc_cnt > chan->desc_free_cnt) { + spin_unlock_bh(&chan->lock); + dev_dbg(chan->dev, "chan %p descs are not available\n", chan); + return NULL; + } + chan->desc_free_cnt = chan->desc_free_cnt - desc_cnt; + spin_unlock_bh(&chan->lock); + + dst_avail = sg_dma_len(dst_sg); + src_avail = sg_dma_len(src_sg); + + /* Run until we are out of scatterlist entries */ + while (true) { + /* Allocate and populate the descriptor */ + new = zynqmp_dma_get_descriptor(chan); + desc = (struct zynqmp_dma_desc_ll *)new->src_v; + len = min_t(size_t, src_avail, dst_avail); + len = min_t(size_t, len, ZYNQMP_DMA_MAX_TRANS_LEN); + if (len == 0) + goto fetch; + dma_dst = sg_dma_address(dst_sg) + sg_dma_len(dst_sg) - + dst_avail; + dma_src = sg_dma_address(src_sg) + sg_dma_len(src_sg) - + src_avail; + + zynqmp_dma_config_sg_ll_desc(chan, desc, dma_src, dma_dst, + len, prev); + prev = desc; + dst_avail -= len; + src_avail -= len; + + if (!first) + first = new; + else + list_add_tail(&new->node, &first->tx_list); +fetch: + /* Fetch the next dst scatterlist entry */ + if (dst_avail == 0) { + if (dst_sg_len == 0) + break; + dst_sg = sg_next(dst_sg); + if (dst_sg == NULL) + break; + dst_sg_len--; + dst_avail = sg_dma_len(dst_sg); + } + /* Fetch the next src scatterlist entry */ + if (src_avail == 0) { + if (src_sg_len == 0) + break; + src_sg = sg_next(src_sg); + if (src_sg == NULL) + break; + src_sg_len--; + src_avail = sg_dma_len(src_sg); + } + } + + zynqmp_dma_desc_config_eod(chan, desc); + first->async_tx.flags = flags; + return &first->async_tx; +} + +/** + * zynqmp_dma_chan_remove - Channel remove function + * @chan: ZynqMP DMA channel pointer + */ +static void zynqmp_dma_chan_remove(struct zynqmp_dma_chan *chan) +{ + if (!chan) + return; + + tasklet_kill(&chan->tasklet); + list_del(&chan->common.device_node); +} + +/** + * zynqmp_dma_chan_probe - Per Channel Probing + * @xdev: Driver specific device structure + * @pdev: Pointer to the platform_device structure + * + * Return: '0' on success and failure value on error + */ +static int zynqmp_dma_chan_probe(struct zynqmp_dma_device *xdev, + struct platform_device *pdev) +{ + struct zynqmp_dma_chan *chan; + struct resource *res; + struct device_node *node = pdev->dev.of_node; + int err; + + chan = devm_kzalloc(xdev->dev, sizeof(*chan), GFP_KERNEL); + if (!chan) + return -ENOMEM; + chan->dev = xdev->dev; + chan->xdev = xdev; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + chan->regs = devm_ioremap_resource(&pdev->dev, res); + if (IS_ERR(chan->regs)) + return PTR_ERR(chan->regs); + + chan->bus_width = ZYNQMP_DMA_BUS_WIDTH_64; + chan->src_issue = SRC_ISSUE_RST_VAL; + chan->dst_burst_len = AWLEN_RST_VAL; + chan->src_burst_len = ARLEN_RST_VAL; + chan->dst_axi_cache = AWCACHE_RST_VAL; + chan->src_axi_cache = ARCACHE_RST_VAL; + err = of_property_read_u32(node, "xlnx,bus-width", &chan->bus_width); + if ((err < 0) && ((chan->bus_width != ZYNQMP_DMA_BUS_WIDTH_64) || + (chan->bus_width != ZYNQMP_DMA_BUS_WIDTH_128))) { + dev_err(xdev->dev, "invalid bus-width value"); + return err; + } + chan->has_sg = of_property_read_bool(node, "xlnx,include-sg"); + chan->ovrfetch = of_property_read_bool(node, "xlnx,overfetch"); + chan->desc_axi_cohrnt = + of_property_read_bool(node, "xlnx,desc-axi-cohrnt"); + chan->src_axi_cohrnt = + of_property_read_bool(node, "xlnx,src-axi-cohrnt"); + chan->dst_axi_cohrnt = + of_property_read_bool(node, "xlnx,dst-axi-cohrnt"); + + of_property_read_u32(node, "xlnx,desc-axi-qos", &chan->desc_axi_qos); + of_property_read_u32(node, "xlnx,desc-axi-cache", + &chan->desc_axi_cache); + of_property_read_u32(node, "xlnx,src-axi-qos", &chan->src_axi_qos); + of_property_read_u32(node, "xlnx,src-axi-cache", &chan->src_axi_cache); + of_property_read_u32(node, "xlnx,dst-axi-qos", &chan->dst_axi_qos); + of_property_read_u32(node, "xlnx,dst-axi-cache", &chan->dst_axi_cache); + of_property_read_u32(node, "xlnx,src-burst-len", &chan->src_burst_len); + of_property_read_u32(node, "xlnx,dst-burst-len", &chan->dst_burst_len); + of_property_read_u32(node, "xlnx,ratectrl", &chan->ratectrl); + of_property_read_u32(node, "xlnx,src-issue", &chan->src_issue); + + xdev->chan = chan; + tasklet_init(&chan->tasklet, zynqmp_dma_do_tasklet, (ulong)chan); + spin_lock_init(&chan->lock); + INIT_LIST_HEAD(&chan->active_list); + INIT_LIST_HEAD(&chan->pending_list); + INIT_LIST_HEAD(&chan->done_list); + INIT_LIST_HEAD(&chan->free_list); + + dma_cookie_init(&chan->common); + chan->common.device = &xdev->common; + list_add_tail(&chan->common.device_node, &xdev->common.channels); + + zynqmp_dma_init(chan); + chan->irq = platform_get_irq(pdev, 0); + if (chan->irq < 0) + return -ENXIO; + err = devm_request_irq(&pdev->dev, chan->irq, zynqmp_dma_irq_handler, 0, + "zynqmp-dma", chan); + if (err) + return err; + + chan->desc_size = sizeof(struct zynqmp_dma_desc_ll); + return 0; +} + +/** + * of_zynqmp_dma_xlate - Translation function + * @dma_spec: Pointer to DMA specifier as found in the device tree + * @ofdma: Pointer to DMA controller data + * + * Return: DMA channel pointer on success and NULL on error + */ +static struct dma_chan *of_zynqmp_dma_xlate(struct of_phandle_args *dma_spec, + struct of_dma *ofdma) +{ + struct zynqmp_dma_device *xdev = ofdma->of_dma_data; + + return dma_get_slave_channel(&xdev->chan->common); +} + +/** + * zynqmp_dma_probe - Driver probe function + * @pdev: Pointer to the platform_device structure + * + * Return: '0' on success and failure value on error + */ +static int zynqmp_dma_probe(struct platform_device *pdev) +{ + struct zynqmp_dma_device *xdev; + struct dma_device *p; + int ret; + + xdev = devm_kzalloc(&pdev->dev, sizeof(*xdev), GFP_KERNEL); + if (!xdev) + return -ENOMEM; + + xdev->dev = &pdev->dev; + INIT_LIST_HEAD(&xdev->common.channels); + + dma_set_mask(&pdev->dev, DMA_BIT_MASK(44)); + dma_cap_set(DMA_SG, xdev->common.cap_mask); + dma_cap_set(DMA_MEMCPY, xdev->common.cap_mask); + + p = &xdev->common; + p->device_prep_dma_sg = zynqmp_dma_prep_sg; + p->device_prep_dma_memcpy = zynqmp_dma_prep_memcpy; + p->device_terminate_all = zynqmp_dma_device_terminate_all; + p->device_issue_pending = zynqmp_dma_issue_pending; + p->device_alloc_chan_resources = zynqmp_dma_alloc_chan_resources; + p->device_free_chan_resources = zynqmp_dma_free_chan_resources; + p->device_tx_status = zynqmp_dma_tx_status; + p->dev = &pdev->dev; + + platform_set_drvdata(pdev, xdev); + + ret = zynqmp_dma_chan_probe(xdev, pdev); + if (ret) { + dev_err(&pdev->dev, "Probing channel failed\n"); + goto free_chan_resources; + } + + p->dst_addr_widths = xdev->chan->bus_width / 8; + p->src_addr_widths = xdev->chan->bus_width / 8; + + dma_async_device_register(&xdev->common); + + ret = of_dma_controller_register(pdev->dev.of_node, + of_zynqmp_dma_xlate, xdev); + if (ret) { + dev_err(&pdev->dev, "Unable to register DMA to DT\n"); + dma_async_device_unregister(&xdev->common); + goto free_chan_resources; + } + + dev_info(&pdev->dev, "ZynqMP DMA driver Probe success\n"); + + return 0; + +free_chan_resources: + zynqmp_dma_chan_remove(xdev->chan); + return ret; +} + +/** + * zynqmp_dma_remove - Driver remove function + * @pdev: Pointer to the platform_device structure + * + * Return: Always '0' + */ +static int zynqmp_dma_remove(struct platform_device *pdev) +{ + struct zynqmp_dma_device *xdev = platform_get_drvdata(pdev); + + of_dma_controller_free(pdev->dev.of_node); + dma_async_device_unregister(&xdev->common); + + zynqmp_dma_chan_remove(xdev->chan); + + return 0; +} + +static const struct of_device_id zynqmp_dma_of_match[] = { + { .compatible = "xlnx,zynqmp-dma-1.0", }, + {} +}; +MODULE_DEVICE_TABLE(of, zynqmp_dma_of_match); + +static struct platform_driver zynqmp_dma_driver = { + .driver = { + .name = "xilinx-zynqmp-dma", + .of_match_table = zynqmp_dma_of_match, + }, + .probe = zynqmp_dma_probe, + .remove = zynqmp_dma_remove, +}; + +module_platform_driver(zynqmp_dma_driver); + +MODULE_AUTHOR("Xilinx, Inc."); +MODULE_DESCRIPTION("Xilinx ZynqMP DMA driver"); +MODULE_LICENSE("GPL");