Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.32 as permitted sender) client-ip=23.128.96.32;
From:   Frank Li <Frank.Li@nxp.com>
To:     miquel.raynal@bootlin.com
Cc:     Frank.li@nxp.com, alexandre.belloni@bootlin.com,
        conor.culhane@silvaco.com, imx@lists.linux.dev, joe@perches.com,
        linux-i3c@lists.infradead.org, linux-kernel@vger.kernel.org,
        zbigniew.lukwinski@linux.intel.com, gregkh@linuxfoundation.org,
        jirislaby@kernel.org, linux-serial@vger.kernel.org
Subject: [PATCH v5 6/7] i3c: add API i3c_dev_gettstatus_format1() to get target device status
Date:   Thu, 30 Nov 2023 17:44:07 -0500
Message-Id: <20231130224408.3591288-7-Frank.Li@nxp.com>
In-Reply-To: <20231130224408.3591288-1-Frank.Li@nxp.com>
References: <20231130224408.3591288-1-Frank.Li@nxp.com>
Content-Transfer-Encoding: 8bit
Content-Type: text/plain
MIME-Version: 1.0
X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1
X-MS-Exchange-AntiSpam-MessageData-0: =?us-ascii?Q?xsIVPO4ryE1EDW+4eDeYpj+Rgy6oxzxfNz5a+kI7N+peOTR5xKZHQmhcc/ax?=
 =?us-ascii?Q?rL1oReMFwc4sl3oecU3tuJW4DNN0sBlVbPl5RplCiJY3zKuoKoN4y8tpzUF2?=
 =?us-ascii?Q?yQcNi1Q0TZcOzsAD7fqi+NoeOxevljjb1VaaSsz8xUiZw5tauVgCS9s8LXGV?=
 =?us-ascii?Q?lwD8pmxO0F+Am/W/7kc2EyLHd6FltMZESmHcVx085JHwE/0fPs6NJKBUcXbC?=
 =?us-ascii?Q?2QJP4DwhBZONcJO81lWsRpuJUCE4x0B2FrCWQSY/C4PJ5fNUAEckGSYr78oU?=
 =?us-ascii?Q?3ezkgiJ/tbmTokfZGxgLTQbE0Ih07h03QocrdmAFdAkvkmyFRbIIKO9jyqom?=
 =?us-ascii?Q?XWOXFRiCD83/mcVo//CtDdznqckHVp6zMr0bgMPxrsWDqlBNixI36QLJt9bL?=
 =?us-ascii?Q?Bn1Lui1BGvur8ZgvTMR2uTHzadVizcvZnxbEeiHExJHCZHrWLOP294zy+j/X?=
 =?us-ascii?Q?379N6xuo5p9R/U39mEVZT/MoRbbHN7BFWuY/wZClX3Wx4Jz/o1eWPT9HyiN9?=
 =?us-ascii?Q?FqIAv/OLMMwy5bjvyT9mV4p5pjjeO+WrpPOZV+/B5PlETx0o9ASqcTZg5kgN?=
 =?us-ascii?Q?URRUj5+sGgipS8Blen+47d5+jRy4ZMdxwTvs2Nz67o98nZJKO/Jt8sfGePOP?=
 =?us-ascii?Q?8khai2xNcG1gK+ibock7oUEPKUG6Z78GTH56PmCBq1jd5Qrd/OflyllpzQcl?=
 =?us-ascii?Q?SGAn10/ZPYfnO/MRpzidHuG70k4zEOIOjnYIODO+7pKyR7FnJPK/WEds6LMo?=
 =?us-ascii?Q?fqmRtAYI7TVXg6o0gs4YeGn9ovv12xRTL8ctTX05LsRe5SWfXgOUXYShp6cQ?=
 =?us-ascii?Q?LbmCHCXSnRoLwPQSQQiigSjb3XaxF/Q8Vfs6zWC143GMnwI5L/CzjHkqMKW+?=
 =?us-ascii?Q?SYOsmxKX+NHgkt65BgxVFCtPVcCPhCiIS+/+YP5OCR7eebij0c8P/B6uJGWm?=
 =?us-ascii?Q?lsA2w+GKxiBjQvvg26RN6MQQc9XHw/maBwx/EZuAjdI+Uqz9O1aew/cFvueb?=
 =?us-ascii?Q?cQWPFL0y3bDjgX4uFHfbxwPDdlxR/bsxNzOiq0hKcyk9h8/wpAUGwm5MRR/2?=
 =?us-ascii?Q?LDaC5VxMKxX8jMeWV2wvgqE6cFpGNDOAm7AlTB+taxEBt8aGds0BCh1+NJnK?=
 =?us-ascii?Q?BlW5tKQZ/bgiZuCT6Do8d51g/5FJGlJQD7SU7+e2b0fjLztzgtYLsW7mXnR6?=
 =?us-ascii?Q?YL/SvdqiUNsYNPFeJ97InDXMNTtBu0/5NtEtqK1qUfxRCAtgzssE+zAziOhr?=
 =?us-ascii?Q?xSPdklo845QxWVMwlQ9vENiROPBcc8EZ8t4C317rRrBawq3WYD9z7aMJj5tM?=
 =?us-ascii?Q?6o7b0SVDZZBZTU88ngXOLgOekjj2gxxzNSf6zaO/kToCaDcy3cICRpREN54M?=
 =?us-ascii?Q?GYWdQjkTREme91Fmc4e/jfmBx719ijnproyS1MhO4h8rKM7bg/sU9fh9hhBH?=
 =?us-ascii?Q?c/+D+vnr5lUNjuErDQv2ZMhNE2BKmsupcbdQfKGxkJkdJNE7EJVpSPuc1yXM?=
 =?us-ascii?Q?EsZB273ZKXRwDDZPOQgq8y0qnaDYOOPl6eXcba8UN0kNcwL34woTAmg47neK?=
 =?us-ascii?Q?KHYbMQ0uQfr8VU7oO5kLIB3wyev65VQiebBRAuNB?=
