From patchwork Fri Apr 26 16:49:34 2024 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Farouk Bouabid X-Patchwork-Id: 792459 Received: from EUR04-DB3-obe.outbound.protection.outlook.com (mail-db3eur04on2111.outbound.protection.outlook.com [40.107.6.111]) (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 3362D15623A; Fri, 26 Apr 2024 16:50:35 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=fail smtp.client-ip=40.107.6.111 ARC-Seal: i=2; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1714150237; cv=fail; b=sNHUOM3sHVvm5wJjOKd8B+AerNsvRZZ4QCYGDgakytaeZnGt7YaVIUnp53lo6ylQF2YUN72qCHDsD+6ADnMNPEN3+daS9XP/LWWfUfIAvmNZwypH0zHQPjVWNBg62XZ1cMqZhj0w7AIh5i1PU8E6F0QhSn6SkrTZoERHzpL09i8= ARC-Message-Signature: i=2; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1714150237; c=relaxed/simple; bh=G6xpFyd/4ek7XfL1DiLMmmMk47dvIUuh8rr3trU/VUY=; h=From:Date:Subject:Content-Type:Message-Id:References:In-Reply-To: To:Cc:MIME-Version; b=KB1GNLshzQUL0Y+5yw8SXBOapOpDOTce39a/86yiLK24MMSwGpLSpYgy4CHLwodgXqZL9uFE9m7FUw28FY3kDBO6F+N7lxu0W5dRyQ+dSjD0aJa0VLxlkPxh452UYzgMr675JMVWdNiN8NWSlxXw4aByRsvT7cF9UrNdPIBwJu8= ARC-Authentication-Results: i=2; smtp.subspace.kernel.org; dmarc=pass (p=quarantine dis=none) header.from=theobroma-systems.com; spf=pass smtp.mailfrom=theobroma-systems.com; dkim=pass (2048-bit key) header.d=theobroma-systems.com header.i=@theobroma-systems.com header.b=LUC44oMC; arc=fail smtp.client-ip=40.107.6.111 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=quarantine dis=none) header.from=theobroma-systems.com Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=theobroma-systems.com Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=theobroma-systems.com header.i=@theobroma-systems.com header.b="LUC44oMC" ARC-Seal: i=1; a=rsa-sha256; s=arcselector9901; d=microsoft.com; cv=none; b=acqpz69g688Jz4QcoODm8y/EK8upjlqB2q+EodhbxBRXqghqqLbaHpHyC/pnN/635AqxxCD+h6hiiUYjgqnV0tJjXe/cegejbA7bFaIGUewkJtpvkzuAk08eHNAKhJT6/dv2E3dcWZ9gKEMkXkCFJ+HJsi1PxDhkTFAhOGH/coiqW6qy3cMIDbjTsikcNPn5+f36Za+K8ivCWzCt+V++efPZJZOdAz/DVpI06pCfp2FMNVjLnksUfVoafHNVu+SXjx4vOwizFUFqO2qVy2/H3Yl3ptGzjR5Gx8DEjA52vClVdAuGTEKfjnrOQNeS9t0GYWk7eqq/r7d7Pm49Z80tSg== 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=+dIG2BkAXgcQbmkRkmzTuBvQ0ASz8UsVLrstqnA3rAI=; b=AwAngE3JgjfsS1khruOqbZScm/dhmVlKcLJ7NhgEodNvNIyeAuGriv2R5mBvSAtIvUTBv64biaMkOZjGXIYDrhbo5TUGhXSkbsSLALWmU67Hc0zVeXIEOO5x4O/JHornyETGhY9LSBO0sKXYps/Lgr5GjUwlLOLWrXhgF3w9t8DgmQE6fumMvsYSDNuLQF6Peroo4xRjKtGF7ASCOHhcuFbyDnkuBGV/205ZV7/JfeCpjx7kjc+2hy8gdgxfn+Fk003dUUpZs4948beAC2+0KODBm1jv6+uGeRvZL3/lb97n633Yr7RVZiw3HsX8sh6DR1DVVNI1WOAo6Ww4n0oPUw== ARC-Authentication-Results: i=1; mx.microsoft.com 1; spf=pass smtp.mailfrom=theobroma-systems.com; dmarc=pass action=none header.from=theobroma-systems.com; dkim=pass header.d=theobroma-systems.com; arc=none DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=theobroma-systems.com; s=selector1; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=+dIG2BkAXgcQbmkRkmzTuBvQ0ASz8UsVLrstqnA3rAI=; b=LUC44oMCItY3GmJEm+38939SDC4R3DNwDJrtxCYK+cbPjeyA//ADHxtmIeEHMzl/P6RTGfd/9c65t1TcnOoCD1b4spNoml6U6Mb9tfJlW7as6dD5a4V8LovmFKwPfyg+PRLQo1p7cGlzcQTeO26JTeXTCCs1Osgxq+eCdGFf8uLS678iMj45hOjBD4LFlA3PGdY03sVAw6OvAFKTOzER2MJ51uE/dpOHrGea4o/cF0BabvG8QfrZDQYs7f+d4DyZ+g+i7p8aysqJvJkef32irxQgSu2kwQLEg0Qp0aeJIsAmBXFguSqdCFVX4JOJ3FruAf+PiJCBGwWl6VdaLS2nuw== Authentication-Results: dkim=none (message not signed) header.d=none;dmarc=none action=none header.from=theobroma-systems.com; Received: from VE1PR04MB6382.eurprd04.prod.outlook.com (2603:10a6:803:122::31) by VI0PR04MB10230.eurprd04.prod.outlook.com (2603:10a6:800:240::12) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.7472.44; Fri, 26 Apr 2024 16:50:28 +0000 Received: from VE1PR04MB6382.eurprd04.prod.outlook.com ([fe80::59d9:878d:65f0:3936]) by VE1PR04MB6382.eurprd04.prod.outlook.com ([fe80::59d9:878d:65f0:3936%4]) with mapi id 15.20.7472.044; Fri, 26 Apr 2024 16:50:28 +0000 From: Farouk Bouabid Date: Fri, 26 Apr 2024 18:49:34 +0200 Subject: [PATCH 3/7] i2c: muxes: add support for mule i2c multiplexer Message-Id: <20240426-dev-mule-i2c-mux-v1-3-045a482f6ffb@theobroma-systems.com> References: <20240426-dev-mule-i2c-mux-v1-0-045a482f6ffb@theobroma-systems.com> In-Reply-To: <20240426-dev-mule-i2c-mux-v1-0-045a482f6ffb@theobroma-systems.com> To: Wolfram Sang , Peter Rosin , Andi Shyti , Rob Herring , Krzysztof Kozlowski , Conor Dooley , Quentin Schulz , Heiko Stuebner Cc: linux-i2c@vger.kernel.org, linux-kernel@vger.kernel.org, devicetree@vger.kernel.org, linux-arm-kernel@lists.infradead.org, linux-rockchip@lists.infradead.org, Farouk Bouabid X-Mailer: b4 0.13.0 X-ClientProxiedBy: VI1PR08CA0261.eurprd08.prod.outlook.com (2603:10a6:803:dc::34) To VE1PR04MB6382.eurprd04.prod.outlook.com (2603:10a6:803:122::31) Precedence: bulk X-Mailing-List: linux-i2c@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 X-MS-PublicTrafficType: Email X-MS-TrafficTypeDiagnostic: VE1PR04MB6382:EE_|VI0PR04MB10230:EE_ X-MS-Office365-Filtering-Correlation-Id: 73926b75-5b7d-4748-f092-08dc6610fa22 X-MS-Exchange-SenderADCheck: 1 X-MS-Exchange-AntiSpam-Relay: 0 X-Microsoft-Antispam: BCL:0; X-Microsoft-Antispam-Message-Info: =?utf-8?q?gQcqJskI+yHfXCQ5UTU+lrKyuXy/klB?= =?utf-8?q?zFt57DFOEhedXUNoXJ4hk1BijOgSO4gE8BwUZv5Z9sURYws4hwOJ1uopGbi+tomhy?= =?utf-8?q?dXMGhVx7bu8zsocVjzaNV9X8UPIm8DKRkhluRPLe6A9dPRaUpcJGtqXnEkyFbYpze?= =?utf-8?q?/vgWe8PbqMcfwpTXVzU7IH7oX/POKMrV6NGmcSgm/5cNrH6YFKI+taGiA/WNs8dEi?= =?utf-8?q?7pmGQsi+BEqk08n/Xk3dE0utcE9A/sS6/Br3KdWxrhGgEQHuhtAEr+6xFgmM6YM9u?= =?utf-8?q?FfTnE71RtaKff1mV6rfLId8/S140B8UyQDrJDt9NQyGQ78apO1eu0G4TG/9E+/8Wi?= =?utf-8?q?0DkJRd1ujCz4PUwrraKsHO9HV1KSTATsGkdkpXx9GaPcU5RVdM7UBE2OskgMg4yZa?= =?utf-8?q?amOtU2D39F/jusx38rAQVKgDTznIzbyVNeK+r9kG4gLGAQ6UY3F1TFWzY3EEkQBZ7?= =?utf-8?q?NlzhiKEFkGKbZ4bvuMRv61Z2MrgNsdis/OPcUMkhLCONudLgvw+deA8+E/525PtRq?= =?utf-8?q?qlbrX8N/EznMQunx/mEi+wlwYsOhpMhcD0qpZ2CsP3pc5rnTUvBJZyc7hd+wfqveg?= =?utf-8?q?67+EeK915NuIghXTH8jUxuPBIJVroUOzMl8oQuqthc98iRLwUxIV+WBnTZfIirGrW?= =?utf-8?q?1uijf3E2xU5p6TTj5RIOZkXrmstCxuYd2WJ8rnN96YjlBeYngJ+40ZnbmJY7UXBlL?= =?utf-8?q?Myy9QTEXqzY/47DsUlp2dvqgaE22z1yVDsjHo8bp9nckXBhJlQO1I40h1N7E35+4P?= =?utf-8?q?NoO+I+SfRK284lNLt+O+nqCiKoOjZZQjFVSl4VN0IlfVU2Nx+zXcarq2gbzlRPX6M?= =?utf-8?q?bq6u8+ebzaLQ9kdA1UIFxT68pANLraaTo3xhC2aPPkxF04ic9YElgBgaBhnDCx8e1?= =?utf-8?q?OFM15lke2bolIpo3+Ll/eVAw2rgpf3l85FWCtaD5h38Yt8BqhDXb8OCYUDxxFfiFu?= =?utf-8?q?J8y3RAeVtXu+oep2tp16+L99PMyAduhy5n5efxpsTCEu8Z7sfaDnRjIHrQfPfW25M?= =?utf-8?q?1GbC6mNaCGMtI8ZYMQRVYfdi/7jQUsT1b6dGG1GCBD1ai3ajBQS/VtdTNREt1VPPP?= =?utf-8?q?RknigiRk9E6c5hLsyR2U2ArhXqKO1L/rNiXKidt6l2paZrrsL5PhO72wiKaKZrsde?= =?utf-8?q?ly0IWvLbgdhyctLg13ApfCL+8wI1EF1yAC4bDkBeUVedsg2Fb5SDNkEkIVPf3wICv?= =?utf-8?q?wkgUSQmT08p+UJeNr1mBVDdmpMNHurklWZqfOQSnSVJ23kW5gueDO+LDdgx0D5rj9?= =?utf-8?q?ql2iw0WyoR5P3ytTGHV+aAKkaWIDTd2tWow=3D=3D?= X-Forefront-Antispam-Report: CIP:255.255.255.255; CTRY:; LANG:en; SCL:1; SRV:; IPV:NLI; SFV:NSPM; H:VE1PR04MB6382.eurprd04.prod.outlook.com; PTR:; CAT:NONE; SFS:(13230031)(376005)(52116005)(7416005)(1800799015)(366007)(38350700005); DIR:OUT; SFP:1102; X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1 X-MS-Exchange-AntiSpam-MessageData-0: =?utf-8?q?oNvj0Nidlrj7vOTKb/p8uDwPQnHj?= =?utf-8?q?xtSTH/aiyOKbXD8n6mrnm00zHt+J75+yqOxJ3Zx+5AGIlKiERUcT7ZWG1nG3aIyM0?= =?utf-8?q?4vOSJh/y2elCaE9ZuL0uKb8d/6IuZkfvffl2hhY3ypV6wsUwqIm31V47aitTsWNkm?= =?utf-8?q?SXOjdEusG9rVht5Am+dKdzzEVoJ+i87OqX2UKnZw9hkMOublQNNDgz3hRJti0e2Kr?= =?utf-8?q?ZJexJBIQuHAeYkz2vw5Kzg90sfM2mhI+gmB95cr7DAZvOujd10zpct2qptaswsjee?= =?utf-8?q?dCWDZJhgqvFGaSvdNWkI+xKvtjLVMykPywJfwRkk4itB9vnm+yAycJsix3EJgzOOA?= =?utf-8?q?PP/9tw7WJHwrkeiLKVWmFD88sOwtyCHomm2Ap7ZRGfGINIgK21EHArmzxQy5neWUP?= =?utf-8?q?3NihwjZCpx5uSf4hTUlSZqg62p3uXuxjLbddEhf9r39a+8axBXlA6ly0Niujy0qEe?= =?utf-8?q?IT2Yv+TEWY48gQmiqYtrHXuypbaPC83cGzcOjc5/5UAp8UD24hVZOkNuSayvsKfDl?= =?utf-8?q?WKnJGPqnEC1gx2Ev3GhdAHGUryoD7OjypZ88ENJ5xud7tef+mLWd5sD+y3NrW8AhE?= =?utf-8?q?BFeIePyOhxT0isgmjcsUpjMRS69nnYOFCTTn2EDk4yO8tOF8+97wnfckHm8IjqrFL?= =?utf-8?q?pCGWz0V4Dcqn6sf6XA6JYwAzS1ZSiaUSETAN6Q1+sHmJ3r3HmWOOxncvyg+gkL5Ky?= =?utf-8?q?BQGc1LSpAZ4HZjGsnauoUh5VG9cpz5YehrZgaZgIIXBY1DLTj6p5dajUjrBxgSXsv?= =?utf-8?q?+7dMal/rNKUeqE3NHCHMxMrJ56YetzhqF2b1gdLw/ixZgPmZd5Xwkse3vRDbVpRI+?= =?utf-8?q?vS0WWzlGTkb+gGc7R5DE3vl4BvCfc8ftcxEPDyZSm8gxBYHuxYNoVVsPevPbLjExY?= =?utf-8?q?sw4/3ga8h9hi2wBn7yhFdzZ3pL/LuZ69MHDLAF+l/qtVIhBc/0YTWer8AWv+qnEXi?= =?utf-8?q?Xhi3/A+/MxS4uXZP1A+Gquq48cKgcr0WpZfynUh3cDqgF3WMJG5OjhrE45HGVt7TM?= =?utf-8?q?gJGTjlSQzA8FO2PWlSiO6p712RLrrYWnYlZ6XAveObANXw0DofJm7cGLH5aK4HMjD?= =?utf-8?q?XGhv53O6OCETYXmBEOOW+9VeG9Qr+pB8zN8+d6dSLmA0A0opKQacePdwE/HrafKnx?= =?utf-8?q?04I5EeQjmosdn9U4Cp7JRnecMxN2jJBUgLv8saAJ93ltrn/nmA8kua59Rla85aNuC?= =?utf-8?q?XrRWFRC8g8LY7akejd67NrmZ0xB0LJHCGJSrcY0csWNP7SR3C0+DWGTJVEs77Gb50?= =?utf-8?q?eYg/IcYDh7CAqk7Xh7yYgXry8fW6l3r1jkg93DVLAuVJbfBhxh23OG06BJOKPbSmD?= =?utf-8?q?Jbely1HC3stMXj7qrfferxDdNKN0J5WjgVWDHo+inuTebl29a5tfdsGZA4KT4mDFw?= =?utf-8?q?HQU2zVS2h9ELK87DajjYa7TPS/+JA1IPM7SheP01ZMe5lIpWgYVu1KqMkZF+XHo0d?= =?utf-8?q?WQwaRlZWJxm4Xn7mBDTPQ5822rZDPA+80l5ULMDwsrCMDH4M2+s/OgeNXTeAX1g+I?= =?utf-8?q?Fi+Cqc/PUtwo9dsJuovlVIwqeUuJIW0qRhzade/r41iJ9TkueFJWyf0=3D?= X-OriginatorOrg: theobroma-systems.com X-MS-Exchange-CrossTenant-Network-Message-Id: 73926b75-5b7d-4748-f092-08dc6610fa22 X-MS-Exchange-CrossTenant-AuthSource: VE1PR04MB6382.eurprd04.prod.outlook.com X-MS-Exchange-CrossTenant-AuthAs: Internal X-MS-Exchange-CrossTenant-OriginalArrivalTime: 26 Apr 2024 16:50:28.4148 (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: d6HpQ7j4xLdWWVBdM45lnyVMSwXBXj5eUqaEcXYg0I6AMQcnyyDDxd+quU3B0bH53h590v/8DYoUZvMdpLLkyXgGw7JCZNixDvyeYrICWFhxdcTYYrS8F8csj26I3TcP X-MS-Exchange-Transport-CrossTenantHeadersStamped: VI0PR04MB10230 Mule is an mcu that emulates a set of i2c devices which are reacheable through an i2c-mux. The emulated devices share a single i2c address with the mux itself where the requested register is what determines which logic is executed (mux or device): 1- The devices on the mux can be selected (mux function) by writing the appropriate device number to an i2c config register (0xff) that is not used by any device logic. 2- Any access to a register other than the config register will be handled by the previously selected device. Signed-off-by: Farouk Bouabid --- drivers/i2c/muxes/Kconfig | 11 +++ drivers/i2c/muxes/Makefile | 1 + drivers/i2c/muxes/i2c-mux-mule.c | 157 +++++++++++++++++++++++++++++++++++++++ 3 files changed, 169 insertions(+) diff --git a/drivers/i2c/muxes/Kconfig b/drivers/i2c/muxes/Kconfig index db1b9057612a..593a20a6ac51 100644 --- a/drivers/i2c/muxes/Kconfig +++ b/drivers/i2c/muxes/Kconfig @@ -119,4 +119,15 @@ 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 "Mule I2C device multiplexer" + depends on OF + help + If you say yes to this option, support will be included for a + Mule I2C device multiplexer. This driver provides access to + I2C devices connected on the Mule I2C 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..da2a9526522e --- /dev/null +++ b/drivers/i2c/muxes/i2c-mux-mule.c @@ -0,0 +1,157 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Mule I2C device multiplexer + * + * Copyright (C) 2024 Theobroma Systems Design und Consulting GmbH + */ + +#include +#include +#include +#include +#include +#include + +#define MUX_CONFIG_REG 0xff +#define MUX_DEFAULT_DEV 0x0 + +struct mule_i2c_reg_mux { + struct regmap *regmap; +}; + +static const struct regmap_config mule_regmap_config = { + .reg_bits = 8, + .val_bits = 8, +}; + +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 inline int __mux_select(struct regmap *regmap, u32 dev) +{ + return regmap_write(regmap, MUX_CONFIG_REG, dev); +} + +static int mux_select(struct i2c_mux_core *muxc, u32 dev) +{ + struct mule_i2c_reg_mux *mux = muxc->priv; + + return __mux_select(mux->regmap, dev); +} + +static int mux_deselect(struct i2c_mux_core *muxc, u32 dev) +{ + return mux_select(muxc, MUX_DEFAULT_DEV); +} + +static void mux_remove(void *data) +{ + struct i2c_mux_core *muxc = data; + + i2c_mux_del_adapters(muxc); + + mux_deselect(muxc, MUX_DEFAULT_DEV); +} + +static int mule_i2c_mux_probe(struct i2c_client *client) +{ + struct i2c_adapter *adap = client->adapter; + struct mule_i2c_reg_mux *priv; + struct i2c_mux_core *muxc; + struct device_node *dev; + unsigned int readback; + bool old_fw; + int ndev, ret; + + /* Count devices on the mux */ + ndev = of_get_child_count(client->dev.of_node); + dev_dbg(&client->dev, "%u devices on the mux\n", ndev); + + muxc = i2c_mux_alloc(adap, &client->dev, + ndev, sizeof(*priv), + I2C_MUX_LOCKED, + mux_select, mux_deselect); + if (!muxc) + return -ENOMEM; + + muxc->share_addr_with_children = 1; + priv = i2c_mux_priv(muxc); + + priv->regmap = devm_regmap_init_i2c(client, &mule_regmap_config); + if (IS_ERR(priv->regmap)) + return dev_err_probe(&client->dev, PTR_ERR(priv->regmap), + "Failed to allocate i2c register map\n"); + + i2c_set_clientdata(client, muxc); + + /* + * Mux 0 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 = mux_select(muxc, 0); + if (ret) + return ret; + + ret = regmap_read(priv->regmap, MUX_CONFIG_REG, &readback); + if (ret) + return ret; + + old_fw = (readback == 0); + + ret = devm_add_action_or_reset(&client->dev, mux_remove, muxc); + if (ret) + return ret; + + /* Create device adapters */ + for_each_child_of_node(client->dev.of_node, dev) { + u32 reg; + + ret = of_property_read_u32(dev, "reg", ®); + if (ret) { + dev_err(&client->dev, "No reg property found for %s: %d\n", + of_node_full_name(dev), ret); + return ret; + } + + if (!old_fw && reg != 0) { + dev_warn(&client->dev, + "Mux %d not supported, please update Mule FW\n", reg); + continue; + } + + ret = mux_select(muxc, reg); + if (ret) { + dev_warn(&client->dev, + "Mux %d not supported, please update Mule FW\n", reg); + continue; + } + + ret = i2c_mux_add_adapter(muxc, 0, reg, 0); + if (ret) { + dev_err(&client->dev, "Failed to add i2c mux adapter %d: %d\n", reg, ret); + return ret; + } + } + + mux_deselect(muxc, MUX_DEFAULT_DEV); + + return 0; +} + +static struct i2c_driver mule_i2c_mux_driver = { + .driver = { + .name = "mule-i2c-mux", + .of_match_table = mule_i2c_mux_of_match, + }, + .probe = mule_i2c_mux_probe, +}; + +module_i2c_driver(mule_i2c_mux_driver); + +MODULE_AUTHOR("Farouk Bouabid "); +MODULE_DESCRIPTION("I2C mux driver for Mule"); +MODULE_LICENSE("GPL");