From patchwork Sun Feb 2 00:49:13 2025 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Peng Fan X-Patchwork-Id: 13956406 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 23DF6C0218A for ; Sun, 2 Feb 2025 00:54:34 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20210309; h=Sender:List-Subscribe:List-Help :List-Post:List-Archive:List-Unsubscribe:List-Id:MIME-Version:Cc:To: In-Reply-To:References:Message-Id:Content-Transfer-Encoding:Content-Type: Subject:Date:From:Reply-To:Content-ID:Content-Description:Resent-Date: Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:List-Owner; bh=dnRdHsxaAcViRTPEQfvHw+sWedtBw21f/M59VsQkyJY=; b=d+KTOwLJuqKP3tDpQ1jNnAg3GE PJuzPr3QdebS/1Rz/lJtT2mVg8vwDLSXA9kdJ13D9S0tDGv7Wvg/3HykHJUncuyx3NXax89/MRWZg Qb3Za6fOXSB/ApIVOjJMvEz0qV7SoLoGMLr0zUwfveHH3DSTMUI/EXA3m6aWceagGNwGW7kjWKUUb BYOy9NycFcQHhfZhjnZsJjlXhuVKXdKclfXGA+fer3xno3DOq8VYYesJQJe1b+I0Prhcb7Qpc8dNj +6JzsVnoI0PRl+nlhsN8wAGXbZxju0YIBUaZoHqD9mEN+rsVdyH4SVdWh7/R8+KPd+gTMp/V1fjj+ 1HVn8ebg==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.98 #2 (Red Hat Linux)) id 1teOFh-0000000DG1D-0V8S; Sun, 02 Feb 2025 00:54:21 +0000 Received: from mail-norwayeastazlp170130007.outbound.protection.outlook.com ([2a01:111:f403:c20f::7] helo=OSPPR02CU001.outbound.protection.outlook.com) by bombadil.infradead.org with esmtps (Exim 4.98 #2 (Red Hat Linux)) id 1teOBn-0000000DFcp-0Jl3 for linux-arm-kernel@lists.infradead.org; Sun, 02 Feb 2025 00:50:20 +0000 ARC-Seal: i=1; a=rsa-sha256; s=arcselector10001; d=microsoft.com; cv=none; b=DRk7Dvsa9NIkquHJMMZGnmPvhnrzPRBZRGR2TG/E1i4EFjxFzc6a3UDJRjlP8DhmciLSaXMtE/RD9LECrolo6KcDPs1N6MmE7ZF2ZYOv5nsfVZqxQ29Dbu9YS4wvHzdjvfJp64g3Xx7P3a0b1JpqzFG+8DMdnPES4EhWOFKaBMP4Ks7GPefjKtHGfWg49c1yKBOFG3agFLT94Ge5f2Wb5g+LwYYX+86QvdGoENFGg2xvJ4AaddKFEz3V7/3WObIJuCG+yJ36b2zMFb21Ev2TX2hYXO/UFX3ypxtaq3n7bWP/IZwmR/ep9wLOkqYFsOM/SFuFPZPyO6W278cm4lLXPQ== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=microsoft.com; s=arcselector10001; 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=dnRdHsxaAcViRTPEQfvHw+sWedtBw21f/M59VsQkyJY=; b=PrDnGQo/ohDW9XqnbFNGkZEf4v3rzhGROMwoMyYO3rgLUZojPMKIZ/4lIwvIdmoQqaGZnv7z3BToLN9A0HLfasWea8ZMGq4zZO4DOnGyr5V6akKdLu71bK1A2cOllQk556Jv39wqsZM6GdFvaFPtn73WDx4dpxPSvnqqfPwKnWR9t1VRo3k839fYyZSQWTjcEOazJptwpXEcne9UYiOp4ectvaNmLwzmZTH6KSPVj/usZYevjrdxu0NKFm34sDPJY8sVminPjbtVr21j9BusAJcOLMntzMS0PZFlltK65QoD94S9KoE3v+VlAxdl6a7IQ/6hY6C+bIhX5gJVr0NztQ== ARC-Authentication-Results: i=1; mx.microsoft.com 1; spf=pass smtp.mailfrom=oss.nxp.com; dmarc=pass action=none header.from=oss.nxp.com; dkim=pass header.d=oss.nxp.com; arc=none DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=NXP1.onmicrosoft.com; s=selector1-NXP1-onmicrosoft-com; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=dnRdHsxaAcViRTPEQfvHw+sWedtBw21f/M59VsQkyJY=; b=GQgLXqcHjPC2XooX5YsJZ8W0eBbwEPh4Jy+RwgeFJyRJw650JRxvsQF8a8MnJJfJ5F04BFOChM2361r6aVmScY6yvpLwYitSNAWoNnCNPUx7HpfTcB8aXcvv7fZlHT6LTnFmXGoaCS1ZHNDzep1OvnYUBCCk8hk+vHExITYp/3JFSA9lP+QP5q0QyeiEnJE3nnfOt28u6C9GDcrP6ltr5VoOUhu/DtuXe1SjPoKex018Qh/xI24h+5dc9FapVYinBCZcUp2K2N4V45ZS1Fwf3AK3pVcc1dP4TTg/xjzma5D3cp/LNEvXPLn5Pcmz4gHrapkRrukpjaWevAJ3PuFI6A== Authentication-Results: dkim=none (message not signed) header.d=none;dmarc=none action=none header.from=oss.nxp.com; Received: from PAXPR04MB8459.eurprd04.prod.outlook.com (2603:10a6:102:1da::15) by VI1PR04MB9932.eurprd04.prod.outlook.com (2603:10a6:800:1d8::21) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.8398.23; Sun, 2 Feb 2025 00:50:09 +0000 Received: from PAXPR04MB8459.eurprd04.prod.outlook.com ([fe80::165a:30a2:5835:9630]) by PAXPR04MB8459.eurprd04.prod.outlook.com ([fe80::165a:30a2:5835:9630%6]) with mapi id 15.20.8398.021; Sun, 2 Feb 2025 00:50:09 +0000 From: "Peng Fan (OSS)" Date: Sun, 02 Feb 2025 08:49:13 +0800 Subject: [PATCH v7 2/2] nvmem: imx-ocotp-ele: Support accessing controller for i.MX9 Message-Id: <20250202-imx-ocotp-v7-2-5622ba16451d@nxp.com> References: <20250202-imx-ocotp-v7-0-5622ba16451d@nxp.com> In-Reply-To: <20250202-imx-ocotp-v7-0-5622ba16451d@nxp.com> To: Srinivas Kandagatla , Rob Herring , Krzysztof Kozlowski , Conor Dooley , Shawn Guo , Sascha Hauer , Pengutronix Kernel Team , Fabio Estevam , Alexander Stein Cc: devicetree@vger.kernel.org, imx@lists.linux.dev, linux-arm-kernel@lists.infradead.org, linux-kernel@vger.kernel.org, Peng Fan X-Mailer: b4 0.14.2 X-Developer-Signature: v=1; a=ed25519-sha256; t=1738457363; l=9131; i=peng.fan@nxp.com; s=20230812; h=from:subject:message-id; bh=Anv2VHTrQ5YUO8Yumr43PlFx9MaHLgFhhdjS8Z8e8PQ=; b=bSH6+RucaywdNuNKB8F+CLm2LzVD4XQsZWbKpGryj3uYnPJBywod+P55qzB73EYpoPtSo76wK ZzWK8RjEwOEBIzuJS6R5+kX8eDKGtjbhEPgqOBOkeK18Xx8wReyM4lu X-Developer-Key: i=peng.fan@nxp.com; a=ed25519; pk=I4sJg7atIT1g63H7bb5lDRGR2gJW14RKDD0wFL8TT1g= X-ClientProxiedBy: SI1PR02CA0035.apcprd02.prod.outlook.com (2603:1096:4:1f6::8) To PAXPR04MB8459.eurprd04.prod.outlook.com (2603:10a6:102:1da::15) MIME-Version: 1.0 X-MS-Exchange-MessageSentRepresentingType: 1 X-MS-PublicTrafficType: Email X-MS-TrafficTypeDiagnostic: PAXPR04MB8459:EE_|VI1PR04MB9932:EE_ X-MS-Office365-Filtering-Correlation-Id: a1a2bca7-9732-4cdb-e943-08dd43238b22 X-MS-Exchange-SharedMailbox-RoutingAgent-Processed: True X-MS-Exchange-SenderADCheck: 1 X-MS-Exchange-AntiSpam-Relay: 0 X-Microsoft-Antispam: BCL:0;ARA:13230040|7416014|366016|376014|1800799024|52116014|38350700014; X-Microsoft-Antispam-Message-Info: =?utf-8?q?KrIf2pWPuG3OVIwNBkScp9bI7Cs2SUe?= =?utf-8?q?Iaa1q7/qkK815XKOGmO/JVxUyATx61Gs9CAbalMBK71CXTWXkWcIicvhxLLNzhYJI?= =?utf-8?q?CX0peqAlXvu42gU9wy1CCekukEpQu7DgjsTSzP4BLrsScdTYeRfKQaYKt/mIbBK6k?= =?utf-8?q?l7ckliHu/1uWft9mJmUFMCwNoufRlvUlMec4TwSZA/9mRejrYEAbBYP9E2/NlAEeO?= =?utf-8?q?w/eaYsnKokeZRCEdC/3SNOUdq90KaQEozXtNZuR3YvkZPP7eyQSt41UbSGnyjPyEz?= =?utf-8?q?I8QChr0fCjy4SWY+5/PHJ6rWAZMB0AUjp/OHa+IGGty+TkL51hQSMuTKi5o4efHt3?= =?utf-8?q?wfWJJ6MKrcbaXdAOLX0g21YOaMOAoJgMTgiJ/chDVN3yFatbIXRLff59bcvuq/Rac?= =?utf-8?q?rw6FneIGAiRWomFOcq0uJCrld4UxrtmXrC4t5NdlQpnP9WRrmJ4+oornPXTY2Kq7T?= =?utf-8?q?glxz+DObDv7JlB/T4LLVc+E4odOQXO4jDMKl+12owKIS7MuAYGaeH+dhI6K4XCaVY?= =?utf-8?q?MnR7w8mNN1eAS+68oxekAlA7LwtrJ63B4sZZugKGBlNbV+8lQ1lP/vnSmQIYyPmMR?= =?utf-8?q?5Wco85dfslgBUc4Vas7jMM3Un2aCa2Q0WiojuBbzcwhNrA9vHqCn36V3JF3qfIH2v?= =?utf-8?q?B9owQDK8QFWM2aPyONbB6rQZ52CYFlh1l34tCTsu7SnIG5RlRoAep6CxAgu5eLRxy?= =?utf-8?q?vfLnUsKPdzriP4v5intGuQ7GJlMovZqtH7cG9Eay6XPDtTq1TqaRur3nZpPQlfkHv?= =?utf-8?q?22K+S480sfNMSXjVi4gLIr+iGvccZycyfUAdRJmWg+cu+taAYNlMMYXlgIyjupb75?= =?utf-8?q?+ASjn4vC/BbWpWnIYXeDkIET4G6fYw2IFd3eZtXEHBchW7CfLIEcmyRzIuzJ7e09w?= =?utf-8?q?fTdvhS0elufPuzZT2imlBHuoF5KEOL2M7JYnEqlQUGUTYZbQeJuGxMfnUwzHdYoPp?= =?utf-8?q?tgHC8ulE8z/jaIpfqyGPowYpsNuzpRV5OkG8iXDzWw0ZPU61knUvwPfyudmMq45ya?= =?utf-8?q?tueG7AsQP/cbR+lfxHI64mtsCVPceGHccpF7HN+1kk/szZymijLleV2J9HLQVE8LM?= =?utf-8?q?8vEaKuMch4gCGQq+wYIXueIsw0WTH5cGRdPsuk09GC+SSicLV51QWZttnRv/Q239u?= =?utf-8?q?gs6+rfZyMcMXOrHU3MoUNjzK5tMHwwHvBXc45n6K+RV8uBT9uo+KUfMThUptKssmw?= =?utf-8?q?Ttcx81oXqRSJEhKqbW06UZ/CFfXSz5dUA3qdE0V/22KjiQ/85cOTd2dZZbjnaq3p/?= =?utf-8?q?mm0TYJ20F2p+Rs7Vpktb2tU9GFldYhWYneosiqXfLrVWWQlOWLgdrlbDa89j9p/PY?= =?utf-8?q?Oppa8wdzDLdnERbjIQimR2l452TZW59bBBXu6G3cynMBg7Y/HDQG2KvGnBTubWbTh?= =?utf-8?q?L1rUhNLYNZM?= X-Forefront-Antispam-Report: CIP:255.255.255.255;CTRY:;LANG:en;SCL:1;SRV:;IPV:NLI;SFV:NSPM;H:PAXPR04MB8459.eurprd04.prod.outlook.com;PTR:;CAT:NONE;SFS:(13230040)(7416014)(366016)(376014)(1800799024)(52116014)(38350700014);DIR:OUT;SFP:1101; X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1 X-MS-Exchange-AntiSpam-MessageData-0: =?utf-8?q?e6YJLCTqhkRxJ0x8VHQrqITMyX/g?= =?utf-8?q?GsP/TKvQ1fBsZEtG8dfqGzw9n02YiiasKRLgpL0CGESCo3HcwOM7Ze24GTSHhFPLF?= =?utf-8?q?mLoPV+w6ZqMOPoddpQfzHX3O0tx74BALqJLpZeazXLNiaSDfM4TLDKhP+4ZKVIpYf?= =?utf-8?q?6+DBjyPyfIQIgdAl3RHObxuyz6+iq+9UzWj44sh/rfCo2ZzOOIRewrZi1bDkpbSuO?= =?utf-8?q?y3BlTF3c7lO2/0dQ1zrP7MjMSu8CS/pqgkmNV54+Auqkn9FioWHMqKlawTAtnAqj9?= =?utf-8?q?ZUZwv/kz8+rgOhDWSpzyVWq+mNu+BSe//1av6CwOkEL27c0lk/25nj691R6RQOgwQ?= =?utf-8?q?QoM40x2I2iyMKNrVW/3Pp1TUwK6HjG45tuyeK1z67J/XwIHB3wYEICB/ZNH5g971H?= =?utf-8?q?gmG2vZ2mc8vEom2i4KZ1Dx0BlwPGoJuEb6Q4mdR/IukySJIbQxFJ11UCof7nnmXoq?= =?utf-8?q?rnal1Fg2EesW2C8Q/I1v675e/L7syK772gxoMHH0Tp0s9SiqN2wE6Vioyn4zXwvig?= =?utf-8?q?f98hsICyABn3cvCc4FXYE6IV2/gM0njiWcfGp95tofEqzPvonlMIUoE3qHskt1siL?= =?utf-8?q?0d5kTvFhb+rRLEtr5VFYEOYkpbB6wj/03hkXVhjGOXYsc0y1ieRwTQXGPYxAwht5D?= =?utf-8?q?F9J4UJXz3oVwXuvYGb6iEdjxDNuFaBH8Un5EIkn5em3PBxuGFXXpIZ3A7QB9UzvIa?= =?utf-8?q?hVagZeZNRx4I7C4YHSF41pQw9/N/WCJ8JZtxguj98sVLFmq7oKtku5DZNPjKspouM?= =?utf-8?q?qWJmDBqcps6oohyCkZRIi4zAzbNCyn5zGr2jkEUUxTNtuPz1xvuq+AHaPaHJVvHea?= =?utf-8?q?iQNpLHmLSzKEVfGD/NDyoIkp89SaO5xrM5GuqAF+3CRI9Za7FJ73ZswKH5n8xc6Gs?= =?utf-8?q?Yjx1ld9cV9Q5sUyCStZOrJnX5QdLmjtz4bN+pMoTmNqPfw/gmTZuIMc9JjJ/Nct8b?= =?utf-8?q?PVNUqO00HvDddE33vsp28MdPrQoP/3q4iId/PrIqV8ya3qGCmv8dJUBVcNlSryh1K?= =?utf-8?q?GzxXZby5ctdvbsT9Bt5gPzSiy53ZVr06nLwX4jHmzbNz4Tr11TNSvVF8FkwjsCC7n?= =?utf-8?q?JXm+6BJhX+om6evDBCj1Sm9kuIg5FhdlyTPKRPlm69NseYwoxXG/LUYvnWnR4Q4pU?= =?utf-8?q?hFFy1cxRdzqxYvGtL2O6z1uPyNpq3WXzxm1s0E86i6UbW0nX6kRaIuKboLappjIkW?= =?utf-8?q?kvVlpjxJn7DzZFDKbSZnTUntkHOK2+6CdBUNR+8Avh7ffCBgtqwcnU38vWl83UIh+?= =?utf-8?q?UhhShkbw+5RCMQG0AgYn4OX8oX2PMKsLdHRRgVQJP1/37wsEJ8vCTGdF/ClUpU/z1?= =?utf-8?q?X96Q5/7MjGX/iw4J0iqZsyQ9Pi/IpFEYjDVaviNrw55ChOYwibSXYCsN36YAUFOWg?= =?utf-8?q?kP7IqLeACLDz9vcwJxwSgAQ1FMln3+tZPO/4/L6jr/ovczYn1gki5S72+dtmqTCGF?= =?utf-8?q?0YmCf2YcyeMd6odUYhcr6I1pEC7QCUD6vJpePnbGjIK2IJbXBjm+RdeZAXBUAAPZT?= =?utf-8?q?N1DljJV7Fbou?= X-OriginatorOrg: oss.nxp.com X-MS-Exchange-CrossTenant-Network-Message-Id: a1a2bca7-9732-4cdb-e943-08dd43238b22 X-MS-Exchange-CrossTenant-AuthSource: PAXPR04MB8459.eurprd04.prod.outlook.com X-MS-Exchange-CrossTenant-AuthAs: Internal X-MS-Exchange-CrossTenant-OriginalArrivalTime: 02 Feb 2025 00:50:09.4658 (UTC) X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted X-MS-Exchange-CrossTenant-Id: 686ea1d3-bc2b-4c6f-a92c-d99c5c301635 X-MS-Exchange-CrossTenant-MailboxType: HOSTED X-MS-Exchange-CrossTenant-UserPrincipalName: 2/A4gYdEPXYeSbgeuVkPIIaOTRZYwTKRJfbu44tZb8xvtSpclDM0xncoh0elUOc1NYvL9bXKB9jSMT+nj/X+PA== X-MS-Exchange-Transport-CrossTenantHeadersStamped: VI1PR04MB9932 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20250201_165019_124320_56692191 X-CRM114-Status: GOOD ( 19.12 ) X-BeenThere: linux-arm-kernel@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-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org From: Peng Fan i.MX9 OCOTP supports a specific peripheral or function being fused which means disabled, so - Introduce ocotp_access_gates to be container of efuse gate info - Iterate all nodes to check accessing permission. If not allowed to be accessed, detach the node Signed-off-by: Peng Fan --- drivers/nvmem/Kconfig | 3 + drivers/nvmem/imx-ocotp-ele.c | 173 +++++++++++++++++++++++++++++++++++++++++- 2 files changed, 175 insertions(+), 1 deletion(-) diff --git a/drivers/nvmem/Kconfig b/drivers/nvmem/Kconfig index 8671b7c974b933e147154bb40b5d41b5730518d2..77cc496fd5e0e1afd753534b56fe1f5ef3e3ec55 100644 --- a/drivers/nvmem/Kconfig +++ b/drivers/nvmem/Kconfig @@ -93,6 +93,9 @@ config NVMEM_IMX_OCOTP_ELE This is a driver for the On-Chip OTP Controller (OCOTP) available on i.MX SoCs which has ELE. + If built as modules, any other driver relying on this working + as access controller also needs to be a module as well. + config NVMEM_IMX_OCOTP_SCU tristate "i.MX8 SCU On-Chip OTP Controller support" depends on IMX_SCU diff --git a/drivers/nvmem/imx-ocotp-ele.c b/drivers/nvmem/imx-ocotp-ele.c index ca6dd71d8a2e29888c6e556aaea116c1a967cb5f..5f31a3a7530ce942f5abcd51869fcf78cc8409dd 100644 --- a/drivers/nvmem/imx-ocotp-ele.c +++ b/drivers/nvmem/imx-ocotp-ele.c @@ -5,6 +5,8 @@ * Copyright 2023 NXP */ +#include +#include #include #include #include @@ -27,6 +29,7 @@ struct ocotp_map_entry { }; struct ocotp_devtype_data { + const struct ocotp_access_gates *access_gates; u32 reg_off; char *name; u32 size; @@ -36,6 +39,20 @@ struct ocotp_devtype_data { struct ocotp_map_entry entry[]; }; +#define OCOTP_MAX_NUM_GATE_WORDS 4 + +struct access_gate { + u32 word; + u32 mask; +}; + +struct ocotp_access_gates { + u32 num_words; + u32 words[OCOTP_MAX_NUM_GATE_WORDS]; + u32 num_gates; + struct access_gate *gates; +}; + struct imx_ocotp_priv { struct device *dev; void __iomem *base; @@ -131,6 +148,83 @@ static void imx_ocotp_fixup_dt_cell_info(struct nvmem_device *nvmem, cell->read_post_process = imx_ocotp_cell_pp; } +static int imx_ele_ocotp_check_access(struct imx_ocotp_priv *priv, u32 id) +{ + const struct ocotp_access_gates *access_gates = priv->data->access_gates; + void __iomem *reg = priv->base + priv->data->reg_off; + u32 word, mask, val; + + if (id >= access_gates->num_gates) { + dev_err(priv->config.dev, "Index %d too large\n", id); + return -EACCES; + } + + word = access_gates->gates[id].word; + mask = access_gates->gates[id].mask; + + reg = priv->base + priv->data->reg_off + (word << 2); + val = readl(reg); + + dev_dbg(priv->config.dev, "id:%d word:%d mask:0x%08x\n", id, word, mask); + /* true means not allow access */ + if (val & mask) + return -EACCES; + + return 0; +} + +static int imx_ele_ocotp_grant_access(struct imx_ocotp_priv *priv, struct device_node *parent) +{ + struct device *dev = priv->config.dev; + + for_each_available_child_of_node_scoped(parent, child) { + struct of_phandle_args args; + u32 id, idx = 0; + + while (!of_parse_phandle_with_args(child, "access-controllers", + "#access-controller-cells", + idx++, &args)) { + of_node_put(args.np); + if (args.np != dev->of_node) + continue; + + /* Only support one cell */ + if (args.args_count != 1) { + dev_err(dev, "wrong args count\n"); + continue; + } + + id = args.args[0]; + + dev_dbg(dev, "Checking node: %pOF gate: %d\n", child, id); + + if (imx_ele_ocotp_check_access(priv, id)) { + of_detach_node(child); + dev_info(dev, "%pOF: Not granted, device driver will not be probed\n", + child); + } + } + + imx_ele_ocotp_grant_access(priv, child); + } + + return 0; +} + +static int imx_ele_ocotp_access_control(struct imx_ocotp_priv *priv) +{ + struct device_node *root __free(device_node) = of_find_node_by_path("/"); + + if (!priv->data->access_gates) + return 0; + + /* This should never happen */ + if (WARN_ON(!root)) + return -EINVAL; + + return imx_ele_ocotp_grant_access(priv, root); +} + static int imx_ele_ocotp_probe(struct platform_device *pdev) { struct device *dev = &pdev->dev; @@ -161,14 +255,45 @@ static int imx_ele_ocotp_probe(struct platform_device *pdev) priv->config.fixup_dt_cell_info = imx_ocotp_fixup_dt_cell_info; mutex_init(&priv->lock); + platform_set_drvdata(pdev, priv); + nvmem = devm_nvmem_register(dev, &priv->config); if (IS_ERR(nvmem)) return PTR_ERR(nvmem); - return 0; + + return imx_ele_ocotp_access_control(priv); } +struct access_gate imx93_access_gate[] = { + [IMX93_OCOTP_NPU_GATE] = { .word = 19, .mask = BIT(13) }, + [IMX93_OCOTP_A550_GATE] = { .word = 19, .mask = BIT(14) }, + [IMX93_OCOTP_A551_GATE] = { .word = 19, .mask = BIT(15) }, + [IMX93_OCOTP_M33_GATE] = { .word = 19, .mask = BIT(24) }, + [IMX93_OCOTP_CAN1_FD_GATE] = { .word = 19, .mask = BIT(28) }, + [IMX93_OCOTP_CAN2_FD_GATE] = { .word = 19, .mask = BIT(29) }, + [IMX93_OCOTP_CAN1_GATE] = { .word = 19, .mask = BIT(30) }, + [IMX93_OCOTP_CAN2_GATE] = { .word = 19, .mask = BIT(31) }, + [IMX93_OCOTP_USB1_GATE] = { .word = 20, .mask = BIT(3) }, + [IMX93_OCOTP_USB2_GATE] = { .word = 20, .mask = BIT(4) }, + [IMX93_OCOTP_ENET1_GATE] = { .word = 20, .mask = BIT(5) }, + [IMX93_OCOTP_ENET2_GATE] = { .word = 20, .mask = BIT(6) }, + [IMX93_OCOTP_PXP_GATE] = { .word = 20, .mask = BIT(10) }, + [IMX93_OCOTP_MIPI_CSI1_GATE] = { .word = 20, .mask = BIT(17) }, + [IMX93_OCOTP_MIPI_DSI1_GATE] = { .word = 20, .mask = BIT(19) }, + [IMX93_OCOTP_LVDS1_GATE] = { .word = 20, .mask = BIT(24) }, + [IMX93_OCOTP_ADC1_GATE] = { .word = 21, .mask = BIT(7) }, +}; + +static const struct ocotp_access_gates imx93_access_gates_info = { + .num_words = 3, + .words = {19, 20, 21}, + .num_gates = ARRAY_SIZE(imx93_access_gate), + .gates = imx93_access_gate, +}; + static const struct ocotp_devtype_data imx93_ocotp_data = { + .access_gates = &imx93_access_gates_info, .reg_off = 0x8000, .reg_read = imx_ocotp_reg_read, .size = 2048, @@ -183,7 +308,53 @@ static const struct ocotp_devtype_data imx93_ocotp_data = { }, }; +struct access_gate imx95_access_gate[] = { + [IMX95_OCOTP_CANFD1_GATE] = { .word = 17, .mask = BIT(20) }, + [IMX95_OCOTP_CANFD2_GATE] = { .word = 17, .mask = BIT(21) }, + [IMX95_OCOTP_CANFD3_GATE] = { .word = 17, .mask = BIT(22) }, + [IMX95_OCOTP_CANFD4_GATE] = { .word = 17, .mask = BIT(23) }, + [IMX95_OCOTP_CANFD5_GATE] = { .word = 17, .mask = BIT(24) }, + [IMX95_OCOTP_CAN1_GATE] = { .word = 17, .mask = BIT(25) }, + [IMX95_OCOTP_CAN2_GATE] = { .word = 17, .mask = BIT(26) }, + [IMX95_OCOTP_CAN3_GATE] = { .word = 17, .mask = BIT(27) }, + [IMX95_OCOTP_CAN4_GATE] = { .word = 17, .mask = BIT(28) }, + [IMX95_OCOTP_CAN5_GATE] = { .word = 17, .mask = BIT(29) }, + [IMX95_OCOTP_NPU_GATE] = { .word = 18, .mask = BIT(0) }, + [IMX95_OCOTP_A550_GATE] = { .word = 18, .mask = BIT(1) }, + [IMX95_OCOTP_A551_GATE] = { .word = 18, .mask = BIT(2) }, + [IMX95_OCOTP_A552_GATE] = { .word = 18, .mask = BIT(3) }, + [IMX95_OCOTP_A553_GATE] = { .word = 18, .mask = BIT(4) }, + [IMX95_OCOTP_A554_GATE] = { .word = 18, .mask = BIT(5) }, + [IMX95_OCOTP_A555_GATE] = { .word = 18, .mask = BIT(6) }, + [IMX95_OCOTP_M7_GATE] = { .word = 18, .mask = BIT(9) }, + [IMX95_OCOTP_DCSS_GATE] = { .word = 18, .mask = BIT(22) }, + [IMX95_OCOTP_LVDS1_GATE] = { .word = 18, .mask = BIT(27) }, + [IMX95_OCOTP_ISP_GATE] = { .word = 18, .mask = BIT(29) }, + [IMX95_OCOTP_USB1_GATE] = { .word = 19, .mask = BIT(2) }, + [IMX95_OCOTP_USB2_GATE] = { .word = 19, .mask = BIT(3) }, + [IMX95_OCOTP_NETC_GATE] = { .word = 19, .mask = BIT(4) }, + [IMX95_OCOTP_PCIE1_GATE] = { .word = 19, .mask = BIT(6) }, + [IMX95_OCOTP_PCIE2_GATE] = { .word = 19, .mask = BIT(7) }, + [IMX95_OCOTP_ADC1_GATE] = { .word = 19, .mask = BIT(8) }, + [IMX95_OCOTP_EARC_RX_GATE] = { .word = 19, .mask = BIT(11) }, + [IMX95_OCOTP_GPU3D_GATE] = { .word = 19, .mask = BIT(16) }, + [IMX95_OCOTP_VPU_GATE] = { .word = 19, .mask = BIT(17) }, + [IMX95_OCOTP_JPEG_ENC_GATE] = { .word = 19, .mask = BIT(18) }, + [IMX95_OCOTP_JPEG_DEC_GATE] = { .word = 19, .mask = BIT(19) }, + [IMX95_OCOTP_MIPI_CSI1_GATE] = { .word = 19, .mask = BIT(21) }, + [IMX95_OCOTP_MIPI_CSI2_GATE] = { .word = 19, .mask = BIT(22) }, + [IMX95_OCOTP_MIPI_DSI1_GATE] = { .word = 19, .mask = BIT(23) }, +}; + +static const struct ocotp_access_gates imx95_access_gates_info = { + .num_words = 3, + .words = {17, 18, 19}, + .num_gates = ARRAY_SIZE(imx95_access_gate), + .gates = imx95_access_gate, +}; + static const struct ocotp_devtype_data imx95_ocotp_data = { + .access_gates = &imx95_access_gates_info, .reg_off = 0x8000, .reg_read = imx_ocotp_reg_read, .size = 2048,