From patchwork Fri Sep 6 15:54:13 2024 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Farouk Bouabid X-Patchwork-Id: 13794397 Received: from AS8PR04CU009.outbound.protection.outlook.com (mail-westeuropeazon11011038.outbound.protection.outlook.com [52.101.70.38]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id CE0B81D3634; Fri, 6 Sep 2024 15:55:56 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=fail smtp.client-ip=52.101.70.38 ARC-Seal: i=2; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1725638159; cv=fail; b=ERkD1H6XcoMix2+3W8QY09kTqQ3RkhtARS6UauWwKgYJMTg4jQWxfP+kQyrn52H6Ti7RHOg/VUIF/OAlZfwaRv9Kk1bfAFbTacpDsuEbAYMhkQCgP3/EnDYRfO4bDa8uuiMe7iohXd3XXu5Q/6L9bIhfB/s8KIMgk2pmEsGGQJA= ARC-Message-Signature: i=2; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1725638159; c=relaxed/simple; bh=1vyCn1ZWWjSD8G9/F1mf2hGEqgOz8Sq72Q/WY6p79q0=; h=From:Date:Subject:Content-Type:Message-Id:References:In-Reply-To: To:Cc:MIME-Version; b=A8aNA1Modyjv9ZPKwHruJGcR1/1FPgXPfhldz0nkQlng7linrxwWoX/EsBQUfoC/9ggcHDgnGIjrhYVVnR+SlRauBX8rDrkEj9xsBn1G9fah7Sn0VJxEU8Lx0xNZWsdxETVkdf63xHhPWGBN6QU0JFHZ+O8fZIzrDRLJmtB0iFY= ARC-Authentication-Results: i=2; smtp.subspace.kernel.org; dmarc=pass (p=quarantine dis=none) header.from=cherry.de; spf=pass smtp.mailfrom=cherry.de; dkim=pass (1024-bit key) header.d=cherry.de header.i=@cherry.de header.b=VJbtZtj3; arc=fail smtp.client-ip=52.101.70.38 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=quarantine dis=none) header.from=cherry.de Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=cherry.de Authentication-Results: smtp.subspace.kernel.org; dkim=pass (1024-bit key) header.d=cherry.de header.i=@cherry.de header.b="VJbtZtj3" ARC-Seal: i=1; a=rsa-sha256; s=arcselector10001; d=microsoft.com; cv=none; b=I3r+j2OE65EBQw9MC6lzA35S5x99TxcciMoRMs+Mrdk6hfnUX/EnCMVMO17dgq8p1muQJ4cngghmdgV55omcGIc9jst4QUhf/7KT66PPOo6DKPS2F4meHlJuwESl2ni4L8dm9RIMZ2oLbsAU60r5F1/UqSkWee/THk55ULBoxed+raNnTyeGnsuMJfY4VScg0UexPVOKccwUFGi4MjfX9xEN5cf0Gt18u2OfWgy3k9RB4B3z13V/FMO5Y3Cp0hHVem9wkeDKt2bC/F3PaihwBKWWiW/0sE+x6VvTiC2aHvuoHnriCeNXTQT5IL1D3l4bdH6Bl/PkfSYzbfXewhSS8w== 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=XwKvTt4SUaWenCCppLG1RCHzQEVx5W07pcFqI0wnOLY=; b=jfKsKUd2EKq9BEa7jaYTerd3V+FeOvS5UdU7unoQn7bw8+JCQ3r2kxR16WHrrzjtjAADE2vKicfY2BRC1nZz2PT1Ew8waPUOff3QiaC2IAv1sZrhibqeBAKIAfjlC93D3Es5j3obRWqxYm+Zi7ScHG1fn4q9DfghG4zJayLZDt2Yrsl6D9Hi/YN0u2i3tOW1CT6c0xOVc87FkudEY+B5XPsXVc4sAZS/XvCR3KLtbFICd7Po7gSv01AbFN5kAqzG2k834Btu6YtnL0mIhcO2xbeczp9cM2W2ml53nKJFqoOFsMegnnrFRbG7PyhQp/08rGNhtzI1GVLtD+m7RsjxHQ== ARC-Authentication-Results: i=1; mx.microsoft.com 1; spf=pass smtp.mailfrom=cherry.de; dmarc=pass action=none header.from=cherry.de; dkim=pass header.d=cherry.de; arc=none DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=cherry.de; s=selector1; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=XwKvTt4SUaWenCCppLG1RCHzQEVx5W07pcFqI0wnOLY=; b=VJbtZtj3i76uc82EZunCMaVlTUKKDdiUBofV15vzPmtajbPnf6fyOuSBMskrH8ll4dC2n0gVxn7UVBz/F5ncVahnS69HV3mxfEBw+84z1w7bJ9OuCUioA1o10kTcP/DoyqoTjVpAx3yuP6xK9hPTAfLLeruDgjLLIcjUwWUETtA= Authentication-Results: dkim=none (message not signed) header.d=none;dmarc=none action=none header.from=cherry.de; Received: from DU0PR04MB9562.eurprd04.prod.outlook.com (2603:10a6:10:321::10) by PAXPR04MB8319.eurprd04.prod.outlook.com (2603:10a6:102:1c3::13) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.7939.17; Fri, 6 Sep 2024 15:55:48 +0000 Received: from DU0PR04MB9562.eurprd04.prod.outlook.com ([fe80::ad4d:8d53:1663:d181]) by DU0PR04MB9562.eurprd04.prod.outlook.com ([fe80::ad4d:8d53:1663:d181%6]) with mapi id 15.20.7918.020; Fri, 6 Sep 2024 15:55:48 +0000 From: Farouk Bouabid Date: Fri, 06 Sep 2024 17:54:13 +0200 Subject: [PATCH v8 2/8] i2c: muxes: add support for tsd,mule-i2c multiplexer Message-Id: <20240906-dev-mule-i2c-mux-v8-2-dbd28a150e41@cherry.de> References: <20240906-dev-mule-i2c-mux-v8-0-dbd28a150e41@cherry.de> In-Reply-To: <20240906-dev-mule-i2c-mux-v8-0-dbd28a150e41@cherry.de> To: Andi Shyti , Rob Herring , Krzysztof Kozlowski , Conor Dooley , Farouk Bouabid , Quentin Schulz , Peter Rosin , Jean Delvare , Guenter Roeck , Heiko Stuebner Cc: linux-i2c@vger.kernel.org, devicetree@vger.kernel.org, linux-kernel@vger.kernel.org, linux-hwmon@vger.kernel.org, linux-arm-kernel@lists.infradead.org, linux-rockchip@lists.infradead.org, Wolfram Sang X-Mailer: b4 0.15-dev-77eae X-ClientProxiedBy: VE1PR08CA0022.eurprd08.prod.outlook.com (2603:10a6:803:104::35) To DU0PR04MB9562.eurprd04.prod.outlook.com (2603:10a6:10:321::10) Precedence: bulk X-Mailing-List: linux-hwmon@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 X-MS-PublicTrafficType: Email X-MS-TrafficTypeDiagnostic: DU0PR04MB9562:EE_|PAXPR04MB8319:EE_ X-MS-Office365-Filtering-Correlation-Id: 03200ba2-42b8-462e-de0d-08dcce8c5fdb X-MS-Exchange-SenderADCheck: 1 X-MS-Exchange-AntiSpam-Relay: 0 X-Microsoft-Antispam: BCL:0;ARA:13230040|366016|376014|7416014|1800799024|52116014|921020|38350700014; X-Microsoft-Antispam-Message-Info: =?utf-8?q?sTaSCUZVO68bpuZmGiaboR6oUoxsIWm?= =?utf-8?q?xszAvLv1CJNq4iARZ9gaKs/FJo1/3/jXHziCyX0ESz/EVIfcCgVGhhq6ew7G1/EoR?= =?utf-8?q?nHVYwJKmGpPcbcTzhDKkRXU3HtXclMkoGwzGz8Ti9wpPYc8Cz8PXCqfkyJqSPZHM6?= =?utf-8?q?dmVS3WQAGOjyb0VzzSMB/JjIe1dI2y+PhOgb4LO3t6VeBHKSH5T1hhGEvcgK/LeJe?= =?utf-8?q?dOIiBVckW2n0rBoJvAMsCUS4+35Ek9xiImcnHrYhloHnkQNhUxsa7Hsv763iDP26O?= =?utf-8?q?DGaNZzAyZZaipnzb8R2cNuYGbUIjEHgJgSvhK8Znya37T2lMmHif3co9eAdDDYpnW?= =?utf-8?q?BhB7IklXgizv14NZrTMI+S1VRQ4N2kQcslBK0MZW8ZDdJtEIG+rfqfv7WatjEPrVI?= =?utf-8?q?8PqaMBtRpg92n1eiu8mU1CgmX+j+TB4j9ioJWE7bZnnxjq4jl2PXrVCROmQKEZhYm?= =?utf-8?q?eXtzGL02odk2QgtoQligJxqcYvBrFPQdQddiO9H0MBS3syXDLeluwtmH6oqtlaHiJ?= =?utf-8?q?fYOAD2QIOVTEVWLNe4Iym197tafK0sY3Xg54UaMQwXsp3yQ0x4Fy3hHFIGyjFEjlN?= =?utf-8?q?AlD63NNefSNNNeu4sZ45moitmgoogqoIkuT1QLyyczDwEHdRXIteXXenvHJWf1+WD?= =?utf-8?q?mPPFvklvMgOAPoUVLaiHDEQYfrkGLFASqsDmQOIezxA6dcwqnZCMijFUenEY/7Jcp?= =?utf-8?q?kS6In90LLEWb9v9YbyZ+sytWg7b7/sAVGmB4rgsGwunrwg+aIgksErhV9ieah2LcT?= =?utf-8?q?7fz2bWI7HZqbMbUbxOisAX9NZpVuTTYnn1pnd4pXMGllJA08LzniBy6GKohLZ2zLM?= =?utf-8?q?KZ29rBCLGZjBcBwgTOPyegm1BWteHBUVU6uCORCMPMA5kYIVQx3/YOvWyOZSQJCh1?= =?utf-8?q?Qu7YSEx82Y7MIW3pO+VsBu1/XT0wuPxQJZzqald1c9rBp6Q2IIRIKYxbJqM8OAvHC?= =?utf-8?q?prk3NkIbPMidcDHE+G5zHyd+jJRSK/LTAD9dfXockKyDqEGuO7uVv088D7obL3h5w?= =?utf-8?q?LS5KiwqRdmjQb7cLJ0vemFnFYCTjfMo3biEZlhGSuJcudnu7Eex5Mgcndw8+XThf9?= =?utf-8?q?vmoIdZoLHovu6retQgzaG8YZKbyrClbXiLK1wIcCs02n3IQJr+rJJ5g5jC4Ngd7y2?= =?utf-8?q?MOJulo08jfemRUBfIaJOVHay+IEnh28XnfmkDxuFW4eGxiEgtexvIExGFCkpbiog9?= =?utf-8?q?Vo10aKHXwVO25hVl71NMo6+0/LOv8iEX6y69GpsrYcn62Jc3JqAjSDsH+jm4dZgo1?= =?utf-8?q?LDgycat06c28q3b72jw099bcf5KzHKp/uahNcgCy6ebNzpAYxDX+UbVhMQAmyCLpi?= =?utf-8?q?RVN1lNwVm/V6c5RGVwBpVr54uH8/UVhwFeojI74C8xlwzmy6ykS5s60=3D?= X-Forefront-Antispam-Report: CIP:255.255.255.255;CTRY:;LANG:en;SCL:1;SRV:;IPV:NLI;SFV:NSPM;H:DU0PR04MB9562.eurprd04.prod.outlook.com;PTR:;CAT:NONE;SFS:(13230040)(366016)(376014)(7416014)(1800799024)(52116014)(921020)(38350700014);DIR:OUT;SFP:1101; X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1 X-MS-Exchange-AntiSpam-MessageData-0: =?utf-8?q?HNPHxMiZZB6SVf3rXIEcut5ZQbcW?= =?utf-8?q?SVkOenwHIpFGna8bJvI5fYtw+YOOMcZMsNC9lnkw7+Ip5pwF+TMIPdZf9tCQEEHM0?= =?utf-8?q?RMl0uEgfoz8Zoyuwe9TvXccYmtjdP+3ZCTOUNM74uZr8UlBm2Z6Y+LhtnfuUH6v9w?= =?utf-8?q?fWAtC3yOhruilvGpr/6a6voZSEs+QtQAZfRJ0sChqtql31HYZczbhek0OEhrdJ/Xo?= =?utf-8?q?xQ5OMzYxEesxhq8Loo2gYtbD3nkWi+zwk9bMWw8tFPgnN7GsLFIlxQghez9GpoEPJ?= =?utf-8?q?HgNXu8rjw84T6ZzeNx6D40zZcolrwCsg3RdfuKLzPc7M2BO3BriVUxoPpHKeYcjRS?= =?utf-8?q?BQyBGgI+asiCltrw2gi+HjwI98Ya00hqykS5fB6fxncIBAkY8mtf120C8QA/IzCB1?= =?utf-8?q?e8iTD7pzhIsZgl6vRM0MzYIu7wh1E0T1vUsHcS4fVDBOxg9MGxtlyFECaNYgGICeK?= =?utf-8?q?w6dpJCrI3oK38fl6lg29qyK8U3pNlWui/p865FkBKn1tW4gI3pR2Kzmj3NSdAgbRc?= =?utf-8?q?YO4y8kaip1iR7QOLtH6D+65B8h6xpFGxOhVu26mycIsjPCaBQqstl5scrAKe1Kh9E?= =?utf-8?q?knoAnWH2TCsFZgdv1ge+N8rv9PPO9/3NsTWe6jqSazj+/VF3LfFh8hEN8mztlKwB9?= =?utf-8?q?1CJUhME6WWzxsLt3S65FxCod0zbB+DPmiTZ6vBRDNCzJmVVPAWf6kkRmXz7FEHJFd?= =?utf-8?q?w2H0VYN0CirupyBFN5aSlRPk2qmz1/EVMtpccJ0GgTUtLjKni7Wh3KetGbuA6AOUW?= =?utf-8?q?OKMa0XDIkXylTDao+jOXPzcI+zyQFJKqpxD5Lrtracpkh08WZsXwse8F4uQKXxt9U?= =?utf-8?q?lGejHw71C6EAVoQKmRcQZEnBcXenfxqDjnCnp7TNvD4Gt64zzEzWalmyFYT3j3b62?= =?utf-8?q?A1ASo9NqDw+cjC5iQAyVoT1YM2j2CBTlYuUD0jyRLdZAvTSTsOyZC94c3wr1x/WmX?= =?utf-8?q?fVuCO/3Akl4DgS/zcTbnuY+Ie3C2qo/qxnprbfpPawLqQ5S+QlB9vPxT7S5vZtYuI?= =?utf-8?q?kxxFfa88u//byE214Oq7kZY8g8VWiXnQv6vDecw3UhhcAv7tOht+jbvFt2Y96rqcZ?= =?utf-8?q?h9Hz0oBUuGpc25B5QJrEqf7RvKTsHzct/VlQO3bc4LjYpaoVmC03JRQ2E20H/Zzhb?= =?utf-8?q?Rkp0Um8xxxpwuI1Ath6X4knjTk93m06Bj9SmrV5dxA4czbv/fpmA5qCU1B1UCkwvV?= =?utf-8?q?VJqVYjaQ/TSpSNkgDRYHbz/c9Al78dCxuTn5nMOtPCNjNizHZ5X9dRHFryhBLSJoS?= =?utf-8?q?vYnaCHHNJ5A5FT9z8GUKYvZkFurQrIyf6c01ON9c6pnZStFSE/MdqAgmMDf5WCemA?= =?utf-8?q?eHlDYeYiSdfJzEtB3klD2/9zMb+khDQF6rncQlQQ470aCFdt0V+srxkPEmV5+DlVo?= =?utf-8?q?mbOw1T6jG1JCYbyO0MD9cWKcnz07Jrnn2/+9uVwcDeL2vZvh2wKhoT65M1OrfB4pe?= =?utf-8?q?L6NwEtCkm9NfukIQpTYWd7N2fpp2Ph7uOkm2Br3dkYAxBYY2/OYMLkGBfazomgmtO?= =?utf-8?q?+1TnJJvJS3NDm1vMInXeLjAT8ZkmdxyCxw=3D=3D?= X-OriginatorOrg: cherry.de X-MS-Exchange-CrossTenant-Network-Message-Id: 03200ba2-42b8-462e-de0d-08dcce8c5fdb X-MS-Exchange-CrossTenant-AuthSource: DU0PR04MB9562.eurprd04.prod.outlook.com X-MS-Exchange-CrossTenant-AuthAs: Internal X-MS-Exchange-CrossTenant-OriginalArrivalTime: 06 Sep 2024 15:55:47.9742 (UTC) X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted X-MS-Exchange-CrossTenant-Id: 5e0e1b52-21b5-4e7b-83bb-514ec460677e X-MS-Exchange-CrossTenant-MailboxType: HOSTED X-MS-Exchange-CrossTenant-UserPrincipalName: LLijPfTB4wrJHfq0LA9MduPPLcIvA5ZkmhW5K8bZf0ySzBcvvRlmj78XlGKvLhms8bNyiEnBKq2ix0oD7KlK7vVqUXzPgGJ0iXyVzvTk+xs= X-MS-Exchange-Transport-CrossTenantHeadersStamped: PAXPR04MB8319 Theobroma Systems Mule is an MCU that emulates a set of I2C devices, among which an amc6821 and devices that are reachable through an I2C-mux. The devices on the mux can be selected by writing the appropriate device number to an I2C config register (amc6821 reg 0xff). This driver is expected to be probed as a platform device with amc6821 as its parent i2c device. Add support for the mule-i2c-mux platform driver. The amc6821 driver support for the mux will be added in a later commit. Reviewed-by: Wolfram Sang Signed-off-by: Farouk Bouabid --- drivers/i2c/muxes/Kconfig | 16 +++++ drivers/i2c/muxes/Makefile | 1 + drivers/i2c/muxes/i2c-mux-mule.c | 148 +++++++++++++++++++++++++++++++++++++++ 3 files changed, 165 insertions(+) diff --git a/drivers/i2c/muxes/Kconfig b/drivers/i2c/muxes/Kconfig index db1b9057612a..6d2f66810cdc 100644 --- a/drivers/i2c/muxes/Kconfig +++ b/drivers/i2c/muxes/Kconfig @@ -119,4 +119,20 @@ config I2C_MUX_MLXCPLD This driver can also be built as a module. If so, the module will be called i2c-mux-mlxcpld. +config I2C_MUX_MULE + tristate "Theobroma Systems Mule I2C device multiplexer" + depends on OF && SENSORS_AMC6821 + help + Mule is an MCU that emulates a set of I2C devices, among which + devices that are reachable through an I2C-mux. The devices on the mux + can be selected by writing the appropriate device number to an I2C + configuration register. + + If you say yes to this option, support will be included for a + Theobroma Systems Mule I2C multiplexer. This driver provides access to + I2C devices connected on this mux. + + This driver can also be built as a module. If so, the module + will be called i2c-mux-mule. + endmenu diff --git a/drivers/i2c/muxes/Makefile b/drivers/i2c/muxes/Makefile index 6d9d865e8518..4b24f49515a7 100644 --- a/drivers/i2c/muxes/Makefile +++ b/drivers/i2c/muxes/Makefile @@ -10,6 +10,7 @@ obj-$(CONFIG_I2C_MUX_GPIO) += i2c-mux-gpio.o obj-$(CONFIG_I2C_MUX_GPMUX) += i2c-mux-gpmux.o obj-$(CONFIG_I2C_MUX_LTC4306) += i2c-mux-ltc4306.o obj-$(CONFIG_I2C_MUX_MLXCPLD) += i2c-mux-mlxcpld.o +obj-$(CONFIG_I2C_MUX_MULE) += i2c-mux-mule.o obj-$(CONFIG_I2C_MUX_PCA9541) += i2c-mux-pca9541.o obj-$(CONFIG_I2C_MUX_PCA954x) += i2c-mux-pca954x.o obj-$(CONFIG_I2C_MUX_PINCTRL) += i2c-mux-pinctrl.o diff --git a/drivers/i2c/muxes/i2c-mux-mule.c b/drivers/i2c/muxes/i2c-mux-mule.c new file mode 100644 index 000000000000..8e942470b35f --- /dev/null +++ b/drivers/i2c/muxes/i2c-mux-mule.c @@ -0,0 +1,148 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Theobroma Systems Mule I2C device multiplexer + * + * Copyright (C) 2024 Theobroma Systems Design und Consulting GmbH + */ + +#include +#include +#include +#include +#include +#include +#include + +#define MULE_I2C_MUX_CONFIG_REG 0xff +#define MULE_I2C_MUX_DEFAULT_DEV 0x0 + +struct mule_i2c_reg_mux { + struct regmap *regmap; +}; + +static int mule_i2c_mux_select(struct i2c_mux_core *muxc, u32 dev) +{ + struct mule_i2c_reg_mux *mux = muxc->priv; + + return regmap_write(mux->regmap, MULE_I2C_MUX_CONFIG_REG, dev); +} + +static int mule_i2c_mux_deselect(struct i2c_mux_core *muxc, u32 dev) +{ + return mule_i2c_mux_select(muxc, MULE_I2C_MUX_DEFAULT_DEV); +} + +static void mule_i2c_mux_remove(void *data) +{ + struct i2c_mux_core *muxc = data; + + i2c_mux_del_adapters(muxc); + + mule_i2c_mux_deselect(muxc, MULE_I2C_MUX_DEFAULT_DEV); +} + +static int mule_i2c_mux_probe(struct platform_device *pdev) +{ + struct device *mux_dev = &pdev->dev; + struct mule_i2c_reg_mux *priv; + struct i2c_client *client; + struct i2c_mux_core *muxc; + struct device_node *dev; + unsigned int readback; + int ndev, ret; + bool old_fw; + + /* Count devices on the mux */ + ndev = of_get_child_count(mux_dev->of_node); + dev_dbg(mux_dev, "%d devices on the mux\n", ndev); + + client = to_i2c_client(mux_dev->parent); + + muxc = i2c_mux_alloc(client->adapter, mux_dev, ndev, sizeof(*priv), + I2C_MUX_LOCKED, mule_i2c_mux_select, mule_i2c_mux_deselect); + if (!muxc) + return -ENOMEM; + + priv = i2c_mux_priv(muxc); + + priv->regmap = dev_get_regmap(mux_dev->parent, NULL); + if (IS_ERR(priv->regmap)) + return dev_err_probe(mux_dev, PTR_ERR(priv->regmap), + "No parent i2c register map\n"); + + platform_set_drvdata(pdev, muxc); + + /* + * MULE_I2C_MUX_DEFAULT_DEV is guaranteed to exist on all old and new + * mule fw. Mule fw without mux support will accept write ops to the + * config register, but readback returns 0xff (register not updated). + */ + ret = mule_i2c_mux_select(muxc, MULE_I2C_MUX_DEFAULT_DEV); + if (ret) + return dev_err_probe(mux_dev, ret, + "Failed to write config register\n"); + + ret = regmap_read(priv->regmap, MULE_I2C_MUX_CONFIG_REG, &readback); + if (ret) + return dev_err_probe(mux_dev, ret, + "Failed to read config register\n"); + + old_fw = (readback != MULE_I2C_MUX_DEFAULT_DEV); + + ret = devm_add_action_or_reset(mux_dev, mule_i2c_mux_remove, muxc); + if (ret) + return dev_err_probe(mux_dev, ret, + "Failed to register mux remove\n"); + + /* Create device adapters */ + for_each_child_of_node(mux_dev->of_node, dev) { + u32 reg; + + ret = of_property_read_u32(dev, "reg", ®); + if (ret) + return dev_err_probe(mux_dev, ret, + "No reg property found for %s\n", + of_node_full_name(dev)); + + if (old_fw && reg != 0) { + dev_warn(mux_dev, + "Mux is not supported, please update Mule FW\n"); + continue; + } + + ret = mule_i2c_mux_select(muxc, reg); + if (ret) { + dev_warn(mux_dev, + "Device %d not supported, please update Mule FW\n", reg); + continue; + } + + ret = i2c_mux_add_adapter(muxc, 0, reg); + if (ret) + return ret; + } + + mule_i2c_mux_deselect(muxc, MULE_I2C_MUX_DEFAULT_DEV); + + return 0; +} + +static const struct of_device_id mule_i2c_mux_of_match[] = { + { .compatible = "tsd,mule-i2c-mux", }, + {}, +}; +MODULE_DEVICE_TABLE(of, mule_i2c_mux_of_match); + +static struct platform_driver mule_i2c_mux_driver = { + .driver = { + .name = "mule-i2c-mux", + .of_match_table = mule_i2c_mux_of_match, + }, + .probe = mule_i2c_mux_probe, +}; + +module_platform_driver(mule_i2c_mux_driver); + +MODULE_AUTHOR("Farouk Bouabid "); +MODULE_DESCRIPTION("I2C mux driver for Theobroma Systems Mule"); +MODULE_LICENSE("GPL");