120 lines · c
1// SPDX-License-Identifier: GPL-2.0+2/*3 * Copyright 2024 NXP4 */5 6#include <linux/firmware/imx/sm.h>7#include <linux/module.h>8#include <linux/of.h>9#include <linux/platform_device.h>10#include <linux/scmi_protocol.h>11#include <linux/scmi_imx_protocol.h>12 13static const struct scmi_imx_misc_proto_ops *imx_misc_ctrl_ops;14static struct scmi_protocol_handle *ph;15struct notifier_block scmi_imx_misc_ctrl_nb;16 17int scmi_imx_misc_ctrl_set(u32 id, u32 val)18{19 if (!ph)20 return -EPROBE_DEFER;21 22 return imx_misc_ctrl_ops->misc_ctrl_set(ph, id, 1, &val);23};24EXPORT_SYMBOL(scmi_imx_misc_ctrl_set);25 26int scmi_imx_misc_ctrl_get(u32 id, u32 *num, u32 *val)27{28 if (!ph)29 return -EPROBE_DEFER;30 31 return imx_misc_ctrl_ops->misc_ctrl_get(ph, id, num, val);32}33EXPORT_SYMBOL(scmi_imx_misc_ctrl_get);34 35static int scmi_imx_misc_ctrl_notifier(struct notifier_block *nb,36 unsigned long event, void *data)37{38 /*39 * notifier_chain_register requires a valid notifier_block and40 * valid notifier_call. SCMI_EVENT_IMX_MISC_CONTROL is needed41 * to let SCMI firmware enable control events, but the hook here42 * is just a dummy function to avoid kernel panic as of now.43 */44 return 0;45}46 47static int scmi_imx_misc_ctrl_probe(struct scmi_device *sdev)48{49 const struct scmi_handle *handle = sdev->handle;50 struct device_node *np = sdev->dev.of_node;51 u32 src_id, flags;52 int ret, i, num;53 54 if (!handle)55 return -ENODEV;56 57 if (imx_misc_ctrl_ops) {58 dev_err(&sdev->dev, "misc ctrl already initialized\n");59 return -EEXIST;60 }61 62 imx_misc_ctrl_ops = handle->devm_protocol_get(sdev, SCMI_PROTOCOL_IMX_MISC, &ph);63 if (IS_ERR(imx_misc_ctrl_ops))64 return PTR_ERR(imx_misc_ctrl_ops);65 66 num = of_property_count_u32_elems(np, "nxp,ctrl-ids");67 if (num % 2) {68 dev_err(&sdev->dev, "Invalid wakeup-sources\n");69 return -EINVAL;70 }71 72 scmi_imx_misc_ctrl_nb.notifier_call = &scmi_imx_misc_ctrl_notifier;73 for (i = 0; i < num; i += 2) {74 ret = of_property_read_u32_index(np, "nxp,ctrl-ids", i, &src_id);75 if (ret) {76 dev_err(&sdev->dev, "Failed to read ctrl-id: %i\n", i);77 continue;78 }79 80 ret = of_property_read_u32_index(np, "nxp,ctrl-ids", i + 1, &flags);81 if (ret) {82 dev_err(&sdev->dev, "Failed to read ctrl-id value: %d\n", i + 1);83 continue;84 }85 86 ret = handle->notify_ops->devm_event_notifier_register(sdev, SCMI_PROTOCOL_IMX_MISC,87 SCMI_EVENT_IMX_MISC_CONTROL,88 &src_id,89 &scmi_imx_misc_ctrl_nb);90 if (ret) {91 dev_err(&sdev->dev, "Failed to register scmi misc event: %d\n", src_id);92 } else {93 ret = imx_misc_ctrl_ops->misc_ctrl_req_notify(ph, src_id,94 SCMI_EVENT_IMX_MISC_CONTROL,95 flags);96 if (ret)97 dev_err(&sdev->dev, "Failed to req notify: %d\n", src_id);98 }99 }100 101 return 0;102}103 104static const struct scmi_device_id scmi_id_table[] = {105 { SCMI_PROTOCOL_IMX_MISC, "imx-misc-ctrl" },106 { },107};108MODULE_DEVICE_TABLE(scmi, scmi_id_table);109 110static struct scmi_driver scmi_imx_misc_ctrl_driver = {111 .name = "scmi-imx-misc-ctrl",112 .probe = scmi_imx_misc_ctrl_probe,113 .id_table = scmi_id_table,114};115module_scmi_driver(scmi_imx_misc_ctrl_driver);116 117MODULE_AUTHOR("Peng Fan <peng.fan@nxp.com>");118MODULE_DESCRIPTION("IMX SM MISC driver");119MODULE_LICENSE("GPL");120