Received: by 2002:ab2:3350:0:b0:1f4:6588:b3a7 with SMTP id o16csp792609lqe; Sun, 7 Apr 2024 04:22:27 -0700 (PDT) X-Forwarded-Encrypted: i=3; AJvYcCWRER+lxRMA1lgPLJl1SL+fLvnuOzl5bkkDkQHliC7+880HWbi34in2UfoaJDZ49wMK1XPRC4n5ZIA9mJDNTsAVv984gfeNMlMUGSNFgQ== X-Google-Smtp-Source: AGHT+IFvArpj6LgxIvAb+50DIvj97ZpmXpjoigyeRWgmKegbQdfFoFGn3TdPZCGbkpJaStgWAsTr X-Received: by 2002:a05:622a:120f:b0:431:5e0b:e5e1 with SMTP id y15-20020a05622a120f00b004315e0be5e1mr10579593qtx.4.1712488946915; Sun, 07 Apr 2024 04:22:26 -0700 (PDT) ARC-Seal: i=2; a=rsa-sha256; t=1712488946; cv=pass; d=google.com; s=arc-20160816; b=U5dhrOfuN62LNlGQJTOCrjrJ7K1cOm0Cnha7doVBWmtzJWJC80bgYSOHXgeVs1G+sl KgtLqWtKbQykMpBQv+nh7cO2XwcdLCz6aj8RABEYFaVm0Jm0/EWhZSJKOAIYsByazWja dJZHq+ZC01pKG+R4wzHg+9AhwEWdWQ8q0YQwnqg7GZeQ1dyyBTjMZo5wc86Kn9YNPnMn vAzOs5qEqqem8ph6W1m2ElLeNiVzMJk3fIewrGncAvKcDsR7xubxF9vI8KUN+/N07h2A RRJ3GRhMBCVjwgJheG7kbYn7FaifdU3PnrVMDEWbm3Jgj8g0P6jHbe427qv//hmKAAi2 S2og== ARC-Message-Signature: i=2; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=in-reply-to:content-disposition:mime-version:list-unsubscribe :list-subscribe:list-id:precedence:references:message-id:subject:cc :to:from:date; bh=dnZ7Q7e2VqqTyU8ttvsgA7A8phJtm4EVrMFDRU+zgLM=; fh=wcHr3dEKXIl+qtu38CJf1NjhFnyJ24HtbvqG5aC8HmQ=; b=aoT3rzcndYNLR2rJCU3hTvKnYKT7AfJCmAF2bFIWepnnLP0n7teVkdCZWYEwLWq2ES auaGxMQ9oIGpFJza/wa3658jw0/+8obJNgBtoYB6fuiUZTdyWEgJxn5VI43pL3Tfn8PC D8iXr5n6Cbn6JlhNXhUpbwkM5ZOveN9f2lB2TjVpODA2lgtVFzJz8iqP82zOcMQT2FE6 Xe5+VAZPXoBgLIzOeCttqymOfIigCmOJNGl6sXDBGtG79xNoHQofVUH4RbiVpPeAV5Ns cz+lqZB8EHZ3nuBbeWihRGSdk5xfpPXxrO+raNp9JQ8Y9eWyXXGoED07soNgmbKGvEOG dpHw==; dara=google.com ARC-Authentication-Results: i=2; mx.google.com; arc=pass (i=1 spf=pass spfdomain=pengutronix.de); spf=pass (google.com: domain of linux-kernel+bounces-134353-linux.lists.archive=gmail.com@vger.kernel.org designates 2604:1380:45d1:ec00::1 as permitted sender) smtp.mailfrom="linux-kernel+bounces-134353-linux.lists.archive=gmail.com@vger.kernel.org" Return-Path: Received: from ny.mirrors.kernel.org (ny.mirrors.kernel.org. [2604:1380:45d1:ec00::1]) by mx.google.com with ESMTPS id f8-20020ac859c8000000b00432d3712712si3556884qtf.422.2024.04.07.04.22.26 for (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Sun, 07 Apr 2024 04:22:26 -0700 (PDT) Received-SPF: pass (google.com: domain of linux-kernel+bounces-134353-linux.lists.archive=gmail.com@vger.kernel.org designates 2604:1380:45d1:ec00::1 as permitted sender) client-ip=2604:1380:45d1:ec00::1; Authentication-Results: mx.google.com; arc=pass (i=1 spf=pass spfdomain=pengutronix.de); spf=pass (google.com: domain of linux-kernel+bounces-134353-linux.lists.archive=gmail.com@vger.kernel.org designates 2604:1380:45d1:ec00::1 as permitted sender) smtp.mailfrom="linux-kernel+bounces-134353-linux.lists.archive=gmail.com@vger.kernel.org" Received: from smtp.subspace.kernel.org (wormhole.subspace.kernel.org [52.25.139.140]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by ny.mirrors.kernel.org (Postfix) with ESMTPS id 495EA1C21038 for ; Sun, 7 Apr 2024 11:22:26 +0000 (UTC) Received: from localhost.localdomain (localhost.localdomain [127.0.0.1]) by smtp.subspace.kernel.org (Postfix) with ESMTP id EC32A2209B; Sun, 7 Apr 2024 11:22:17 +0000 (UTC) Received: from metis.whiteo.stw.pengutronix.de (metis.whiteo.stw.pengutronix.de [185.203.201.7]) (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 A5FB2210FF for ; Sun, 7 Apr 2024 11:22:14 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=185.203.201.7 ARC-Seal:i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1712488936; cv=none; b=fNf0JZANEA9YyeYo6GmxBrxyoVvnI4/RqmOa1KRzSNYsCML5osHd4B5JC8PRDX7yiSaNybmPS76EsUtdRAS/BZC6HaGgGv9m5miBKue7QgIhcInFW46sp6yQmNURkLvtm8AoMhUNH0eM8N6VQCJhfb3ncHKTzHG0j+s5R0H0LQQ= ARC-Message-Signature:i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1712488936; c=relaxed/simple; bh=txq22B8+BMvIOJ3ae/BNQUESEfxAhPlsoUZJIum1oY4=; h=Date:From:To:Cc:Subject:Message-ID:References:MIME-Version: Content-Type:Content-Disposition:In-Reply-To; b=SBd5hlbVVUlkQDLVIRiOHWzxdxL7f387jBkQbFUDmH64Mdybf+wl+xiArNJ3dgMhRwrOvO2oyjkxbRgt+Qzgh+g0jRrQr9ZdNIefCGi73wsjiEKz/f18I2/zWnPlQ9XkgR/ODRepGavRYqwlylC5tiS5fyiEkT840ci5jpDSdCQ= ARC-Authentication-Results:i=1; smtp.subspace.kernel.org; dmarc=none (p=none dis=none) header.from=pengutronix.de; spf=pass smtp.mailfrom=pengutronix.de; arc=none smtp.client-ip=185.203.201.7 Authentication-Results: smtp.subspace.kernel.org; dmarc=none (p=none dis=none) header.from=pengutronix.de Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=pengutronix.de Received: from drehscheibe.grey.stw.pengutronix.de ([2a0a:edc0:0:c01:1d::a2]) by metis.whiteo.stw.pengutronix.de with esmtps (TLS1.3:ECDHE_RSA_AES_256_GCM_SHA384:256) (Exim 4.92) (envelope-from ) id 1rtQHq-0004wY-Im; Sun, 07 Apr 2024 13:02:10 +0200 Received: from [2a0a:edc0:2:b01:1d::c5] (helo=pty.whiteo.stw.pengutronix.de) by drehscheibe.grey.stw.pengutronix.de with esmtps (TLS1.3) tls TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384 (Exim 4.94.2) (envelope-from ) id 1rtQHo-00AuJU-N1; Sun, 07 Apr 2024 13:02:08 +0200 Received: from mfe by pty.whiteo.stw.pengutronix.de with local (Exim 4.96) (envelope-from ) id 1rtQHo-001DFY-1w; Sun, 07 Apr 2024 13:02:08 +0200 Date: Sun, 7 Apr 2024 13:02:08 +0200 From: Marco Felsch To: Peng Fan Cc: "Peng Fan (OSS)" , Rob Herring , Krzysztof Kozlowski , Conor Dooley , Shawn Guo , Sascha Hauer , Pengutronix Kernel Team , Fabio Estevam , Sudeep Holla , Cristian Marussi , "devicetree@vger.kernel.org" , "linux-kernel@vger.kernel.org" , "linux-arm-kernel@lists.infradead.org" , "imx@lists.linux.dev" Subject: Re: [PATCH v2 4/6] firmware: arm_scmi: add initial support for i.MX MISC protocol Message-ID: <20240407110208.4huirwif7as3dsps@pengutronix.de> References: <20240405-imx95-bbm-misc-v2-v2-0-9fc9186856c2@nxp.com> <20240405-imx95-bbm-misc-v2-v2-4-9fc9186856c2@nxp.com> <20240405164414.t3fqhnwudxxt2ozv@pengutronix.de> Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Type: text/plain; charset=us-ascii Content-Disposition: inline In-Reply-To: X-SA-Exim-Connect-IP: 2a0a:edc0:0:c01:1d::a2 X-SA-Exim-Mail-From: mfe@pengutronix.de X-SA-Exim-Scanned: No (on metis.whiteo.stw.pengutronix.de); SAEximRunCond expanded to false X-PTX-Original-Recipient: linux-kernel@vger.kernel.org Hi Peng, On 24-04-07, Peng Fan wrote: > > Subject: Re: [PATCH v2 4/6] firmware: arm_scmi: add initial support for i.MX > > MISC protocol > > > > Hi Peng, > > > > On 24-04-05, Peng Fan (OSS) wrote: > > > From: Peng Fan > > > > > > The i.MX MISC protocol is for misc settings, such as gpio expander > > > wakeup. > > > > Can you elaborate a bit more please? > > The gpio expander is under M33(SCMI firmware used core) I2C control, Due to missing technical references I guess that your specific EVK has an i2c-expander connected to the system-critical-i2c bus? The system-critical-i2c should be only used for system critical topics like PMIC control. > But the gpio expander supports board function such as PCIE_WAKEUP, > BTN_WAKEUP. So these are managed by MISC protocol. This seems more like an specific i.MX95-EVK problem too me since you have conneccted the i2c-gpio-expander to the system-critical-i2c bus instead of using an bus available within Linux. Also can you please provide me a link with the propsoal for the MISC protocol? I can't find any references within the SCMI v3.2 https://developer.arm.com/documentation/den0056/e/ nor within the SCP firmware git: https://github.com/ARM-software/SCP-firmware. > SAI_CLK_MSEL in WAKEUP BLK CTRL is also managed by MISC Protocol. You recently said that we need blk-ctrl drivers for managing/controlling the GPR stuff within Linux since the SCMI firmware does not support this. Now blk-ctrl GPR control is supported by the firmware? Regards, Marco > > And etc... > > I will add more info in commit log in next version later, after I get more > reviews on the patchset. > > Thanks, > Peng. > > > > > Regards, > > Marco > > > > > > > > > > Signed-off-by: Peng Fan > > > --- > > > drivers/firmware/arm_scmi/Kconfig | 10 ++ > > > drivers/firmware/arm_scmi/Makefile | 1 + > > > drivers/firmware/arm_scmi/imx-sm-misc.c | 305 > > ++++++++++++++++++++++++++++++++ > > > include/linux/scmi_imx_protocol.h | 17 ++ > > > 4 files changed, 333 insertions(+) > > > > > > diff --git a/drivers/firmware/arm_scmi/Kconfig > > > b/drivers/firmware/arm_scmi/Kconfig > > > index 56d11c9d9f47..bfeae92f6420 100644 > > > --- a/drivers/firmware/arm_scmi/Kconfig > > > +++ b/drivers/firmware/arm_scmi/Kconfig > > > @@ -191,3 +191,13 @@ config IMX_SCMI_BBM_EXT > > > and BUTTON. > > > > > > This driver can also be built as a module. > > > + > > > +config IMX_SCMI_MISC_EXT > > > + tristate "i.MX SCMI MISC EXTENSION" > > > + depends on ARM_SCMI_PROTOCOL || (COMPILE_TEST && OF) > > > + default y if ARCH_MXC > > > + help > > > + This enables i.MX System MISC control logic such as gpio expander > > > + wakeup > > > + > > > + This driver can also be built as a module. > > > diff --git a/drivers/firmware/arm_scmi/Makefile > > > b/drivers/firmware/arm_scmi/Makefile > > > index 327687acf857..a23fde721222 100644 > > > --- a/drivers/firmware/arm_scmi/Makefile > > > +++ b/drivers/firmware/arm_scmi/Makefile > > > @@ -12,6 +12,7 @@ scmi-transport- > > $(CONFIG_ARM_SCMI_TRANSPORT_VIRTIO) > > > += virtio.o > > > scmi-transport-$(CONFIG_ARM_SCMI_TRANSPORT_OPTEE) += optee.o > > > scmi-protocols-y = base.o clock.o perf.o power.o reset.o sensors.o > > > system.o voltage.o powercap.o > > > scmi-protocols-$(CONFIG_IMX_SCMI_BBM_EXT) += imx-sm-bbm.o > > > +scmi-protocols-$(CONFIG_IMX_SCMI_MISC_EXT) += imx-sm-misc.o > > > scmi-module-objs := $(scmi-driver-y) $(scmi-protocols-y) > > > $(scmi-transport-y) > > > > > > obj-$(CONFIG_ARM_SCMI_PROTOCOL) += scmi-core.o diff --git > > > a/drivers/firmware/arm_scmi/imx-sm-misc.c > > > b/drivers/firmware/arm_scmi/imx-sm-misc.c > > > new file mode 100644 > > > index 000000000000..1b0ec2281518 > > > --- /dev/null > > > +++ b/drivers/firmware/arm_scmi/imx-sm-misc.c > > > @@ -0,0 +1,305 @@ > > > +// SPDX-License-Identifier: GPL-2.0 > > > +/* > > > + * System control and Management Interface (SCMI) NXP MISC Protocol > > > + * > > > + * Copyright 2024 NXP > > > + */ > > > + > > > +#define pr_fmt(fmt) "SCMI Notifications MISC - " fmt > > > + > > > +#include > > > +#include > > > +#include > > > +#include > > > +#include > > > +#include > > > +#include > > > + > > > +#include "protocols.h" > > > +#include "notify.h" > > > + > > > +#define SCMI_PROTOCOL_SUPPORTED_VERSION 0x10000 > > > + > > > +enum scmi_imx_misc_protocol_cmd { > > > + SCMI_IMX_MISC_CTRL_SET = 0x3, > > > + SCMI_IMX_MISC_CTRL_GET = 0x4, > > > + SCMI_IMX_MISC_CTRL_NOTIFY = 0x8, > > > +}; > > > + > > > +struct scmi_imx_misc_info { > > > + u32 version; > > > + u32 nr_dev_ctrl; > > > + u32 nr_brd_ctrl; > > > + u32 nr_reason; > > > +}; > > > + > > > +struct scmi_msg_imx_misc_protocol_attributes { > > > + __le32 attributes; > > > +}; > > > + > > > +#define GET_BRD_CTRLS_NR(x) le32_get_bits((x), GENMASK(31, > > 24)) > > > +#define GET_REASONS_NR(x) le32_get_bits((x), GENMASK(23, 16)) > > > +#define GET_DEV_CTRLS_NR(x) le32_get_bits((x), GENMASK(15, 0)) > > > +#define BRD_CTRL_START_ID BIT(15) > > > + > > > +struct scmi_imx_misc_ctrl_set_in { > > > + __le32 id; > > > + __le32 num; > > > + __le32 value[MISC_MAX_VAL]; > > > +}; > > > + > > > +struct scmi_imx_misc_ctrl_notify_in { > > > + __le32 ctrl_id; > > > + __le32 flags; > > > +}; > > > + > > > +struct scmi_imx_misc_ctrl_notify_payld { > > > + __le32 ctrl_id; > > > + __le32 flags; > > > +}; > > > + > > > +struct scmi_imx_misc_ctrl_get_out { > > > + __le32 num; > > > + __le32 *val; > > > +}; > > > + > > > +static int scmi_imx_misc_attributes_get(const struct scmi_protocol_handle > > *ph, > > > + struct scmi_imx_misc_info *mi) > > > +{ > > > + int ret; > > > + struct scmi_xfer *t; > > > + struct scmi_msg_imx_misc_protocol_attributes *attr; > > > + > > > + ret = ph->xops->xfer_get_init(ph, PROTOCOL_ATTRIBUTES, 0, > > > + sizeof(*attr), &t); > > > + if (ret) > > > + return ret; > > > + > > > + attr = t->rx.buf; > > > + > > > + ret = ph->xops->do_xfer(ph, t); > > > + if (!ret) { > > > + mi->nr_dev_ctrl = GET_DEV_CTRLS_NR(attr->attributes); > > > + mi->nr_brd_ctrl = GET_BRD_CTRLS_NR(attr->attributes); > > > + mi->nr_reason = GET_REASONS_NR(attr->attributes); > > > + dev_info(ph->dev, "i.MX MISC NUM DEV CTRL: %d, NUM > > BRD CTRL: %d,NUM Reason: %d\n", > > > + mi->nr_dev_ctrl, mi->nr_brd_ctrl, mi->nr_reason); > > > + } > > > + > > > + ph->xops->xfer_put(ph, t); > > > + > > > + return ret; > > > +} > > > + > > > +static int scmi_imx_misc_ctrl_validate_id(const struct > > scmi_protocol_handle *ph, > > > + u32 ctrl_id) > > > +{ > > > + struct scmi_imx_misc_info *mi = ph->get_priv(ph); > > > + > > > + if ((ctrl_id < BRD_CTRL_START_ID) && (ctrl_id > mi->nr_dev_ctrl)) > > > + return -EINVAL; > > > + if (ctrl_id >= BRD_CTRL_START_ID + mi->nr_brd_ctrl) > > > + return -EINVAL; > > > + > > > + return 0; > > > +} > > > + > > > +static int scmi_imx_misc_ctrl_notify(const struct scmi_protocol_handle > > *ph, > > > + u32 ctrl_id, u32 flags) > > > +{ > > > + struct scmi_imx_misc_ctrl_notify_in *in; > > > + struct scmi_xfer *t; > > > + int ret; > > > + > > > + ret = scmi_imx_misc_ctrl_validate_id(ph, ctrl_id); > > > + if (ret) > > > + return ret; > > > + > > > + ret = ph->xops->xfer_get_init(ph, SCMI_IMX_MISC_CTRL_NOTIFY, > > > + sizeof(*in), 0, &t); > > > + if (ret) > > > + return ret; > > > + > > > + in = t->tx.buf; > > > + in->ctrl_id = cpu_to_le32(ctrl_id); > > > + in->flags = cpu_to_le32(flags); > > > + > > > + ret = ph->xops->do_xfer(ph, t); > > > + > > > + ph->xops->xfer_put(ph, t); > > > + > > > + return ret; > > > +} > > > + > > > +static int > > > +scmi_imx_misc_ctrl_set_notify_enabled(const struct > > scmi_protocol_handle *ph, > > > + u8 evt_id, u32 src_id, bool enable) { > > > + int ret; > > > + > > > + ret = scmi_imx_misc_ctrl_notify(ph, src_id, enable ? evt_id : 0); > > > + if (ret) > > > + dev_err(ph->dev, "FAIL_ENABLED - evt[%X] src[%d] - > > ret:%d\n", > > > + evt_id, src_id, ret); > > > + > > > + return ret; > > > +} > > > + > > > +static int scmi_imx_misc_ctrl_get_num_sources(const struct > > > +scmi_protocol_handle *ph) { > > > + return GENMASK(15, 0); > > > +} > > > + > > > +static void * > > > +scmi_imx_misc_ctrl_fill_custom_report(const struct scmi_protocol_handle > > *ph, > > > + u8 evt_id, ktime_t timestamp, > > > + const void *payld, size_t payld_sz, > > > + void *report, u32 *src_id) > > > +{ > > > + const struct scmi_imx_misc_ctrl_notify_payld *p = payld; > > > + struct scmi_imx_misc_ctrl_notify_report *r = report; > > > + > > > + if (sizeof(*p) != payld_sz) > > > + return NULL; > > > + > > > + r->timestamp = timestamp; > > > + r->ctrl_id = p->ctrl_id; > > > + r->flags = p->flags; > > > + *src_id = r->ctrl_id; > > > + dev_dbg(ph->dev, "%s: ctrl_id: %d flags: %d\n", __func__, > > > + r->ctrl_id, r->flags); > > > + > > > + return r; > > > +} > > > + > > > +static const struct scmi_event_ops scmi_imx_misc_event_ops = { > > > + .get_num_sources = scmi_imx_misc_ctrl_get_num_sources, > > > + .set_notify_enabled = scmi_imx_misc_ctrl_set_notify_enabled, > > > + .fill_custom_report = scmi_imx_misc_ctrl_fill_custom_report, > > > +}; > > > + > > > +static const struct scmi_event scmi_imx_misc_events[] = { > > > + { > > > + .id = SCMI_EVENT_IMX_MISC_CONTROL_DISABLED, > > > + .max_payld_sz = sizeof(struct > > scmi_imx_misc_ctrl_notify_payld), > > > + .max_report_sz = sizeof(struct > > scmi_imx_misc_ctrl_notify_report), > > > + }, > > > + { > > > + .id = SCMI_EVENT_IMX_MISC_CONTROL_FALLING_EDGE, > > > + .max_payld_sz = sizeof(struct > > scmi_imx_misc_ctrl_notify_payld), > > > + .max_report_sz = sizeof(struct > > scmi_imx_misc_ctrl_notify_report), > > > + }, > > > + { > > > + .id = SCMI_EVENT_IMX_MISC_CONTROL_RISING_EDGE, > > > + .max_payld_sz = sizeof(struct > > scmi_imx_misc_ctrl_notify_payld), > > > + .max_report_sz = sizeof(struct > > scmi_imx_misc_ctrl_notify_report), > > > + } > > > +}; > > > + > > > +static struct scmi_protocol_events scmi_imx_misc_protocol_events = { > > > + .queue_sz = SCMI_PROTO_QUEUE_SZ, > > > + .ops = &scmi_imx_misc_event_ops, > > > + .evts = scmi_imx_misc_events, > > > + .num_events = ARRAY_SIZE(scmi_imx_misc_events), }; > > > + > > > +static int scmi_imx_misc_protocol_init(const struct > > > +scmi_protocol_handle *ph) { > > > + struct scmi_imx_misc_info *minfo; > > > + u32 version; > > > + int ret; > > > + > > > + ret = ph->xops->version_get(ph, &version); > > > + if (ret) > > > + return ret; > > > + > > > + dev_info(ph->dev, "NXP SM MISC Version %d.%d\n", > > > + PROTOCOL_REV_MAJOR(version), > > PROTOCOL_REV_MINOR(version)); > > > + > > > + minfo = devm_kzalloc(ph->dev, sizeof(*minfo), GFP_KERNEL); > > > + if (!minfo) > > > + return -ENOMEM; > > > + > > > + ret = scmi_imx_misc_attributes_get(ph, minfo); > > > + if (ret) > > > + return ret; > > > + > > > + return ph->set_priv(ph, minfo, version); } > > > + > > > +static int scmi_imx_misc_ctrl_get(const struct scmi_protocol_handle *ph, > > > + u32 ctrl_id, u32 *num, u32 *val) { > > > + struct scmi_imx_misc_ctrl_get_out *out; > > > + struct scmi_xfer *t; > > > + int ret, i; > > > + > > > + ret = scmi_imx_misc_ctrl_validate_id(ph, ctrl_id); > > > + if (ret) > > > + return ret; > > > + > > > + ret = ph->xops->xfer_get_init(ph, SCMI_IMX_MISC_CTRL_GET, > > sizeof(u32), > > > + 0, &t); > > > + if (ret) > > > + return ret; > > > + > > > + put_unaligned_le32(ctrl_id, t->tx.buf); > > > + ret = ph->xops->do_xfer(ph, t); > > > + if (!ret) { > > > + out = t->rx.buf; > > > + *num = le32_to_cpu(out->num); > > > + for (i = 0; i < *num && i < MISC_MAX_VAL; i++) > > > + val[i] = le32_to_cpu(out->val[i]); > > > + } > > > + > > > + ph->xops->xfer_put(ph, t); > > > + > > > + return ret; > > > +} > > > + > > > +static int scmi_imx_misc_ctrl_set(const struct scmi_protocol_handle *ph, > > > + u32 ctrl_id, u32 num, u32 *val) { > > > + struct scmi_imx_misc_ctrl_set_in *in; > > > + struct scmi_xfer *t; > > > + int ret, i; > > > + > > > + ret = scmi_imx_misc_ctrl_validate_id(ph, ctrl_id); > > > + if (ret) > > > + return ret; > > > + > > > + if (num > MISC_MAX_VAL) > > > + return -EINVAL; > > > + > > > + ret = ph->xops->xfer_get_init(ph, SCMI_IMX_MISC_CTRL_SET, > > sizeof(*in), > > > + 0, &t); > > > + if (ret) > > > + return ret; > > > + > > > + in = t->tx.buf; > > > + in->id = cpu_to_le32(ctrl_id); > > > + in->num = cpu_to_le32(num); > > > + for (i = 0; i < num; i++) > > > + in->value[i] = cpu_to_le32(val[i]); > > > + > > > + ret = ph->xops->do_xfer(ph, t); > > > + > > > + ph->xops->xfer_put(ph, t); > > > + > > > + return ret; > > > +} > > > + > > > +static const struct scmi_imx_misc_proto_ops scmi_imx_misc_proto_ops = > > { > > > + .misc_ctrl_set = scmi_imx_misc_ctrl_set, > > > + .misc_ctrl_get = scmi_imx_misc_ctrl_get, }; > > > + > > > +static const struct scmi_protocol scmi_imx_misc = { > > > + .id = SCMI_PROTOCOL_IMX_MISC, > > > + .owner = THIS_MODULE, > > > + .instance_init = &scmi_imx_misc_protocol_init, > > > + .ops = &scmi_imx_misc_proto_ops, > > > + .events = &scmi_imx_misc_protocol_events, > > > + .supported_version = SCMI_PROTOCOL_SUPPORTED_VERSION, }; > > > +module_scmi_protocol(scmi_imx_misc); > > > diff --git a/include/linux/scmi_imx_protocol.h > > > b/include/linux/scmi_imx_protocol.h > > > index 90ce011a4429..a69bd4a20f0f 100644 > > > --- a/include/linux/scmi_imx_protocol.h > > > +++ b/include/linux/scmi_imx_protocol.h > > > @@ -13,8 +13,14 @@ > > > #include > > > #include > > > > > > +#define SCMI_PAYLOAD_LEN 100 > > > + > > > +#define SCMI_ARRAY(X, Y) ((SCMI_PAYLOAD_LEN - (X)) / sizeof(Y)) > > > +#define MISC_MAX_VAL SCMI_ARRAY(8, uint32_t) > > > + > > > enum scmi_nxp_protocol { > > > SCMI_PROTOCOL_IMX_BBM = 0x81, > > > + SCMI_PROTOCOL_IMX_MISC = 0x84, > > > }; > > > > > > struct scmi_imx_bbm_proto_ops { > > > @@ -42,4 +48,15 @@ struct scmi_imx_bbm_notif_report { > > > unsigned int rtc_id; > > > unsigned int rtc_evt; > > > }; > > > + > > > +struct scmi_imx_misc_ctrl_notify_report { > > > + ktime_t timestamp; > > > + unsigned int ctrl_id; > > > + unsigned int flags; > > > +}; > > > + > > > +struct scmi_imx_misc_proto_ops { > > > + int (*misc_ctrl_set)(const struct scmi_protocol_handle *ph, u32 id, > > u32 num, u32 *val); > > > + int (*misc_ctrl_get)(const struct scmi_protocol_handle *ph, u32 id, > > > +u32 *num, u32 *val); }; > > > #endif > > > > > > -- > > > 2.37.1 > > > > > > > > > >