From nobody Sun Feb 8 06:04:57 2026 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 vger.kernel.org (vger.kernel.org [23.128.96.18]) by smtp.lore.kernel.org (Postfix) with ESMTP id BD212C77B73 for ; Thu, 1 Jun 2023 03:40:28 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S230423AbjFADk1 (ORCPT ); Wed, 31 May 2023 23:40:27 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:54618 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S229527AbjFADkS (ORCPT ); Wed, 31 May 2023 23:40:18 -0400 X-Greylist: delayed 345 seconds by postgrey-1.37 at lindbergh.monkeyblade.net; Wed, 31 May 2023 20:40:13 PDT Received: from mail-m11878.qiye.163.com (mail-m11878.qiye.163.com [115.236.118.78]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id DF1A9128; Wed, 31 May 2023 20:40:13 -0700 (PDT) Received: from localhost.localdomain (unknown [58.22.7.114]) by mail-m11878.qiye.163.com (Hmail) with ESMTPA id F1464740464; Thu, 1 Jun 2023 11:34:24 +0800 (CST) From: David Wu To: wsa@kernel.org, linux-i2c@vger.kernel.org Cc: linux-kernel@vger.kernel.org, Zhang aihui , David Wu Subject: [PATCH] i2c: Devices which have some i2c addr can work in same i2c bus Date: Thu, 1 Jun 2023 11:34:23 +0800 Message-Id: <20230601033423.172021-1-david.wu@rock-chips.com> X-Mailer: git-send-email 2.25.1 MIME-Version: 1.0 Content-Transfer-Encoding: quoted-printable X-HM-Spam-Status: e1kfGhgUHx5ZQUpXWQgPGg8OCBgUHx5ZQUlOS1dZFg8aDwILHllBWSg2Ly tZV1koWUFDSUNOT01LS0k3V1ktWUFJV1kPCRoVCBIfWUFZQk5IGFZMQ0MfTx1NSx5OHx1VEwETFh oSFyQUDg9ZV1kYEgtZQVlOQ1VJSVVMVUpKT1lXWRYaDxIVHRRZQVlPS0hVSkpLQ0hJVUpLS1VLWQ Y+ X-HM-Tid: 0a8875055a412eb4kusnf1464740464 X-HM-MType: 1 X-HM-Sender-Digest: e1kMHhlZQR0aFwgeV1kSHx4VD1lBWUc6Ny46Szo6Lz1DIjhLGRcsHz8x EEkwCw5VSlVKTUNOTkJLT01OTU5IVTMWGhIXVR8aDRIfVQwOOwkUGBBWGBMSCwhVGBQWRVlXWRIL WUFZTkNVSUlVTFVKSk9ZV1kIAVlBT0xDSTcG Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Content-Type: text/plain; charset="utf-8" From: Zhang aihui If i2c slave devices don't work at the same time, which have the same i2c addr, it would register two devices, can make them working. Change-Id: I1bfb7783924b08bdc6e12bf47c2de01bdac7c2e2 Signed-off-by: Zhang aihui Signed-off-by: David Wu --- drivers/i2c/i2c-core-base.c | 51 +++++++++++++++++++++++++++++-------- 1 file changed, 41 insertions(+), 10 deletions(-) diff --git a/drivers/i2c/i2c-core-base.c b/drivers/i2c/i2c-core-base.c index ae3af738b03f..53a8141e6238 100644 --- a/drivers/i2c/i2c-core-base.c +++ b/drivers/i2c/i2c-core-base.c @@ -62,6 +62,7 @@ static DEFINE_MUTEX(core_lock); static DEFINE_IDR(i2c_adapter_idr); =20 +static int i2c_check_addr_ex(struct i2c_adapter *adapter, int addr); static int i2c_detect(struct i2c_adapter *adapter, struct i2c_driver *driv= er); =20 static DEFINE_STATIC_KEY_FALSE(i2c_trace_msg_key); @@ -849,7 +850,8 @@ static void i2c_adapter_unlock_bus(struct i2c_adapter *= adapter, =20 static void i2c_dev_set_name(struct i2c_adapter *adap, struct i2c_client *client, - struct i2c_board_info const *info) + struct i2c_board_info const *info, + int status) { struct acpi_device *adev =3D ACPI_COMPANION(&client->dev); =20 @@ -863,8 +865,12 @@ static void i2c_dev_set_name(struct i2c_adapter *adap, return; } =20 - dev_set_name(&client->dev, "%d-%04x", i2c_adapter_id(adap), - i2c_encode_flags_to_addr(client)); + if (status =3D=3D 0) + dev_set_name(&client->dev, "%d-%04x", i2c_adapter_id(adap), + i2c_encode_flags_to_addr(client)); + else + dev_set_name(&client->dev, "%d-%04x-%01x", i2c_adapter_id(adap), + i2c_encode_flags_to_addr(client), status); } =20 int i2c_dev_irq_from_resources(const struct resource *resources, @@ -940,9 +946,11 @@ i2c_new_client_device(struct i2c_adapter *adap, struct= i2c_board_info const *inf } =20 /* Check for address business */ - status =3D i2c_check_addr_busy(adap, i2c_encode_flags_to_addr(client)); + status =3D i2c_check_addr_ex(adap, i2c_encode_flags_to_addr(client)); if (status) - goto out_err; + dev_err(&adap->dev, + "%d i2c clients have been registered at 0x%02x", + status, client->addr); =20 client->dev.parent =3D &client->adapter->dev; client->dev.bus =3D &i2c_bus_type; @@ -951,7 +959,7 @@ i2c_new_client_device(struct i2c_adapter *adap, struct = i2c_board_info const *inf client->dev.fwnode =3D info->fwnode; =20 device_enable_async_suspend(&client->dev); - i2c_dev_set_name(adap, client, info); + i2c_dev_set_name(adap, client, info, status); =20 if (info->swnode) { status =3D device_add_software_node(&client->dev, info->swnode); @@ -976,10 +984,6 @@ i2c_new_client_device(struct i2c_adapter *adap, struct= i2c_board_info const *inf device_remove_software_node(&client->dev); out_err_put_of_node: of_node_put(info->of_node); -out_err: - dev_err(&adap->dev, - "Failed to register i2c client %s at 0x%02x (%d)\n", - client->name, client->addr, status); out_err_silent: kfree(client); return ERR_PTR(status); @@ -1988,6 +1992,33 @@ EXPORT_SYMBOL(i2c_del_driver); =20 /* -----------------------------------------------------------------------= -- */ =20 +struct i2c_addr_cnt { + int addr; + int cnt; +}; + +static int __i2c_check_addr_ex(struct device *dev, void *addrp) +{ + struct i2c_client *client =3D i2c_verify_client(dev); + struct i2c_addr_cnt *addrinfo =3D (struct i2c_addr_cnt *)addrp; + int addr =3D addrinfo->addr; + + if (client && client->addr =3D=3D addr) + addrinfo->cnt++; + + return 0; +} + +static int i2c_check_addr_ex(struct i2c_adapter *adapter, int addr) +{ + struct i2c_addr_cnt addrinfo; + + addrinfo.addr =3D addr; + addrinfo.cnt =3D 0; + device_for_each_child(&adapter->dev, &addrinfo, __i2c_check_addr_ex); + return addrinfo.cnt; +} + struct i2c_cmd_arg { unsigned cmd; void *arg; --=20 2.25.1