Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) client-ip=23.128.96.18;
From:   Andriy Tryshnivskyy <andriy.tryshnivskyy@opensynergy.com>
To:     jbhayana@google.com, jic23@kernel.org
Cc:     lars@metafoo.de, linux-iio@vger.kernel.org,
        linux-kernel@vger.kernel.org, Vasyl.Vavrychuk@opensynergy.com,
        andriy.tryshnivskyy@opensynergy.com
Subject: [PATCH v4 1/1] iio/scmi: Add reading "raw" attribute.
Date:   Fri,  8 Oct 2021 16:58:42 +0300
Message-Id: <20211008135842.21896-2-andriy.tryshnivskyy@opensynergy.com>
In-Reply-To: <20211008135842.21896-1-andriy.tryshnivskyy@opensynergy.com>
References: <20211008135842.21896-1-andriy.tryshnivskyy@opensynergy.com>
Content-Type: text/plain
MIME-Version: 1.0
X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1
X-MS-Exchange-AntiSpam-MessageData-0: =?us-ascii?Q?vLdpng5PhRuv10vY8g0X3REmXcrpwjBi/As1NgTdiNHN9HZjrY43fYi4+dc2?=
 =?us-ascii?Q?x46RuUC9Qz/pio3/5abo4KcCEIV0uzXBmU5CRtQFRhUDGKjU764uYPqgNskR?=
 =?us-ascii?Q?bkBzVeRogv7uN8YbCTET6OG9dhJrk+jxMgoSdBX/i31DbxgBgGv8N+CGQ4hL?=
 =?us-ascii?Q?+lZ9uTZ63tvSaFem0RjzEf010Yszgefd51gR86RXNvi1OwX5vK3l95mmyDRP?=
 =?us-ascii?Q?4VUryAhyAOIJELoYviJYw7Ymbpv1fnAm9+5NgqcM4EjgbAWcnMtcjPggqWcJ?=
 =?us-ascii?Q?2sIqCv+k4bIcOZQBT6o/orci7b0jFus+oGIG9gdRo8IAsVp2AQbEsGZPoOO4?=
 =?us-ascii?Q?lVUd1Ecd3MggGseLVjkFoedLdFY3Tc6Qfnpe5EZcMWAqCf9l/9IYEvcpJs8v?=
 =?us-ascii?Q?xWIfCpwY8ezWPZtaYZhGsXrvRYwXSeUgT2lpO9vomFvxhZWbZfqA328OU8iW?=
 =?us-ascii?Q?mXqFYup16UTWA2o0ABOkI6WZnLqs6GKv3b7JntearZ6WB0IX/mJ/+SpoVnDC?=
 =?us-ascii?Q?M77e8QZAihP3LgGCNbh/KNYxLLaBTZjpdQ8Yu/XBRHfObyTmuPH5y0tX1KBv?=
 =?us-ascii?Q?ewmwy93SS8IxtFN0NVOhA0x5FuAMNtpm5RdpGbOS589ffDiM3pY61ZbKH9BK?=
 =?us-ascii?Q?GERkqhXIZQKlJ79ro83fPCI4jgWroYefYXeNSQKBUL71ZCRewBYsqEcnp0E7?=
 =?us-ascii?Q?+kRBX6JZvBKrYzJSw8wRkZpWXdGUSDxqcI6irCSLz35BHNPyz8wfqxQb6M7W?=
 =?us-ascii?Q?a0ux2CuAegGfLRvhjhf6t0I83Ht3xKtTdxX+YaJdue9hSP1OGz//3Nmt2IgP?=
 =?us-ascii?Q?IXTSVrAE5uyPYHaDD7fPQ1xvS60l+jcevKku3+5eZMX0VYUyibwYYxIV94VT?=
 =?us-ascii?Q?67trDG3wly0Bzwa8zffloPa/bOOARASnKDYmXs3LaFPufTL1AfrKAEqOSsap?=
 =?us-ascii?Q?Wp5snnT0dsCi+k5kHFI1pg8L1c5z3xYP+kM8ndlJTz5tD9pRn534jN1xeJ//?=
 =?us-ascii?Q?tB/CY8GhasA5qH65zO7qN6jFNMN7Mj14HwNIkKf5jS4mSHFvCcCvuMIQqgch?=
 =?us-ascii?Q?Aikq4DVn8+O56ppLtnjE/YWr17GdQpzWs9GqKb0SClpUhD162JMXnvqYmIcu?=
 =?us-ascii?Q?mj0m2FBq1PZAzADdLJN5lO646YJ0DTbORZtNTukGJK82qGJkbvbRaxV268UQ?=
 =?us-ascii?Q?62ToYA6rH18Ck7sFZWUzsiV18PNxDEgL3x6aS4TQ2joPk2R6d9Nh4z6NfO74?=
 =?us-ascii?Q?JH3QVntx3b5XZEwFlCDYi9pnO9pUwl3ogTfzxoACIwoNyYPnmecrDtiQ7fuH?=
 =?us-ascii?Q?08vslRXcH+Q6+6/obWDXO0Q1?=
