Received-SPF: pass (google.com: domain of linux-kernel+bounces-172166-linux.lists.archive=gmail.com@vger.kernel.org designates 2604:1380:45e3:2400::1 as permitted sender) client-ip=2604:1380:45e3:2400::1;
From: Frank Li <Frank.Li@nxp.com>
To: alexandre.belloni@bootlin.com
Cc: conor.culhane@silvaco.com,
	devicetree@vger.kernel.org,
	gregkh@linuxfoundation.org,
	ilpo.jarvinen@linux.intel.com,
	imx@lists.linux.dev,
	jirislaby@kernel.org,
	joe@perches.com,
	krzysztof.kozlowski+dt@linaro.org,
	krzysztof.kozlowski@linaro.org,
	linux-i3c@lists.infradead.org,
	linux-kernel@vger.kernel.org,
	linux-serial@vger.kernel.org,
	miquel.raynal@bootlin.com,
	robh@kernel.org,
	zbigniew.lukwinski@linux.intel.com
Subject: [PATCH resend v9 7/8] i3c: add API i3c_dev_gettstatus_format1() to get target device status
Date: Tue,  7 May 2024 16:43:10 -0400
Message-Id: <20240507204311.2898714-8-Frank.Li@nxp.com>
In-Reply-To: <20240507204311.2898714-1-Frank.Li@nxp.com>
References: <20240507204311.2898714-1-Frank.Li@nxp.com>
Content-Transfer-Encoding: 8bit
Content-Type: text/plain
Precedence: bulk
MIME-Version: 1.0
X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1
X-MS-Exchange-AntiSpam-MessageData-0:
	=?us-ascii?Q?rOxP0S3ymn0oDp+b+jQrCmv9duH7mLlN32Hr2e44YtROTW33cNIrA1VBgq8o?=
 =?us-ascii?Q?5WH2sxKi2Zk3qR98yKdmTI0Um5ZpMhAcUvotAAJxZIHCF1i2uum0DyTDqsvn?=
 =?us-ascii?Q?+U+HU0E4Z9lvDklSZ4NF/EO3y7pFFGiWTr6HKJYY8j7UFNqK20AI6xArABxo?=
 =?us-ascii?Q?lccQ4+tPtn7rKAxNwDi7R01I++JUv4K5IX4RlSIIEmUphNhUKIctjClJ8Bsn?=
 =?us-ascii?Q?dU7emFJ3DZWEGkjE9IS99OxzldyWFfQHfNBXVuyawJds9E7zHBtpOOh6j9oX?=
 =?us-ascii?Q?E+fMoEg29jvI0MYQNY4LnhzFJdL4yiVPxTme0uAPmdeAm5RyFrZcIrtFa/nt?=
 =?us-ascii?Q?q0SdiAs+w3kUmCRwScduZZSCkDRBPuAW8Po2R/zNWyEpTqp+FsK/YSt6CpEF?=
 =?us-ascii?Q?vVr/ns5NVtdus6GSu0MA9sci5RC+8v+O6tDx+d9mZ/Re7tC52neTUDxApLvf?=
 =?us-ascii?Q?xQbtyNBbqxfNcDeosmNcYkW+8LgQ8/P7AVkEtuBdFk8zaF6bPIYbxROlNx5z?=
 =?us-ascii?Q?nIdVcRAowmdp+feb30CJV1d8qlvybrO91bBksklY9s0jI9hrnDMPDEdXCguS?=
 =?us-ascii?Q?b1P21u71Z3hOwHcqFLKzU3XvWOR6cnB+measT03+j8CyRqJgaG46hUB8n3wi?=
 =?us-ascii?Q?UmHSlRNFg+pPMkFfAqBhNBPn+a1geuRjMC0m4v4Hq8kIAKQ9mdiarupVnRwh?=
 =?us-ascii?Q?A0iAp/PZkpGPqqeB7GtszEy9jHzGNZIfaWhWfm9z8vfW/nvl74dux+GuYzSg?=
 =?us-ascii?Q?0JL6YE2yMlbAbmWMkSjSbPzy42xvIve+e5EQbrD6G+HQhSYaxO41l+zrrj0C?=
 =?us-ascii?Q?/G209IvDcJgH0Of3BD3oF84hRyaKf0Ok07bkRWIQHNQ9+YdYsO0Vm2AlObPY?=
 =?us-ascii?Q?2IW1JtB6ab9Qc1zmwlTgkQvJgVRze4aR4Yk8sTo1jZr0+1KSL0HzgSjEeQ4t?=
 =?us-ascii?Q?GSKSNfYFKkf7m39eAl6ALLLxGnNwud6MYLfK12kHodTkO01XvNZa58vBXyDt?=
 =?us-ascii?Q?yR7O1LYVR1KrEy40g45uOsJzfshhx35sFW2Q0ELlE5bYTRSSNv99Ab/cM/JE?=
 =?us-ascii?Q?aXvpIi7i4FkchcuYdA1bSraF+VWDZ+rltsgTUCUf7qeEsfWX9MbLiXkns73Z?=
 =?us-ascii?Q?t9C5oZnvtw5LcWBqgzNbdvNReYgqQdwMdQlwh3RnDdjie0zCfFf4owEZZPYW?=
 =?us-ascii?Q?Rz3uDQVpG0xxuECy+HF4TTjdmPJbBh16rpPPunnSVdY2PvkPl8nCckXnrXIN?=
 =?us-ascii?Q?pARjZ03MLpb3EdK8wT1LXfJoNVq6g8WTgC8R+TAq5jsTFknk4ZouKWf1rPex?=
 =?us-ascii?Q?C0/GDXjYtzjleHFW4nR0cSpQR1wD7VN3sEg0ACY1dxLM1GEMJRtayCE4ftd/?=
 =?us-ascii?Q?CyOJOMz3pp8VU37NilaJIEk8LBS3D7rvl2SMa9xamMKUsxMh4YGEffvo58oZ?=
 =?us-ascii?Q?j9b2UhHqwgK8Rs+HoYKNBcu92aTErJEqqpHEFDQyUW68GMttO/uoKrcPSBpG?=
 =?us-ascii?Q?Bo5mxPcfbxpP4TpKUN6DafhD+X7jg23yglP9WduTs4x+8+fzw5JkdebmJP8M?=
 =?us-ascii?Q?jM40P0MCq8ywRghkgGMbTzusnYYN+8n+DXQq3Nhx?=
X-OriginatorOrg: nxp.com
X-MS-Exchange-CrossTenant-Network-Message-Id: caa5ad46-5716-44a4-d41e-08dc6ed668c2
X-MS-Exchange-CrossTenant-AuthSource: PAXPR04MB9642.eurprd04.prod.outlook.com
X-MS-Exchange-CrossTenant-AuthAs: Internal
X-MS-Exchange-CrossTenant-OriginalArrivalTime: 07 May 2024 20:43:54.0317
 (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: L+yKNF/dTFfB8dInotsPdC7Xp60KZ1limdGBuP6FnKNzCiawlujjmpZ7ca1Ocv/JMypmv05jbgTgExF4IDCIag==
X-MS-Exchange-Transport-CrossTenantHeadersStamped: PAXPR04MB8576

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>
---
 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 3afa530c5e322..ff61a218bcc6d 100644
--- a/drivers/i3c/master.c
+++ b/drivers/i3c/master.c
@@ -2988,6 +2988,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 e119f11948efe..66920045ff042 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