X-OriginatorOrg: nxp.com
X-MS-Exchange-CrossTenant-Network-Message-Id: 665ac62f-6107-44b7-33e8-08dbf1f5f441
X-MS-Exchange-CrossTenant-AuthSource: AM6PR04MB4838.eurprd04.prod.outlook.com
X-MS-Exchange-CrossTenant-AuthAs: Internal
X-MS-Exchange-CrossTenant-OriginalArrivalTime: 30 Nov 2023 22:44:47.1601
 (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: kolQr8cS0D6vUzch39fsfxOl4FR2bFMRJnMpwtoWgbEAqcOM6Gi5wXDz6AZmVDToo5F5FNitSX0XegRUpfBkpQ==
X-MS-Exchange-Transport-CrossTenantHeadersStamped: AS8PR04MB8851
X-Spam-Status: No, score=-0.9 required=5.0 tests=DKIM_SIGNED,DKIM_VALID,
	DKIM_VALID_AU,HEADER_FROM_DIFFERENT_DOMAINS,MAILING_LIST_MULTI,
	SPF_HELO_NONE,SPF_PASS,T_SCC_BODY_TEXT_LINE autolearn=unavailable
	autolearn_force=no version=3.4.6
X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on agentk.vger.email
Precedence: bulk
List-ID: <linux-kernel.vger.kernel.org>
X-Mailing-List: linux-kernel@vger.kernel.org
X-Greylist: Sender passed SPF test, not delayed by milter-greylist-4.6.4 (agentk.vger.email [0.0.0.0]); Thu, 30 Nov 2023 14:45:10 -0800 (PST)

I3C standard 5.1.9.3.15 Get Device Status (GETSTATUS):
Get request for one I3C Target Device to return its current status.

Add API to fetch it with format1.

Signed-off-by: Frank Li <Frank.Li@nxp.com>
---

Notes:
    Change from v4 to v5
    - none

 drivers/i3c/device.c       | 24 ++++++++++++++++++++++++
 drivers/i3c/internals.h    |  1 +
 drivers/i3c/master.c       | 26 ++++++++++++++++++++++++++
 include/linux/i3c/device.h |  1 +
 4 files changed, 52 insertions(+)

diff --git a/drivers/i3c/device.c b/drivers/i3c/device.c
index 1a6a8703dbc3a..aa26cf50ab9c6 100644
--- a/drivers/i3c/device.c
+++ b/drivers/i3c/device.c
@@ -196,6 +196,30 @@ void i3c_device_free_ibi(struct i3c_device *dev)
 }
 EXPORT_SYMBOL_GPL(i3c_device_free_ibi);
 
