From patchwork Mon Dec 2 22:05:32 2019 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 8bit X-Patchwork-Submitter: =?utf-8?q?Andreas_F=C3=A4rber?= X-Patchwork-Id: 11269981 Return-Path: Received: from mail.kernel.org (pdx-korg-mail-1.web.codeaurora.org [172.30.200.123]) by pdx-korg-patchwork-2.web.codeaurora.org (Postfix) with ESMTP id 845B8930 for ; Mon, 2 Dec 2019 22:06:42 +0000 (UTC) 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 mail.kernel.org (Postfix) with ESMTPS id 5FBE02070B for ; Mon, 2 Dec 2019 22:06:42 +0000 (UTC) Authentication-Results: mail.kernel.org; dkim=pass (2048-bit key) header.d=lists.infradead.org header.i=@lists.infradead.org header.b="ZhIbtiB5" DMARC-Filter: OpenDMARC Filter v1.3.2 mail.kernel.org 5FBE02070B Authentication-Results: mail.kernel.org; dmarc=none (p=none dis=none) header.from=suse.de Authentication-Results: mail.kernel.org; spf=none smtp.mailfrom=linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20170209; h=Sender: Content-Transfer-Encoding:Content-Type:Cc:List-Subscribe:List-Help:List-Post: List-Archive:List-Unsubscribe:List-Id:MIME-Version:References:In-Reply-To: Message-Id:Date:Subject:To:From:Reply-To:Content-ID:Content-Description: Resent-Date:Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID: List-Owner; bh=a2glyl1jhQKhb20uxupHqWkyQMXGzEmd698MtzkC4r8=; b=ZhIbtiB50A4DgD VyfsccZY3M8yD51g40ODMXJv7pI0GUXUc/5zo5z6b2YjdGWAlEGzwnugvg+KE7t6yuYg47G3Re4/V VGDhR4tjuCM372GV7kaL0twSZgDghl6jY3fEI46L/4vbM5JXUvn7V7juY2FVAYgq8WzND5S8l1Ivy PiBXvS8oywc2i2RUxQ72Pud1rZa3tyX082OUxgYBwenQe3naW3TMLwS7NR5MLPdk2sDfzacnq4qwZ OgI88zsErxeOSZKbnI9H9TwGBoJS8Yw0ARFFgdSskNl0zQpyllETkOCXGQ4cZSPrg4bEhjF++5DhL Gd1yY4Hsszz28nPxIHQw==; Received: from localhost ([127.0.0.1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.92.3 #3 (Red Hat Linux)) id 1ibtq4-0000PY-Ef; Mon, 02 Dec 2019 22:06:40 +0000 Received: from mx2.suse.de ([195.135.220.15] helo=mx1.suse.de) by bombadil.infradead.org with esmtps (Exim 4.92.3 #3 (Red Hat Linux)) id 1ibtpD-0007tW-0I; Mon, 02 Dec 2019 22:05:50 +0000 X-Virus-Scanned: by amavisd-new at test-mx.suse.de Received: from relay2.suse.de (unknown [195.135.220.254]) by mx1.suse.de (Postfix) with ESMTP id B9492B2ED; Mon, 2 Dec 2019 22:05:45 +0000 (UTC) From: =?utf-8?q?Andreas_F=C3=A4rber?= To: linux-realtek-soc@lists.infradead.org Subject: [RFC 2/5] hwspinlock: Add Realtek RTD1195 SB2 Date: Mon, 2 Dec 2019 23:05:32 +0100 Message-Id: <20191202220535.6208-3-afaerber@suse.de> X-Mailer: git-send-email 2.16.4 In-Reply-To: <20191202220535.6208-1-afaerber@suse.de> References: <20191202220535.6208-1-afaerber@suse.de> MIME-Version: 1.0 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20191202_140547_335637_3393958F X-CRM114-Status: GOOD ( 13.91 ) X-Spam-Score: -2.3 (--) X-Spam-Report: SpamAssassin version 3.4.2 on bombadil.infradead.org summary: Content analysis details: (-2.3 points) pts rule name description ---- ---------------------- -------------------------------------------------- -2.3 RCVD_IN_DNSWL_MED RBL: Sender listed at https://www.dnswl.org/, medium trust [195.135.220.15 listed in list.dnswl.org] -0.0 SPF_PASS SPF: sender matches SPF record 0.0 SPF_HELO_NONE SPF: HELO does not publish an SPF Record X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.29 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: Ohad Ben-Cohen , Cheng-Yu Lee , linux-remoteproc@vger.kernel.org, linux-kernel@vger.kernel.org, Bjorn Andersson , =?utf-8?q?Andreas_F=C3=A4rber?= , linux-arm-kernel@lists.infradead.org Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org Implement a driver for hardware semaphores found in RTD1195 SoC. It allows for both per-register instances (SB2_HD_SEM) as well as contiguous register ranges (SB2_HD_SEM_NEW[0-7]). While these registers are part of the SB2 syscon, this implementation does not use syscon, to allow assigning one as SB2 syscon's hwlock. Cc: Cheng-Yu Lee Signed-off-by: Andreas Färber --- drivers/hwspinlock/Kconfig | 11 ++++ drivers/hwspinlock/Makefile | 1 + drivers/hwspinlock/rtd1195_sb2_sem.c | 101 +++++++++++++++++++++++++++++++++++ 3 files changed, 113 insertions(+) create mode 100644 drivers/hwspinlock/rtd1195_sb2_sem.c diff --git a/drivers/hwspinlock/Kconfig b/drivers/hwspinlock/Kconfig index 37740e992cfa..9c26c436d399 100644 --- a/drivers/hwspinlock/Kconfig +++ b/drivers/hwspinlock/Kconfig @@ -28,6 +28,17 @@ config HWSPINLOCK_QCOM If unsure, say N. +config HWSPINLOCK_RTD1195_SB2 + tristate "Realtek RTD1195 SB2 Hardware Spinlock device" + depends on HWSPINLOCK + depends on ARCH_REALTEK || COMPILE_TEST + default ARCH_REALTEK + help + Say y here to support the Realtek Hardware Semaphore functionality, + found on the RTD1195 and later SoC families. + + If unsure, say N. + config HWSPINLOCK_SIRF tristate "SIRF Hardware Spinlock device" depends on HWSPINLOCK diff --git a/drivers/hwspinlock/Makefile b/drivers/hwspinlock/Makefile index ed053e3f02be..d5bd59412468 100644 --- a/drivers/hwspinlock/Makefile +++ b/drivers/hwspinlock/Makefile @@ -6,6 +6,7 @@ obj-$(CONFIG_HWSPINLOCK) += hwspinlock_core.o obj-$(CONFIG_HWSPINLOCK_OMAP) += omap_hwspinlock.o obj-$(CONFIG_HWSPINLOCK_QCOM) += qcom_hwspinlock.o +obj-$(CONFIG_HWSPINLOCK_RTD1195_SB2) += rtd1195_sb2_sem.o obj-$(CONFIG_HWSPINLOCK_SIRF) += sirf_hwspinlock.o obj-$(CONFIG_HWSPINLOCK_SPRD) += sprd_hwspinlock.o obj-$(CONFIG_HWSPINLOCK_STM32) += stm32_hwspinlock.o diff --git a/drivers/hwspinlock/rtd1195_sb2_sem.c b/drivers/hwspinlock/rtd1195_sb2_sem.c new file mode 100644 index 000000000000..ae925d057874 --- /dev/null +++ b/drivers/hwspinlock/rtd1195_sb2_sem.c @@ -0,0 +1,101 @@ +// SPDX-License-Identifier: GPL-2.0-or-later +/* + * RTD1195 SB2 hardware semaphore + * + * Copyright (c) 2019 Andreas Färber + */ + +#include +#include +#include +#include +#include +#include +#include +#include + +#include "hwspinlock_internal.h" + +struct rtd1195_sb2_sem { + struct platform_device *pdev; + void __iomem *base; + int base_id; + struct hwspinlock_device lockdev; +}; + +static DEFINE_IDR(rtd1195_sb2_sem_idr); + +static int rtd1195_sb2_sem_trylock(struct hwspinlock *lock) +{ + void __iomem *reg = (void __iomem *)lock->priv; + + return readl_relaxed(reg) & BIT(0); +} + +static void rtd1195_sb2_sem_unlock(struct hwspinlock *lock) +{ + void __iomem *reg = (void __iomem *)lock->priv; + + writel_relaxed(0, reg); +} + +static const struct hwspinlock_ops rtd1195_sb2_sem_hwspinlock_ops = { + .trylock = rtd1195_sb2_sem_trylock, + .unlock = rtd1195_sb2_sem_unlock, +}; + +static int rtd1195_sb2_sem_probe(struct platform_device *pdev) +{ + struct rtd1195_sb2_sem *sem; + struct hwspinlock *lock; + struct resource *res; + int i, num; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + if (!res) + return -ENOMEM; + + num = resource_size(res) / 4; + + sem = devm_kzalloc(&pdev->dev, sizeof(*sem) + num * sizeof(*lock), + GFP_KERNEL); + if (!sem) + return -ENOMEM; + + sem->pdev = pdev; + + sem->base = of_iomap(pdev->dev.of_node, 0); + if (!sem->base) + return -ENOMEM; + + for (i = 0; i < num; i++) { + lock = &sem->lockdev.lock[i]; + lock->priv = sem->base + i * 4; + } + + platform_set_drvdata(pdev, sem); + + sem->base_id = idr_alloc(&rtd1195_sb2_sem_idr, sem, 0, 0, GFP_KERNEL); + + return devm_hwspin_lock_register(&pdev->dev, &sem->lockdev, + &rtd1195_sb2_sem_hwspinlock_ops, sem->base_id, num); +} + +static const struct of_device_id rtd1195_sb2_sem_dt_ids[] = { + { .compatible = "realtek,rtd1195-sb2-sem" }, + { } +}; +MODULE_DEVICE_TABLE(of, rtd1195_sb2_sem_dt_ids); + +static struct platform_driver rtd1195_sb2_sem_platform_driver = { + .driver = { + .name = "rtd1195-sb2-sem", + .of_match_table = rtd1195_sb2_sem_dt_ids, + }, + .probe = rtd1195_sb2_sem_probe, +}; +module_platform_driver(rtd1195_sb2_sem_platform_driver); + +MODULE_LICENSE("GPL"); +MODULE_DESCRIPTION("Hardware spinlock driver for Realtek RTD1195 SB2"); +MODULE_AUTHOR("Andreas Färber ");