From patchwork Mon Mar 18 06:38:51 2024 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Inochi Amaoto X-Patchwork-Id: 13595051 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.133]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.lore.kernel.org (Postfix) with ESMTPS id 19406C54E58 for ; Mon, 18 Mar 2024 06:39:41 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20210309; h=Sender: Content-Transfer-Encoding:Content-Type:List-Subscribe:List-Help:List-Post: List-Archive:List-Unsubscribe:List-Id:MIME-Version:References:In-Reply-To: Message-ID:Date:Subject:Cc:To:From:Reply-To:Content-ID:Content-Description: Resent-Date:Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID: List-Owner; bh=9OZrF4zsEPtKDbb5z5/M2ZtjbDcZtAvBgGN5aGgmC6E=; b=SdSx3JZ9F21Q3S BX7d5/w+s+3Hx98tbeGI0J9hCyavd+5zWRejpeHQY27laCXZCT9RW4hVWbRilDt5aB74OoMPedSjc 0oqtX+7IvMkf20edIkR7pth51Xi6djI2mMqMNKDb/tyYavs+BXBKzU0L9wnW4gXrJNV0inWBp2c43 alQikfwyCWBYZd0BiMl+SdmsPFkC9OsKTszb2b2WLqXxbgEI4tBj/2R48oC3jPLaZkayzidPNywNl Hb44UW9u8O9J6uwQCCEiyHt2UcKp6J0le0z8HHxW00fYFOwB0wdf8VemE/2jgdru4yHL/xS0IEEkO CKntpEZlYtdZklEXgchw==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.97.1 #2 (Red Hat Linux)) id 1rm6em-00000007Uiv-30ez; Mon, 18 Mar 2024 06:39:36 +0000 Received: from mail-bn7nam10olkn20800.outbound.protection.outlook.com ([2a01:111:f403:2804::800] helo=NAM10-BN7-obe.outbound.protection.outlook.com) by bombadil.infradead.org with esmtps (Exim 4.97.1 #2 (Red Hat Linux)) id 1rm6eh-00000007UZB-2mfT for linux-riscv@lists.infradead.org; Mon, 18 Mar 2024 06:39:34 +0000 ARC-Seal: i=1; a=rsa-sha256; s=arcselector9901; d=microsoft.com; cv=none; b=WedTzBz980Jjprz+lTuM1g5E4uXT+ZTPNyf391fkveaOnKVyKZaGZg3glO9ENL9tAhfCBz3piL69R/ZYj+a1M970ZX5A6i4eSW0ggI/xkYRhSfttHxzjQLhhghmIdwPA5qlJumnjM4dJrQGjvT+k3w1ZbneBKpoJCLt6XV0c9KFjJMPhVBbvy7ad3hAhF34tx771XDbgQg5sDTqZ4emjnvIe/n2fzV7oYmGv2lRsqjGY/soCcR6ePU++/fKunVizzMjyCbuedkhnIgjfbLHLV28xXqGS7wMP66sNgukj8lhCpetl0lsI5DWkVOCbXnN7rXcgGl18jdzusBGArKnmZA== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=microsoft.com; s=arcselector9901; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-AntiSpam-MessageData-ChunkCount:X-MS-Exchange-AntiSpam-MessageData-0:X-MS-Exchange-AntiSpam-MessageData-1; bh=G6pYCSaKfLXkzXMfkQJfkJFlTBHLZWxHB/e4t7eei6s=; b=iixErwYdVSVcDg2DjFREKx9i+6xS6wmgbboUuabpE1acFP3kp/8ami0Bz1P4ip9PznKBdE0D+WzIX9af+9Z4GKSb81eqhG+7B0p0i7Em/kFRakR+m60hCBfaRzfkJ4yW2CZoC6HzJ9FzhuBRckvlFwzraorEdzgIM1/7cwU8qYQbV379F2CVdwfn1focZyR2Mf9ub4bMxiNUs9X5g0Rp/eV5+lFzii+tz4Jio3PNPL3eFCWYyfUzy5sUgvcYTV16h5SUuAKqTrH7fpn+KD6mXPAU2wsjtiTvvQqqefR9N/nSxNzsYNinbzQ5Hp9HIDhybLUTh+yBhbjnJnbUZy0/Bw== ARC-Authentication-Results: i=1; mx.microsoft.com 1; spf=none; dmarc=none; dkim=none; arc=none DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=outlook.com; s=selector1; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=G6pYCSaKfLXkzXMfkQJfkJFlTBHLZWxHB/e4t7eei6s=; b=dxzaaOYsHaWYAvtXyNqDRvKt5sZgijnbTXGPC7Xta8XLBGwAWzZfVjWjJrUJ8SxfTnZwmf6YhNZPZl6RUIQ0UmGWnJy4yFk+7ydp3eMp41uQS1umM2H773/YWzhTp9pknh57LbC028gXsp/UIUPAS7XR36zAWLCD7EY/XPAXfYNqcsjrco/5N2JrYGkDlll2vC1ihK9bM1vf8GHhzg26tfBJYFDF2qfPVHdVRCn06PdgDjWcTOusWJwGhGuBGea9+4FJdPAks0qU8ToDH+ACYhvbvy+s+xgRMtJ2ewgyI1giCPrFgW04+yxRKe9NxgTwpNcY8EGZHvoQIk8Znbg3Xg== Received: from IA1PR20MB4953.namprd20.prod.outlook.com (2603:10b6:208:3af::19) by SN7PR20MB5460.namprd20.prod.outlook.com (2603:10b6:806:2ab::17) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.7386.25; Mon, 18 Mar 2024 06:39:23 +0000 Received: from IA1PR20MB4953.namprd20.prod.outlook.com ([fe80::8615:efe2:7c8e:2041]) by IA1PR20MB4953.namprd20.prod.outlook.com ([fe80::8615:efe2:7c8e:2041%3]) with mapi id 15.20.7386.025; Mon, 18 Mar 2024 06:39:22 +0000 From: Inochi Amaoto To: Vinod Koul , Rob Herring , Krzysztof Kozlowski , Conor Dooley , Chen Wang , Inochi Amaoto , Paul Walmsley , Palmer Dabbelt , Albert Ou Cc: Jisheng Zhang , Liu Gui , Jingbao Qiu , dlan@gentoo.org, dmaengine@vger.kernel.org, devicetree@vger.kernel.org, linux-kernel@vger.kernel.org, linux-riscv@lists.infradead.org Subject: [PATCH v4 4/4] dmaengine: add driver for Sophgo CV18XX/SG200X dmamux Date: Mon, 18 Mar 2024 14:38:51 +0800 Message-ID: X-Mailer: git-send-email 2.44.0 In-Reply-To: References: X-TMN: [7qm0FjB5asIBI6vetYBPR8kdaSYNsdCZLJ2EnNQRv48=] X-ClientProxiedBy: TYCP301CA0074.JPNP301.PROD.OUTLOOK.COM (2603:1096:405:7d::14) To IA1PR20MB4953.namprd20.prod.outlook.com (2603:10b6:208:3af::19) X-Microsoft-Original-Message-ID: <20240318063852.1554712-4-inochiama@outlook.com> MIME-Version: 1.0 X-MS-Exchange-MessageSentRepresentingType: 1 X-MS-PublicTrafficType: Email X-MS-TrafficTypeDiagnostic: IA1PR20MB4953:EE_|SN7PR20MB5460:EE_ X-MS-Office365-Filtering-Correlation-Id: 82558cd3-549a-4900-3413-08dc471625ab X-MS-Exchange-SLBlob-MailProps: 7J/vb0KDx3g6a7F03Qev6MOuCGwUNmfERvbL1B87uliY8ZRwG+wrIeHDOAedME1pjkGmrqmMix19l4z8NMY1kudSPJ7pYxqgCOYE7K42q0R8uhar0Xx7UstHHfBk+IHw44HwLe10w35cM19YJA94itnn+udRNbi9E6bqCbB0dvVc7xojYoYMTQvRvhnbtuiae6+kcOhi6IQDDKEHhbDzfCm6cftV3sIPU+dQYLVPR+MVAR1sAJHVc6FEFwASCA8Gn6EQDCgO0dPT1+O9bol8QwWy7BMuEeKX3f5bknzWPKMJie66WwjeYSIEUjMiZGUMPYF8rjVAPQFaHGJBCD9oh8/sSMxV/CnKaRhKpxPdGD0dCUNEKHbtkNJwWz0+nKLms0SDS/LB43rRHKEPZgY6LjBS2E3kAsHcFRJccbVNdPIPhGBEdYW10KNaODyZKMegwStMCQ+mUoMX2Y7WH1hHCmOnXHAiwjdwqGWtVVHYuApvQW++jRrpTbM85OcO6sBR01xIbo2jTm17Muce/eDOujZUVxKfmO2TSFlcYAtgon7sIqnvJIB7sZYkrvNLa7cFg8rw/FVNcdZVqLMfHBDvQSPz3vbrpe9vPELAwABGIaHX5JpvfAGrOuNxtVF0mdHoidHCgnQW0rcgQkcjZcWOtbL/cBCH6rD4yloH0WCFhvllBYlM7knBJM8VX6yBQhLiOqrhQKkrTF2Sb6i0qJvZYUYINRdHuyrLKps9zNl4m0hTSDHrrmLuZYCgSX72tn9thyJ5PSfJMo/Z5QGObmWiQx39lcwxEk7v/Q7qGEYAnR8= X-Microsoft-Antispam: BCL:0; X-Microsoft-Antispam-Message-Info: 0PTTo1c24djxOBbeEMIs3hJph9zqsk5+on9DYwH7rtf6ajIcXfkudy0F0RFmOoVGuQ4SEsUcnLnUTiIRT47DdvruLVZcM/0ebtrQjg5XA2FkQFuFHmoPOuw22DVfm1lgedar2PRs/U+WWRqubakTCTWrCZCKQg6fBSZA541McA/kNka52+x3l/82vHfnWbrkkHiC3IPpUPBtmqCt/vwXRPS/pvV4HP8xncpcDzpkhggNZxAXUthmD/pmzCqdNsnPKk1bixvjWNM2+gMOjqL+7PJ7xUVLwYPfYSxPBtKjnEpOxLIHAHP239KyMNRx73nnPyXGMttCOJDrumLjQuUIlIxMPvwOdrV23XqrtJu38JlsH2tOpR9OdFL15rXk9wKLQD/WM7h276kq0SI51EIkJ3gyfV452Z4EHUED19jdOMhhSMaYbKvTbbYfo0IRcpegCINohSohPjSdQV+fObW7jrN8FUQV0SlEAmCII2gt7jVjz6V97Ivt7IsrlZsS9mHVs3VqZ9AIMkbEhvkPpiFxtNNAgT/h+PDoCpIKrkXaEhXYLI3cu2cwr8nDMtkI6+fuCaR8PUVpgBzn8ZZscMTXu4g2IURav7dAP3KQPxJofrU9CErXzuCFjewNUBNv/COF X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1 X-MS-Exchange-AntiSpam-MessageData-0: cetwP+yGu8/jJVaEyaWs8XHWY04lIrZr5zEoHyGwcAfBofSXtBxMK7zeyMBLd5yMrvO6d94lp7dPcNXidtVNwJiUwLFhtYboFIHWGt2p18Ep+HBv2m5tfCbcQnPbm7N4Omixsu5SHQii+DFlw8zwsxXOxgbzfL8EeLVd0KcKZ+sNkB1I0Hh2d22iiEQ3ffdyM3sd0TuA/b/4+XStWyjIxyA9kJ2z/VWwed5td84ux9qm08mHDONjBSq0T2BxAgIS7CK4jBpVz7kS80BUGJ+MGE41DQ9K9QGWxC4xm5MBdXN9Yob3IyQ3DWkyQ6RSWLEfsOwWu6ShQlFkae+NIHuU+EmOMKLVnVHjGyL0xgs18DRfftLQzxyKewmnBX5LN69uAFs0rgZ+we74f9wc7OJwjzaMIDZYAPoOFHtLJcoEKawKjHT5rVXLi9p1BgdfGz/FXg8R5xiqG4zNepzYOlvAnGvIJ+pBkzCri4LQngGnwWfGQAmvH2ZMWbjycKkDeWsI5Xq6d+qR3S57pPKBkzjXMKGHOhgGn/c1uyPVNYLfA6GKGOUMDvZG5oHjT4UOBGRG7X74UKeUtt3nEHSXEFvSSea8ChiYuQyfVvc9H+q3ix8xrcNL7OMtjei4TZHhYU1iE2uLdFdZw/aY1fkg7qvVqjPx/E64bUPgHToua2ulUK0XxqG2smZg4xwgOw1DGUxTt1afAFqNYtSlHSwtvKmaoDSYxdNJlTIJpFwDox7nS9TGUhRIHzn9rgJuIVHTgt6Jc0QwiMA5rdki56cNngW/x9KU3Knu46xcjOerDA5W9ce3O3zLrIM7Q7fns08je5PRiAdx2IyNEwB+IKjTlDCDzliR+XiOVIuanW3fiLiQ7g2yaKGVp+dO3hLAlBEWjE5M2EmBNl6xfpm4XhQ+T7vhWeIQKdEXPkqwcxtHGgW0WwxKJooQsn2MXfLMxaI4PTv/CChItuH+F4Gw5j9Z3XfXAWv8mZUveJ9mc+y3+J7ECs4HbGk017Yn9QZht3H685yYhRES50PubRdr/O9kc3GvyMGH8YUK6nnmm4B6VMxUfwyU8PKZaClsmSwxhOuxtwNgWvlmm3VVA3kxIXN4L43Vdre1IHur1LfRcyWcKCoey8kMpTjKNWihR6FiVE+NdK5FY+/FGHNchd2GeDf4gjaOkPoWvVicHbcmzZMUDoNTmgZGONkA20Rnsgr/82D+6EfzGhGC5I8m6eUBJZvw+ixp54PU5Z7FSHVhZVp2dcel0zRzL5oa3qnYSn3N55F26GJx X-OriginatorOrg: outlook.com X-MS-Exchange-CrossTenant-Network-Message-Id: 82558cd3-549a-4900-3413-08dc471625ab X-MS-Exchange-CrossTenant-AuthSource: IA1PR20MB4953.namprd20.prod.outlook.com X-MS-Exchange-CrossTenant-AuthAs: Internal X-MS-Exchange-CrossTenant-OriginalArrivalTime: 18 Mar 2024 06:39:22.9447 (UTC) X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted X-MS-Exchange-CrossTenant-Id: 84df9e7f-e9f6-40af-b435-aaaaaaaaaaaa X-MS-Exchange-CrossTenant-RMS-PersistedConsumerOrg: 00000000-0000-0000-0000-000000000000 X-MS-Exchange-Transport-CrossTenantHeadersStamped: SN7PR20MB5460 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20240317_233932_067057_F8C7E4CD X-CRM114-Status: GOOD ( 16.72 ) X-BeenThere: linux-riscv@lists.infradead.org X-Mailman-Version: 2.1.34 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Sender: "linux-riscv" Errors-To: linux-riscv-bounces+linux-riscv=archiver.kernel.org@lists.infradead.org Sophgo CV18XX/SG200X use DW AXI CORE with a multiplexer for remapping its request lines. The multiplexer supports at most 8 request lines. Add driver for Sophgo CV18XX/SG200X DMA multiplexer. Signed-off-by: Inochi Amaoto --- drivers/dma/Kconfig | 9 ++ drivers/dma/Makefile | 1 + drivers/dma/cv1800-dmamux.c | 232 ++++++++++++++++++++++++++++++++++++ 3 files changed, 242 insertions(+) create mode 100644 drivers/dma/cv1800-dmamux.c -- 2.44.0 diff --git a/drivers/dma/Kconfig b/drivers/dma/Kconfig index 002a5ec80620..cb31520b9f86 100644 --- a/drivers/dma/Kconfig +++ b/drivers/dma/Kconfig @@ -546,6 +546,15 @@ config PLX_DMA These are exposed via extra functions on the switch's upstream port. Each function exposes one DMA channel. +config SOPHGO_CV1800_DMAMUX + tristate "Sophgo CV1800/SG2000 series SoC DMA multiplexer support" + depends on MFD_SYSCON + depends on ARCH_SOPHGO + help + Support for the DMA multiplexer on Sophgo CV1800/SG2000 + series SoCs. + Say Y here if your board have this soc. + config STE_DMA40 bool "ST-Ericsson DMA40 support" depends on ARCH_U8500 diff --git a/drivers/dma/Makefile b/drivers/dma/Makefile index dfd40d14e408..7465f249ee47 100644 --- a/drivers/dma/Makefile +++ b/drivers/dma/Makefile @@ -67,6 +67,7 @@ obj-$(CONFIG_PPC_BESTCOMM) += bestcomm/ obj-$(CONFIG_PXA_DMA) += pxa_dma.o obj-$(CONFIG_RENESAS_DMA) += sh/ obj-$(CONFIG_SF_PDMA) += sf-pdma/ +obj-$(CONFIG_SOPHGO_CV1800_DMAMUX) += cv1800-dmamux.o obj-$(CONFIG_STE_DMA40) += ste_dma40.o ste_dma40_ll.o obj-$(CONFIG_STM32_DMA) += stm32-dma.o obj-$(CONFIG_STM32_DMAMUX) += stm32-dmamux.o diff --git a/drivers/dma/cv1800-dmamux.c b/drivers/dma/cv1800-dmamux.c new file mode 100644 index 000000000000..b41c39f2e338 --- /dev/null +++ b/drivers/dma/cv1800-dmamux.c @@ -0,0 +1,232 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (C) 2023 Inochi Amaoto + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include + +#define DMAMUX_NCELLS 3 +#define MAX_DMA_MAPPING_ID DMA_SPI_NOR1 +#define MAX_DMA_CPU_ID DMA_CPU_C906_1 +#define MAX_DMA_CH_ID 7 + +#define DMAMUX_INTMUX_REGISTER_LEN 4 +#define DMAMUX_NR_CH_PER_REGISTER 4 +#define DMAMUX_BIT_PER_CH 8 +#define DMAMUX_CH_MASk GENMASK(5, 0) +#define DMAMUX_INT_BIT_PER_CPU 10 +#define DMAMUX_CH_UPDATE_BIT BIT(31) + +#define DMAMUX_CH_SET(chid, val) \ + (((val) << ((chid) * DMAMUX_BIT_PER_CH)) | DMAMUX_CH_UPDATE_BIT) +#define DMAMUX_CH_MASK(chid) \ + DMAMUX_CH_SET(chid, DMAMUX_CH_MASk) + +#define DMAMUX_INT_BIT(chid, cpuid) \ + BIT((cpuid) * DMAMUX_INT_BIT_PER_CPU + (chid)) +#define DMAMUX_INTEN_BIT(cpuid) \ + DMAMUX_INT_BIT(8, cpuid) +#define DMAMUX_INT_CH_BIT(chid, cpuid) \ + (DMAMUX_INT_BIT(chid, cpuid) | DMAMUX_INTEN_BIT(cpuid)) +#define DMAMUX_INT_MASK(chid) \ + (DMAMUX_INT_BIT(chid, DMA_CPU_A53) | \ + DMAMUX_INT_BIT(chid, DMA_CPU_C906_0) | \ + DMAMUX_INT_BIT(chid, DMA_CPU_C906_1)) +#define DMAMUX_INT_CH_MASK(chid, cpuid) \ + (DMAMUX_INT_MASK(chid) | DMAMUX_INTEN_BIT(cpuid)) + +struct cv1800_dmamux_data { + struct dma_router dmarouter; + struct regmap *regmap; + spinlock_t lock; + DECLARE_BITMAP(used_chans, MAX_DMA_CH_ID); + DECLARE_BITMAP(mapped_peripherals, MAX_DMA_MAPPING_ID); +}; + +struct cv1800_dmamux_map { + unsigned int channel; + unsigned int peripheral; + unsigned int cpu; +}; + +static void cv1800_dmamux_free(struct device *dev, void *route_data) +{ + struct cv1800_dmamux_data *dmamux = dev_get_drvdata(dev); + struct cv1800_dmamux_map *map = route_data; + u32 regoff = map->channel % DMAMUX_NR_CH_PER_REGISTER; + u32 regpos = map->channel / DMAMUX_NR_CH_PER_REGISTER; + unsigned long flags; + + spin_lock_irqsave(&dmamux->lock, flags); + + regmap_update_bits(dmamux->regmap, + regpos + CV1800_SDMA_DMA_CHANNEL_REMAP0, + DMAMUX_CH_MASK(regoff), + DMAMUX_CH_UPDATE_BIT); + + regmap_update_bits(dmamux->regmap, CV1800_SDMA_DMA_INT_MUX, + DMAMUX_INT_CH_MASK(map->channel, map->cpu), + DMAMUX_INTEN_BIT(map->cpu)); + + clear_bit(map->channel, dmamux->used_chans); + clear_bit(map->peripheral, dmamux->mapped_peripherals); + + spin_unlock_irqrestore(&dmamux->lock, flags); + + kfree(map); +} + +static void *cv1800_dmamux_route_allocate(struct of_phandle_args *dma_spec, + struct of_dma *ofdma) +{ + struct platform_device *pdev = of_find_device_by_node(ofdma->of_node); + struct cv1800_dmamux_data *dmamux = platform_get_drvdata(pdev); + struct cv1800_dmamux_map *map; + unsigned long flags; + unsigned int chid, devid, cpuid; + u32 regoff, regpos; + + if (dma_spec->args_count != DMAMUX_NCELLS) { + dev_err(&pdev->dev, "invalid number of dma mux args\n"); + return ERR_PTR(-EINVAL); + } + + chid = dma_spec->args[0]; + devid = dma_spec->args[1]; + cpuid = dma_spec->args[2]; + dma_spec->args_count -= 2; + + if (chid > MAX_DMA_CH_ID) { + dev_err(&pdev->dev, "invalid channel id: %u\n", chid); + return ERR_PTR(-EINVAL); + } + + if (devid > MAX_DMA_MAPPING_ID) { + dev_err(&pdev->dev, "invalid device id: %u\n", devid); + return ERR_PTR(-EINVAL); + } + + if (cpuid > MAX_DMA_CPU_ID) { + dev_err(&pdev->dev, "invalid cpu id: %u\n", cpuid); + return ERR_PTR(-EINVAL); + } + + dma_spec->np = of_parse_phandle(ofdma->of_node, "dma-masters", 0); + if (!dma_spec->np) { + dev_err(&pdev->dev, "can't get dma master\n"); + return ERR_PTR(-EINVAL); + } + + map = kzalloc(sizeof(*map), GFP_KERNEL); + if (!map) + return ERR_PTR(-ENOMEM); + + map->channel = chid; + map->peripheral = devid; + map->cpu = cpuid; + + regoff = chid % DMAMUX_NR_CH_PER_REGISTER; + regpos = chid / DMAMUX_NR_CH_PER_REGISTER; + + spin_lock_irqsave(&dmamux->lock, flags); + + if (test_and_set_bit(devid, dmamux->mapped_peripherals)) { + dev_err(&pdev->dev, "already used device mapping: %u\n", devid); + goto failed; + } + + if (test_and_set_bit(chid, dmamux->used_chans)) { + clear_bit(devid, dmamux->mapped_peripherals); + dev_err(&pdev->dev, "already used channel id: %u\n", chid); + goto failed; + } + + regmap_set_bits(dmamux->regmap, + regpos + CV1800_SDMA_DMA_CHANNEL_REMAP0, + DMAMUX_CH_SET(regoff, devid)); + + regmap_update_bits(dmamux->regmap, CV1800_SDMA_DMA_INT_MUX, + DMAMUX_INT_CH_MASK(chid, cpuid), + DMAMUX_INT_CH_BIT(chid, cpuid)); + + spin_unlock_irqrestore(&dmamux->lock, flags); + + dev_info(&pdev->dev, "register channel %u for req %u (cpu %u)\n", + chid, devid, cpuid); + + return map; + +failed: + spin_unlock_irqrestore(&dmamux->lock, flags); + dev_err(&pdev->dev, "already used channel id: %u\n", chid); + return ERR_PTR(-EBUSY); +} + +static int cv1800_dmamux_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct device_node *mux_node = dev->of_node; + struct cv1800_dmamux_data *data; + struct device *parent = dev->parent; + struct device_node *dma_master; + struct regmap *map = NULL; + + if (!parent) + return -ENODEV; + + map = device_node_to_regmap(parent->of_node); + if (IS_ERR(map)) + return PTR_ERR(map); + + dma_master = of_parse_phandle(mux_node, "dma-masters", 0); + if (!dma_master) { + dev_err(dev, "invalid dma-requests property\n"); + return -ENODEV; + } + of_node_put(dma_master); + + data = devm_kmalloc(dev, sizeof(*data), GFP_KERNEL); + if (!data) + return -ENOMEM; + + spin_lock_init(&data->lock); + data->regmap = map; + data->dmarouter.dev = dev; + data->dmarouter.route_free = cv1800_dmamux_free; + + platform_set_drvdata(pdev, data); + + return of_dma_router_register(mux_node, + cv1800_dmamux_route_allocate, + &data->dmarouter); +} + +static const struct of_device_id cv1800_dmamux_ids[] = { + { .compatible = "sophgo,cv1800-dmamux", }, + { } +}; +MODULE_DEVICE_TABLE(of, cv1800_dmamux_ids); + +static struct platform_driver cv1800_dmamux_driver = { + .driver = { + .name = "fsl-raideng", + .of_match_table = cv1800_dmamux_ids, + }, + .probe = cv1800_dmamux_probe, +}; +module_platform_driver(cv1800_dmamux_driver); + +MODULE_AUTHOR("Inochi Amaoto "); +MODULE_DESCRIPTION("Sophgo CV1800/SG2000 Series Soc DMAMUX driver"); +MODULE_LICENSE("GPL");