X-OriginatorOrg: opensynergy.com
X-MS-Exchange-CrossTenant-Network-Message-Id: d4ee36bd-aafc-4bdd-60af-08d98a63c925
X-MS-Exchange-CrossTenant-AuthSource: AM6PR04MB6359.eurprd04.prod.outlook.com
X-MS-Exchange-CrossTenant-AuthAs: Internal
X-MS-Exchange-CrossTenant-OriginalArrivalTime: 08 Oct 2021 13:59:03.2050
 (UTC)
X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted
X-MS-Exchange-CrossTenant-Id: 800fae25-9b1b-4edc-993d-c939c4e84a64
X-MS-Exchange-CrossTenant-MailboxType: HOSTED
X-MS-Exchange-CrossTenant-UserPrincipalName: yqtY2WuIPGT5ePclghImdApz06i8m+jNg3xSSYdhAUTL9vA07Vni2zIhjVUsbUPrLWwYdSrBuFzyc28svTywPQ==
X-MS-Exchange-Transport-CrossTenantHeadersStamped: AM6PR04MB4309
Precedence: bulk
List-ID: <linux-kernel.vger.kernel.org>
X-Mailing-List: linux-kernel@vger.kernel.org

Add scmi_iio_get_raw() to read "raw" attribute.

Signed-off-by: Andriy Tryshnivskyy <andriy.tryshnivskyy@opensynergy.com>
---
 drivers/iio/common/scmi_sensors/scmi_iio.c | 66 ++++++++++++++++++++++
 1 file changed, 66 insertions(+)

diff --git a/drivers/iio/common/scmi_sensors/scmi_iio.c b/drivers/iio/common/scmi_sensors/scmi_iio.c
index 7cf2bf282cef..c3bd48ea85b8 100644
--- a/drivers/iio/common/scmi_sensors/scmi_iio.c
+++ b/drivers/iio/common/scmi_sensors/scmi_iio.c
@@ -311,6 +311,67 @@ static const struct iio_info scmi_iio_info = {
 	.write_raw = scmi_iio_write_raw,
 };
 
+static ssize_t scmi_iio_get_raw(struct iio_dev *iio_dev, uintptr_t private,
+				const struct iio_chan_spec *chan, char *buf)
+{
+	struct scmi_iio_priv *sensor = iio_priv(iio_dev);
+	int err;
+	u32 sensor_config;
+	struct scmi_sensor_reading readings[SCMI_IIO_NUM_OF_AXIS];
+	int len = 0;
+
+	err = iio_device_claim_direct_mode(iio_dev);
+	if (err) {
+		dev_err(&iio_dev->dev,
+			"Error in climing direct mode for sensor %s err %d",
+			sensor->sensor_info->name, err);
+		return len;
+	}
+
+	sensor_config = FIELD_PREP(SCMI_SENS_CFG_SENSOR_ENABLED_MASK,
+				   SCMI_SENS_CFG_SENSOR_ENABLE);
+	err = sensor->sensor_ops->config_set(
+		sensor->ph, sensor->sensor_info->id, sensor_config);
+	if (err) {
+		dev_err(&iio_dev->dev, "Error in enabling sensor %s err %d",
+			sensor->sensor_info->name, err);
+		return len;
+	}
+
+	err = sensor->sensor_ops->reading_get_timestamped(
+		sensor->ph, sensor->sensor_info->id,
+		sensor->sensor_info->num_axis, readings);
+	if (err) {
+		dev_err(&iio_dev->dev,
+			"Error in reading raw attribute for sensor %s err %d",
+			sensor->sensor_info->name, err);
+		return len;
+	}
+
+	sensor_config = FIELD_PREP(SCMI_SENS_CFG_SENSOR_ENABLED_MASK,
+				   SCMI_SENS_CFG_SENSOR_DISABLE);
+	err = sensor->sensor_ops->config_set(
+		sensor->ph, sensor->sensor_info->id, sensor_config);
+	if (err) {
+		dev_err(&iio_dev->dev, "Error in enabling sensor %s err %d",
+			sensor->sensor_info->name, err);
+		return len;
+	}
+
+	iio_device_release_direct_mode(iio_dev);
+	if (err) {
+		dev_err(&iio_dev->dev,
+			"Error in releasing direct mode for sensor %s err %d",
+			sensor->sensor_info->name, err);
+		return len;
+	}
+
+	len = scnprintf(buf, PAGE_SIZE, "%lld\n",
+			readings[chan->scan_index].value);
+
+	return len;
+}
+
 static ssize_t scmi_iio_get_raw_available(struct iio_dev *iio_dev,
 					  uintptr_t private,
 					  const struct iio_chan_spec *chan,
@@ -355,6 +416,11 @@ static ssize_t scmi_iio_get_raw_available(struct iio_dev *iio_dev,
 }
 
 static const struct iio_chan_spec_ext_info scmi_iio_ext_info[] = {
+	{
+		.name = "raw",
+		.read = scmi_iio_get_raw,
+		.shared = IIO_SEPARATE,
+	},
 	{
 		.name = "raw_available",
 		.read = scmi_iio_get_raw_available,
-- 
2.17.1