+/**
+ * i3c_device_getstatus_format1() - Get device status with format 1.
+ * @dev: device for which you want to get status.
+ * @status: I3C status format 1
+ *
+ * Return: 0 in case of success, a negative error core otherwise.
+ */
+int i3c_device_getstatus_format1(struct i3c_device *dev, u16 *status)
+{
+	int ret = -EINVAL;
+
+	if (!status)
+		return -EINVAL;
+
+	i3c_bus_normaluse_lock(dev->bus);
+	if (dev->desc)
+		ret = i3c_dev_getstatus_format1_locked(dev->desc, status);
+
+	i3c_bus_normaluse_unlock(dev->bus);
+
+	return ret;
+}
+EXPORT_SYMBOL_GPL(i3c_device_getstatus_format1);
+
 /**
  * i3cdev_to_dev() - Returns the device embedded in @i3cdev
  * @i3cdev: I3C device
diff --git a/drivers/i3c/internals.h b/drivers/i3c/internals.h
index 908a807badaf9..976ad26ca79c2 100644
--- a/drivers/i3c/internals.h
+++ b/drivers/i3c/internals.h
@@ -24,4 +24,5 @@ int i3c_dev_enable_ibi_locked(struct i3c_dev_desc *dev);
 int i3c_dev_request_ibi_locked(struct i3c_dev_desc *dev,
 			       const struct i3c_ibi_setup *req);
 void i3c_dev_free_ibi_locked(struct i3c_dev_desc *dev);
+int i3c_dev_getstatus_format1_locked(struct i3c_dev_desc *dev, u16 *status);
 #endif /* I3C_INTERNAL_H */
diff --git a/drivers/i3c/master.c b/drivers/i3c/master.c
index d3b56c9f601e2..81611a3e3585a 100644
--- a/drivers/i3c/master.c
+++ b/drivers/i3c/master.c
@@ -2923,6 +2923,32 @@ void i3c_dev_free_ibi_locked(struct i3c_dev_desc *dev)
 	dev->ibi = NULL;
 }
 
+int i3c_dev_getstatus_format1_locked(struct i3c_dev_desc *dev, u16 *status)
+{
+	struct i3c_master_controller *master = i3c_dev_get_master(dev);
+	struct i3c_ccc_getstatus *format1;
+	struct i3c_ccc_cmd_dest dest;
+	struct i3c_ccc_cmd cmd;
+	int ret;
+
+	format1 = i3c_ccc_cmd_dest_init(&dest, dev->info.dyn_addr, sizeof(*format1));
+	if (!format1)
+		return -ENOMEM;
+
+	i3c_ccc_cmd_init(&cmd, true, I3C_CCC_GETSTATUS, &dest, 1);
+
+	ret = i3c_master_send_ccc_cmd_locked(master, &cmd);
+	if (ret)
+		goto out;
+
+	*status = be16_to_cpu(format1->status);
+
+out:
+	i3c_ccc_cmd_dest_cleanup(&dest);
+
+	return ret;
+}
+
 static int __init i3c_init(void)
 {
 	int res;
diff --git a/include/linux/i3c/device.h b/include/linux/i3c/device.h
index ef6217da8253b..5f511bd400f11 100644
--- a/include/linux/i3c/device.h
+++ b/include/linux/i3c/device.h
@@ -345,4 +345,5 @@ void i3c_device_free_ibi(struct i3c_device *dev);
 int i3c_device_enable_ibi(struct i3c_device *dev);
 int i3c_device_disable_ibi(struct i3c_device *dev);
 
+int i3c_device_getstatus_format1(struct i3c_device *dev, u16 *status);
 #endif /* I3C_DEV_H */
-- 
2.34.1