From nobody Wed Dec 17 23:00:03 2025 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 73DA2C5ACB3 for ; Tue, 21 Nov 2023 10:13:42 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S232131AbjKUKNo (ORCPT ); Tue, 21 Nov 2023 05:13:44 -0500 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:34600 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S231936AbjKUKNm (ORCPT ); Tue, 21 Nov 2023 05:13:42 -0500 Received: from mail-lf1-x136.google.com (mail-lf1-x136.google.com [IPv6:2a00:1450:4864:20::136]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 2AE18F4 for ; Tue, 21 Nov 2023 02:13:37 -0800 (PST) Received: by mail-lf1-x136.google.com with SMTP id 2adb3069b0e04-5094cb3a036so7713508e87.2 for ; Tue, 21 Nov 2023 02:13:37 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=9elements.com; s=google; t=1700561615; x=1701166415; darn=vger.kernel.org; h=content-transfer-encoding:mime-version:message-id:date:subject:cc :to:from:from:to:cc:subject:date:message-id:reply-to; bh=X2VdqDxdByXD1LNmM0mdnnOXlg3cwMHJDPDXfeCHhLY=; b=XNuHg5ljo7oRUTtTzZ06lqxjFsHDrt4MbUo+606b+CJgaECwZH31LabQLlod5GOC+s ux5fK513JNG7msLlpCwVFyivYenc4+2YgTHVB/obSxznh/gGi6hxnruKszirMFsq+ldq YtxSe6fgldRbKRCbbfW83SadLqZ/lcRauTrfYlqSy064mY19LLzvzKc+oWUeiFS9notE +wLTNcJiwaMWq26xmm8fEAlKOzp0Y26QMxrJe8nm+wqYSW5LfiM04Zts83/v1Nu8YLpS sN6LPAnWdR2BMg3ZJEj1ODDHoLw5jpuHDza168zUophfmuCAlMKiz3ntd45GwTmcPxPw ybAA== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1700561615; x=1701166415; h=content-transfer-encoding:mime-version:message-id:date:subject:cc :to:from:x-gm-message-state:from:to:cc:subject:date:message-id :reply-to; bh=X2VdqDxdByXD1LNmM0mdnnOXlg3cwMHJDPDXfeCHhLY=; b=AZX8dARHtUE3bYeiiL8qkXPG5M0nk5WIDaJqg+JlwqlQDhzCJIikkFK3CTeMfD08uj tkYVEBQLP3mXLdnU84kxOJ4kUaQHvswgjJZKRSJO+RALKQh0d7yD7Q6wcxFv+4QFB0vO 5YPjQeR7Lq8doa02tsXu9APV/xKic56IAPixJTDA/ADRFCKe41jgxFBPj2Hzht2fN5wS mZGPi8EzPrQ0Q/cd6zroREvqsbCEBOP2kuXAbt5rASQoxXXWHPr64KfgywJu553mc4EG jaPBUDHExZ/ovNoLLPxysB2OB27eNv5ULq1eMx5gPOOX8vvKLyyQEbFmPX6muosAdf7z g4Ng== X-Gm-Message-State: AOJu0YxXrP7+RJEjliMRN1cdyYTRcZqY5X9PxWfA5PXzOkz5YbU56Gg1 DOZX83N1Oslq7cyadlEXatkc+SiIDqp5zbjelb1Smg== X-Google-Smtp-Source: AGHT+IFNmv4PBLZ03ybGSxBfXAiSjYYQxKO6zPQ1cO85/FzJv0uCLSO87u6d4dt7cHgAg7FMz5BTpA== X-Received: by 2002:ac2:4219:0:b0:509:4655:d8d6 with SMTP id y25-20020ac24219000000b005094655d8d6mr5882345lfh.67.1700561615317; Tue, 21 Nov 2023 02:13:35 -0800 (PST) Received: from stroh80.sec.9e.network (ip-078-094-000-051.um19.pools.vodafone-ip.de. [78.94.0.51]) by smtp.gmail.com with ESMTPSA id x5-20020aa7dac5000000b005489e55d95esm2693433eds.22.2023.11.21.02.13.34 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Tue, 21 Nov 2023 02:13:34 -0800 (PST) From: Naresh Solanki To: Liam Girdwood , Mark Brown Cc: Naresh Solanki , linux-kernel@vger.kernel.org Subject: [PATCH v2] regulator: event: Add regulator netlink event support Date: Tue, 21 Nov 2023 10:13:30 +0000 Message-ID: <20231121101331.22837-1-naresh.solanki@9elements.com> X-Mailer: git-send-email 2.41.0 MIME-Version: 1.0 Content-Transfer-Encoding: quoted-printable Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Content-Type: text/plain; charset="utf-8" This commit introduces netlink event support to the regulator subsystem. Changes: - Introduce event.c and regnl.h for netlink event handling. - Implement reg_generate_netlink_event to broadcast regulator events. - Update Makefile to include the new event.c file. Signed-off-by: Naresh Solanki --- drivers/regulator/Makefile | 1 + drivers/regulator/core.c | 7 +- drivers/regulator/event.c | 134 +++++++++++++++++++++++++++++++++++++ drivers/regulator/regnl.h | 8 +++ 4 files changed, 149 insertions(+), 1 deletion(-) create mode 100644 drivers/regulator/event.c create mode 100644 drivers/regulator/regnl.h diff --git a/drivers/regulator/Makefile b/drivers/regulator/Makefile index b2b059b5ee56..de37144e4784 100644 --- a/drivers/regulator/Makefile +++ b/drivers/regulator/Makefile @@ -5,6 +5,7 @@ =20 =20 obj-$(CONFIG_REGULATOR) +=3D core.o dummy.o fixed-helper.o helpers.o devre= s.o irq_helpers.o +obj-$(CONFIG_REGULATOR) +=3D event.o obj-$(CONFIG_OF) +=3D of_regulator.o obj-$(CONFIG_REGULATOR_FIXED_VOLTAGE) +=3D fixed.o obj-$(CONFIG_REGULATOR_VIRTUAL_CONSUMER) +=3D virtual.o diff --git a/drivers/regulator/core.c b/drivers/regulator/core.c index 4aa9ec8c22f3..384ffe8618fd 100644 --- a/drivers/regulator/core.c +++ b/drivers/regulator/core.c @@ -33,6 +33,7 @@ =20 #include "dummy.h" #include "internal.h" +#include "regnl.h" =20 static DEFINE_WW_CLASS(regulator_ww_class); static DEFINE_MUTEX(regulator_nesting_mutex); @@ -4854,7 +4855,11 @@ static int _notifier_call_chain(struct regulator_dev= *rdev, unsigned long event, void *data) { /* call rdev chain first */ - return blocking_notifier_call_chain(&rdev->notifier, event, data); + int ret =3D blocking_notifier_call_chain(&rdev->notifier, event, data); + + reg_generate_netlink_event(rdev_get_name(rdev), event); + + return ret; } =20 int _regulator_bulk_get(struct device *dev, int num_consumers, diff --git a/drivers/regulator/event.c b/drivers/regulator/event.c new file mode 100644 index 000000000000..359539a2a05a --- /dev/null +++ b/drivers/regulator/event.c @@ -0,0 +1,134 @@ +// SPDX-License-Identifier: GPL-2.0 + +#include +#include + +#include "regnl.h" + +#ifdef CONFIG_NET +static unsigned int reg_event_seqnum; +struct reg_genl_event { + char reg_name[15]; + u64 event; +}; + +/* attributes of reg_genl_family */ +enum { + REG_GENL_ATTR_UNSPEC, + REG_GENL_ATTR_EVENT, /* reg event info needed by user space */ + __REG_GENL_ATTR_MAX, +}; + +#define REG_GENL_ATTR_MAX (__REG_GENL_ATTR_MAX - 1) + +/* commands supported by the reg_genl_family */ +enum { + REG_GENL_CMD_UNSPEC, + REG_GENL_CMD_EVENT, /* kernel->user notifications for reg events */ + __REG_GENL_CMD_MAX, +}; + +#define REG_GENL_CMD_MAX (__REG_GENL_CMD_MAX - 1) + +#define REG_GENL_FAMILY_NAME "reg_event" +#define REG_GENL_VERSION 0x01 +#define REG_GENL_MCAST_GROUP_NAME "reg_mc_group" + +static const struct genl_multicast_group reg_event_mcgrps[] =3D { + { .name =3D REG_GENL_MCAST_GROUP_NAME, }, +}; + +static struct genl_family reg_event_genl_family __ro_after_init =3D { + .module =3D THIS_MODULE, + .name =3D REG_GENL_FAMILY_NAME, + .version =3D REG_GENL_VERSION, + .maxattr =3D REG_GENL_ATTR_MAX, + .mcgrps =3D reg_event_mcgrps, + .n_mcgrps =3D ARRAY_SIZE(reg_event_mcgrps), +}; + +int reg_generate_netlink_event(const char *reg_name, u64 event) +{ + struct sk_buff *skb; + struct nlattr *attr; + struct reg_genl_event *edata; + void *msg_header; + int size; + + /* allocate memory */ + size =3D nla_total_size(sizeof(struct reg_genl_event)) + + nla_total_size(0); + + skb =3D genlmsg_new(size, GFP_ATOMIC); + if (!skb) + return -ENOMEM; + + /* add the genetlink message header */ + msg_header =3D genlmsg_put(skb, 0, reg_event_seqnum++, + ®_event_genl_family, 0, + REG_GENL_CMD_EVENT); + if (!msg_header) { + nlmsg_free(skb); + return -ENOMEM; + } + + /* fill the data */ + attr =3D nla_reserve(skb, REG_GENL_ATTR_EVENT, sizeof(struct reg_genl_eve= nt)); + if (!attr) { + nlmsg_free(skb); + return -EINVAL; + } + + edata =3D nla_data(attr); + memset(edata, 0, sizeof(struct reg_genl_event)); + + strscpy(edata->reg_name, reg_name, sizeof(edata->reg_name)); + edata->event =3D event; + + /* send multicast genetlink message */ + genlmsg_end(skb, msg_header); + size =3D genlmsg_multicast(®_event_genl_family, skb, 0, 0, GFP_ATOMIC); + + pr_debug("%s -> %llx , ret: %x", reg_name, event, size); + if (size =3D=3D -ESRCH) + pr_debug("multicast message sent, but nobody was listening...\n"); + else if (size) + pr_debug("failed to send multicast genl message\n"); + else + pr_debug("multicast message sent %d\n", reg_event_seqnum); + + return 0; +} +EXPORT_SYMBOL(reg_generate_netlink_event); + +static int __init reg_event_genetlink_init(void) +{ + return genl_register_family(®_event_genl_family); +} + +#else +int reg_generate_netlink_event(const char *reg_name, u64 event) +{ + return 0; +} +EXPORT_SYMBOL(reg_generate_netlink_event); + +static int reg_event_genetlink_init(void) +{ + return -ENODEV; +} +#endif + +static int __init reg_event_init(void) +{ + int error; + + /* create genetlink for acpi event */ + error =3D reg_event_genetlink_init(); + if (error) + pr_warn("Failed to create genetlink family for reg event\n"); + + return 0; +} + +fs_initcall(reg_event_init); diff --git a/drivers/regulator/regnl.h b/drivers/regulator/regnl.h new file mode 100644 index 000000000000..0b27972bd523 --- /dev/null +++ b/drivers/regulator/regnl.h @@ -0,0 +1,8 @@ +/* SPDX-License-Identifier: GPL-2.0-or-later */ + +#ifndef __REGULATOR_EVENT_H +#define __REGULATOR_EVENT_H + +int reg_generate_netlink_event(const char *reg_name, u64 event); + +#endif base-commit: 753e4d5c433da57da75dd4c3e1aececc8e874a62 --=20 2.41.0