From patchwork Tue Nov 13 08:51:50 2018 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Benjamin Gaignard X-Patchwork-Id: 150968 Delivered-To: patch@linaro.org Received: by 2002:a2e:299d:0:0:0:0:0 with SMTP id p29-v6csp4331201ljp; Tue, 13 Nov 2018 04:19:11 -0800 (PST) X-Google-Smtp-Source: AJdET5cYACJXluRSaxFORCBYBqkW30oHrYg3Km/LqrdyEbzcfXPPl6raePpcNd7Y18f6fKl4N+tn X-Received: by 2002:a50:b2e1:: with SMTP id p88-v6mr3141780edd.155.1542111551460; Tue, 13 Nov 2018 04:19:11 -0800 (PST) ARC-Seal: i=1; a=rsa-sha256; t=1542111551; cv=none; d=google.com; s=arc-20160816; b=FTfZQkW4vL5tTM/y/aykqd29DrUbMFE8EI6RrKtBL0QYSCizrpDtL449zZ1lkzTJ4b yWxhf262fXlatTX70oDHl+yRI+bUB1W9dbk0YUcGdjTHdtYze9d+xrn2nN5qdoc3p7c3 Ak1al6nHq3j8Nc+6ZnSjo8lOoQYlZKBST4ZrZ+hSqWheIqO9fWcMpO1PdHcVzF2rvwvM HGmwmMB0hiDEHdHJ3+vY34mO3AJubgJgBEPBroWNCIUsyfQXMVO4TAf0ohWNTOfdGe9C AzExWFK2D4UEJRQ9RV7pDwXKUEj1C7xUsWBtIuLVlCqOOBgYW8ra8tv4oT65jvzBJkIH qzoQ== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=sender:errors-to:content-transfer-encoding:mime-version :list-subscribe:list-help:list-post:list-archive:list-unsubscribe :list-id:precedence:subject:cc:references:in-reply-to:message-id :date:to:from:dkim-signature; bh=YuOXGnx+gusfEEYmUSqVSZWXa7Lvg3yNg2mQv3i5O6c=; b=cYb6/qrvtIPogg2dBLPB3Den1JP7dDmbZzLvGUbJTiyfuslMXCclzFp378MjIkXadu PhIihF7o+hl/UpkUMPOvErYLbcTITm+qPixLa4XZeFPZ6D2IlcUfnMisUTlDwaCV0uWu 6bQSOl6PB7Hf8mbAaf09pgFTaGfQhwN9yGhdBTglffeZWIplv2D2WZyL5h9xXWqLjCUU ttx+pw5LRJXJFFL0jThQg0Y0BxENPqvcp3h0xmlsXE+DAHetFUmCox6M3HbpvuizL9AU tmlq26LjAeVVp66WYR3IAHiaMMs38bI1r/CMFQ695AU7JLY0bmgbp0TU9xz7iCZG7x+c qzhA== ARC-Authentication-Results: i=1; mx.google.com; dkim=neutral (body hash did not verify) header.i=@linaro.org header.s=google header.b=eD7o7g7d; spf=pass (google.com: best guess record for domain of u-boot-bounces@lists.denx.de designates 81.169.180.215 as permitted sender) smtp.mailfrom=u-boot-bounces@lists.denx.de; dmarc=fail (p=NONE sp=NONE dis=NONE) header.from=linaro.org Return-Path: Received: from lists.denx.de (dione.denx.de. [81.169.180.215]) by mx.google.com with ESMTP id i12si2998566edq.264.2018.11.13.04.19.11; Tue, 13 Nov 2018 04:19:11 -0800 (PST) Received-SPF: pass (google.com: best guess record for domain of u-boot-bounces@lists.denx.de designates 81.169.180.215 as permitted sender) client-ip=81.169.180.215; Authentication-Results: mx.google.com; dkim=neutral (body hash did not verify) header.i=@linaro.org header.s=google header.b=eD7o7g7d; spf=pass (google.com: best guess record for domain of u-boot-bounces@lists.denx.de designates 81.169.180.215 as permitted sender) smtp.mailfrom=u-boot-bounces@lists.denx.de; dmarc=fail (p=NONE sp=NONE dis=NONE) header.from=linaro.org Received: by lists.denx.de (Postfix, from userid 105) id ED891C224F3; Tue, 13 Nov 2018 12:18:01 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on lists.denx.de X-Spam-Level: X-Spam-Status: No, score=0.0 required=5.0 tests=RCVD_IN_MSPIKE_H2, T_DKIM_INVALID autolearn=unavailable autolearn_force=no version=3.4.0 Received: from lists.denx.de (localhost [IPv6:::1]) by lists.denx.de (Postfix) with ESMTP id 6950AC21F4E; Tue, 13 Nov 2018 12:15:34 +0000 (UTC) Received: by lists.denx.de (Postfix, from userid 105) id A6C83C21DCA; Tue, 13 Nov 2018 08:52:05 +0000 (UTC) Received: from mail-wr1-f66.google.com (mail-wr1-f66.google.com [209.85.221.66]) by lists.denx.de (Postfix) with ESMTPS id 51669C21ED5 for ; Tue, 13 Nov 2018 08:52:05 +0000 (UTC) Received: by mail-wr1-f66.google.com with SMTP id p4so3132825wrt.7 for ; Tue, 13 Nov 2018 00:52:05 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; h=from:to:cc:subject:date:message-id:in-reply-to:references; bh=7QP/schaKsjBrzOqMH4l8S1XHL3dKdT8jJfVPxx9QA8=; b=eD7o7g7dXBL08n3fSvB9b9CRHZkkJzdGnjFGJY+jAMPXrmYJP4ubqol5VXZ7Bp1Wdq Jj0ZVC134G1zC26dnxlsPV/CfFngFQb1LWrAUdV98bvs8mu6WWfK9dPe1eeV6E0zq5Ei iqIfRi4t465ql+95YqezVFzSnBSut7H+e1L6A= X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references; bh=7QP/schaKsjBrzOqMH4l8S1XHL3dKdT8jJfVPxx9QA8=; b=p/BFU3xcfZ8tSUqDJJncqMI1eVZ3VCMKtrhFtbsWEVLBLqH1/9fHxyXhcVHts2Zm78 1xOCOAR+hj5k5EIq41QxNeG3bPxmMoidZZvb7fQQ2sufTo2AGXgJ1/IqCDKMUuK2lhxX QM3WHPRROSlsfGItl6ssEehDAb/FlsAO3Oq927wshVJ/KlR7PALEQlJZbT8mpm4mmgwk 4IsrUhcpK0qImwj1EC3+gDkWRX8Vg1XRisUQ5Wa7Szz849eKIcp7X2cpgBDG8CzofH9n kZktx6TDhW61g88zfW5kFaGHjs3wDt5GdMftlbvGu6Zw8ZcyfHfpyZy75+BmDGgOfmbf RItQ== X-Gm-Message-State: AGRZ1gJVpTEBRg9++lCJkhZ31U9WYIb7NFpTZ3ef61pDOuwOyMfSjoi3 QbGDfb0VpnLaahm/PN4LH4gTlw== X-Received: by 2002:adf:e84e:: with SMTP id d14-v6mr4024580wrn.51.1542099124844; Tue, 13 Nov 2018 00:52:04 -0800 (PST) Received: from lmecxl0911.lme.st.com ([2a04:cec0:1047:8145:8cab:bca7:b2f2:d2bb]) by smtp.gmail.com with ESMTPSA id d18-v6sm4235544wre.25.2018.11.13.00.52.03 (version=TLS1_2 cipher=ECDHE-RSA-AES128-SHA bits=128/128); Tue, 13 Nov 2018 00:52:04 -0800 (PST) From: Benjamin Gaignard X-Google-Original-From: Benjamin Gaignard To: patrick.delaunay@st.com, albert.u.boot@aribaud.net, sjg@chromium.org, christophe.kerello@st.com, patrice.chotard@st.com Date: Tue, 13 Nov 2018 09:51:50 +0100 Message-Id: <20181113085151.32368-4-benjamin.gaignard@st.com> X-Mailer: git-send-email 2.15.0 In-Reply-To: <20181113085151.32368-1-benjamin.gaignard@st.com> References: <20181113085151.32368-1-benjamin.gaignard@st.com> X-Mailman-Approved-At: Tue, 13 Nov 2018 12:15:27 +0000 Cc: uboot-stm32@st-md-mailman.stormreply.com, u-boot@lists.denx.de, Benjamin Gaignard Subject: [U-Boot] [PATCH 3/4] hwspinlock: add stm32 hardware spinlock support X-BeenThere: u-boot@lists.denx.de X-Mailman-Version: 2.1.18 Precedence: list List-Id: U-Boot discussion List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , MIME-Version: 1.0 Errors-To: u-boot-bounces@lists.denx.de Sender: "U-Boot" Implement hardware spinlock support for STM32MP1. Signed-off-by: Benjamin Gaignard --- arch/arm/dts/stm32mp157c-ed1.dts | 4 ++ arch/arm/dts/stm32mp157c.dtsi | 9 ++++ configs/stm32mp15_basic_defconfig | 2 + drivers/hwspinlock/Kconfig | 6 +++ drivers/hwspinlock/Makefile | 1 + drivers/hwspinlock/stm32_hwspinlock.c | 90 +++++++++++++++++++++++++++++++++++ 6 files changed, 112 insertions(+) create mode 100644 drivers/hwspinlock/stm32_hwspinlock.c diff --git a/arch/arm/dts/stm32mp157c-ed1.dts b/arch/arm/dts/stm32mp157c-ed1.dts index f8b7701167..fc277dd7d2 100644 --- a/arch/arm/dts/stm32mp157c-ed1.dts +++ b/arch/arm/dts/stm32mp157c-ed1.dts @@ -365,6 +365,10 @@ usb33d-supply = <&usb33>; }; +&hwspinlock { + status = "okay"; +}; + &usbphyc_port0 { phy-supply = <&vdd_usb>; vdda1v1-supply = <®11>; diff --git a/arch/arm/dts/stm32mp157c.dtsi b/arch/arm/dts/stm32mp157c.dtsi index 33c5981869..37cadfa30c 100644 --- a/arch/arm/dts/stm32mp157c.dtsi +++ b/arch/arm/dts/stm32mp157c.dtsi @@ -690,6 +690,15 @@ status = "disabled"; }; + hwspinlock: hwspinlock@4c000000 { + compatible = "st,stm32-hwspinlock"; + #hwlock-cells = <1>; + reg = <0x4c000000 0x400>; + clocks = <&rcc HSEM>; + clock-names = "hwspinlock"; + status = "disabled"; + }; + rcc: rcc@50000000 { compatible = "st,stm32mp1-rcc", "syscon"; reg = <0x50000000 0x1000>; diff --git a/configs/stm32mp15_basic_defconfig b/configs/stm32mp15_basic_defconfig index 3bf7538089..c8409fd04e 100644 --- a/configs/stm32mp15_basic_defconfig +++ b/configs/stm32mp15_basic_defconfig @@ -32,6 +32,8 @@ CONFIG_CMD_EXT4_WRITE=y # CONFIG_SPL_DOS_PARTITION is not set CONFIG_DEFAULT_DEVICE_TREE="stm32mp157c-ev1" CONFIG_STM32_ADC=y +CONFIG_DM_HWSPINLOCK=y +CONFIG_HWSPINLOCK_STM32=y CONFIG_DM_I2C=y CONFIG_SYS_I2C_STM32F7=y CONFIG_LED=y diff --git a/drivers/hwspinlock/Kconfig b/drivers/hwspinlock/Kconfig index de367fd2a9..f28d582bb2 100644 --- a/drivers/hwspinlock/Kconfig +++ b/drivers/hwspinlock/Kconfig @@ -13,4 +13,10 @@ config HWSPINLOCK_SANDBOX can be probed and support all the methods of HWSPINLOCK, but does not really do anything. +config HWSPINLOCK_STM32 + bool "Enable Hardware Spinlock support for STM32" + depends on ARCH_STM32MP && DM_HWSPINLOCK + help + Enable hardware spinlock support in STM32MP. + endmenu diff --git a/drivers/hwspinlock/Makefile b/drivers/hwspinlock/Makefile index 2704d6814f..289b12a256 100644 --- a/drivers/hwspinlock/Makefile +++ b/drivers/hwspinlock/Makefile @@ -4,3 +4,4 @@ obj-$(CONFIG_DM_HWSPINLOCK) += hwspinlock-uclass.o obj-$(CONFIG_HWSPINLOCK_SANDBOX) += sandbox_hwspinlock.o +obj-$(CONFIG_HWSPINLOCK_STM32) += stm32_hwspinlock.o diff --git a/drivers/hwspinlock/stm32_hwspinlock.c b/drivers/hwspinlock/stm32_hwspinlock.c new file mode 100644 index 0000000000..b8f3b1632f --- /dev/null +++ b/drivers/hwspinlock/stm32_hwspinlock.c @@ -0,0 +1,90 @@ +// SPDX-License-Identifier: GPL-2.0+ OR BSD-3-Clause +/* + * Copyright (C) 2018, STMicroelectronics - All Rights Reserved + */ + +#include +#include +#include +#include +#include +#include +#include + +#define STM32_MUTEX_COREID BIT(8) +#define STM32_MUTEX_LOCK_BIT BIT(31) +#define STM32_MUTEX_NUM_LOCKS 32 + +static int stm32mp1_lock(struct udevice *dev, int index) +{ + fdt_addr_t *base = dev_get_priv(dev); + u32 status; + + if (index >= STM32_MUTEX_NUM_LOCKS) + return -EINVAL; + + status = readl(*base + index * sizeof(u32)); + if (status == (STM32_MUTEX_LOCK_BIT | STM32_MUTEX_COREID)) + return -EBUSY; + + writel(STM32_MUTEX_LOCK_BIT | STM32_MUTEX_COREID, + *base + index * sizeof(u32)); + + status = readl(*base + index * sizeof(u32)); + if (status != (STM32_MUTEX_LOCK_BIT | STM32_MUTEX_COREID)) + return -EINVAL; + + return 0; +} + +static int stm32mp1_unlock(struct udevice *dev, int index) +{ + fdt_addr_t *base = dev_get_priv(dev); + + if (index >= STM32_MUTEX_NUM_LOCKS) + return -EINVAL; + + writel(STM32_MUTEX_COREID, *base + index * sizeof(u32)); + + return 0; +} + +static int stm32mp1_hwspinlock_probe(struct udevice *dev) +{ + fdt_addr_t *base = dev_get_priv(dev); + struct clk clk; + int ret; + + *base = dev_read_addr(dev); + if (*base == FDT_ADDR_T_NONE) + return -EINVAL; + + ret = clk_get_by_index(dev, 0, &clk); + if (ret) + return ret; + + ret = clk_enable(&clk); + if (ret) + clk_free(&clk); + + return ret; +} + +static const struct hwspinlock_ops stm32mp1_hwspinlock_ops = { + .lock = stm32mp1_lock, + .unlock = stm32mp1_unlock, +}; + +static const struct udevice_id stm32mp1_hwspinlock_ids[] = { + { .compatible = "st,stm32-hwspinlock" }, + {} +}; + +U_BOOT_DRIVER(hwspinlock_stm32mp1) = { + .name = "hwspinlock_stm32mp1", + .id = UCLASS_HWSPINLOCK, + .of_match = stm32mp1_hwspinlock_ids, + .ops = &stm32mp1_hwspinlock_ops, + .probe = stm32mp1_hwspinlock_probe, + .priv_auto_alloc_size = sizeof(fdt_addr_t), +};