19d3ba0b6SHao Zhang // SPDX-License-Identifier: GPL-2.0
29d3ba0b6SHao Zhang /*
39d3ba0b6SHao Zhang * Copyright (c) 2023 Qualcomm Innovation Center, Inc. All rights reserved.
49d3ba0b6SHao Zhang */
59d3ba0b6SHao Zhang
69d3ba0b6SHao Zhang #include <linux/coresight.h>
79d3ba0b6SHao Zhang #include <linux/kernel.h>
89d3ba0b6SHao Zhang #include <linux/module.h>
99d3ba0b6SHao Zhang #include <linux/of.h>
109d3ba0b6SHao Zhang #include <linux/platform_device.h>
119d3ba0b6SHao Zhang #include <linux/pm_runtime.h>
129d3ba0b6SHao Zhang
139d3ba0b6SHao Zhang #include "coresight-priv.h"
149d3ba0b6SHao Zhang
159d3ba0b6SHao Zhang struct dummy_drvdata {
169d3ba0b6SHao Zhang struct device *dev;
179d3ba0b6SHao Zhang struct coresight_device *csdev;
189d3ba0b6SHao Zhang };
199d3ba0b6SHao Zhang
209d3ba0b6SHao Zhang DEFINE_CORESIGHT_DEVLIST(source_devs, "dummy_source");
219d3ba0b6SHao Zhang DEFINE_CORESIGHT_DEVLIST(sink_devs, "dummy_sink");
229d3ba0b6SHao Zhang
dummy_source_enable(struct coresight_device * csdev,struct perf_event * event,enum cs_mode mode)239d3ba0b6SHao Zhang static int dummy_source_enable(struct coresight_device *csdev,
24185891f0SNathan Chancellor struct perf_event *event, enum cs_mode mode)
259d3ba0b6SHao Zhang {
269d3ba0b6SHao Zhang dev_dbg(csdev->dev.parent, "Dummy source enabled\n");
279d3ba0b6SHao Zhang
289d3ba0b6SHao Zhang return 0;
299d3ba0b6SHao Zhang }
309d3ba0b6SHao Zhang
dummy_source_disable(struct coresight_device * csdev,struct perf_event * event)319d3ba0b6SHao Zhang static void dummy_source_disable(struct coresight_device *csdev,
329d3ba0b6SHao Zhang struct perf_event *event)
339d3ba0b6SHao Zhang {
349d3ba0b6SHao Zhang dev_dbg(csdev->dev.parent, "Dummy source disabled\n");
359d3ba0b6SHao Zhang }
369d3ba0b6SHao Zhang
dummy_sink_enable(struct coresight_device * csdev,enum cs_mode mode,void * data)37185891f0SNathan Chancellor static int dummy_sink_enable(struct coresight_device *csdev, enum cs_mode mode,
389d3ba0b6SHao Zhang void *data)
399d3ba0b6SHao Zhang {
409d3ba0b6SHao Zhang dev_dbg(csdev->dev.parent, "Dummy sink enabled\n");
419d3ba0b6SHao Zhang
429d3ba0b6SHao Zhang return 0;
439d3ba0b6SHao Zhang }
449d3ba0b6SHao Zhang
dummy_sink_disable(struct coresight_device * csdev)459d3ba0b6SHao Zhang static int dummy_sink_disable(struct coresight_device *csdev)
469d3ba0b6SHao Zhang {
479d3ba0b6SHao Zhang dev_dbg(csdev->dev.parent, "Dummy sink disabled\n");
489d3ba0b6SHao Zhang
499d3ba0b6SHao Zhang return 0;
509d3ba0b6SHao Zhang }
519d3ba0b6SHao Zhang
529d3ba0b6SHao Zhang static const struct coresight_ops_source dummy_source_ops = {
539d3ba0b6SHao Zhang .enable = dummy_source_enable,
549d3ba0b6SHao Zhang .disable = dummy_source_disable,
559d3ba0b6SHao Zhang };
569d3ba0b6SHao Zhang
579d3ba0b6SHao Zhang static const struct coresight_ops dummy_source_cs_ops = {
589d3ba0b6SHao Zhang .source_ops = &dummy_source_ops,
599d3ba0b6SHao Zhang };
609d3ba0b6SHao Zhang
619d3ba0b6SHao Zhang static const struct coresight_ops_sink dummy_sink_ops = {
629d3ba0b6SHao Zhang .enable = dummy_sink_enable,
639d3ba0b6SHao Zhang .disable = dummy_sink_disable,
649d3ba0b6SHao Zhang };
659d3ba0b6SHao Zhang
669d3ba0b6SHao Zhang static const struct coresight_ops dummy_sink_cs_ops = {
679d3ba0b6SHao Zhang .sink_ops = &dummy_sink_ops,
689d3ba0b6SHao Zhang };
699d3ba0b6SHao Zhang
dummy_probe(struct platform_device * pdev)709d3ba0b6SHao Zhang static int dummy_probe(struct platform_device *pdev)
719d3ba0b6SHao Zhang {
729d3ba0b6SHao Zhang struct device *dev = &pdev->dev;
739d3ba0b6SHao Zhang struct device_node *node = dev->of_node;
749d3ba0b6SHao Zhang struct coresight_platform_data *pdata;
759d3ba0b6SHao Zhang struct dummy_drvdata *drvdata;
769d3ba0b6SHao Zhang struct coresight_desc desc = { 0 };
779d3ba0b6SHao Zhang
789d3ba0b6SHao Zhang if (of_device_is_compatible(node, "arm,coresight-dummy-source")) {
799d3ba0b6SHao Zhang
809d3ba0b6SHao Zhang desc.name = coresight_alloc_device_name(&source_devs, dev);
819d3ba0b6SHao Zhang if (!desc.name)
829d3ba0b6SHao Zhang return -ENOMEM;
839d3ba0b6SHao Zhang
849d3ba0b6SHao Zhang desc.type = CORESIGHT_DEV_TYPE_SOURCE;
859d3ba0b6SHao Zhang desc.subtype.source_subtype =
869d3ba0b6SHao Zhang CORESIGHT_DEV_SUBTYPE_SOURCE_OTHERS;
879d3ba0b6SHao Zhang desc.ops = &dummy_source_cs_ops;
889d3ba0b6SHao Zhang } else if (of_device_is_compatible(node, "arm,coresight-dummy-sink")) {
899d3ba0b6SHao Zhang desc.name = coresight_alloc_device_name(&sink_devs, dev);
909d3ba0b6SHao Zhang if (!desc.name)
919d3ba0b6SHao Zhang return -ENOMEM;
929d3ba0b6SHao Zhang
939d3ba0b6SHao Zhang desc.type = CORESIGHT_DEV_TYPE_SINK;
949d3ba0b6SHao Zhang desc.subtype.sink_subtype = CORESIGHT_DEV_SUBTYPE_SINK_DUMMY;
959d3ba0b6SHao Zhang desc.ops = &dummy_sink_cs_ops;
969d3ba0b6SHao Zhang } else {
979d3ba0b6SHao Zhang dev_err(dev, "Device type not set\n");
989d3ba0b6SHao Zhang return -EINVAL;
999d3ba0b6SHao Zhang }
1009d3ba0b6SHao Zhang
1019d3ba0b6SHao Zhang pdata = coresight_get_platform_data(dev);
1029d3ba0b6SHao Zhang if (IS_ERR(pdata))
1039d3ba0b6SHao Zhang return PTR_ERR(pdata);
1049d3ba0b6SHao Zhang pdev->dev.platform_data = pdata;
1059d3ba0b6SHao Zhang
1069d3ba0b6SHao Zhang drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);
1079d3ba0b6SHao Zhang if (!drvdata)
1089d3ba0b6SHao Zhang return -ENOMEM;
1099d3ba0b6SHao Zhang
1109d3ba0b6SHao Zhang drvdata->dev = &pdev->dev;
1119d3ba0b6SHao Zhang platform_set_drvdata(pdev, drvdata);
1129d3ba0b6SHao Zhang
1139d3ba0b6SHao Zhang desc.pdata = pdev->dev.platform_data;
1149d3ba0b6SHao Zhang desc.dev = &pdev->dev;
1159d3ba0b6SHao Zhang drvdata->csdev = coresight_register(&desc);
1169d3ba0b6SHao Zhang if (IS_ERR(drvdata->csdev))
1179d3ba0b6SHao Zhang return PTR_ERR(drvdata->csdev);
1189d3ba0b6SHao Zhang
1199d3ba0b6SHao Zhang pm_runtime_enable(dev);
1209d3ba0b6SHao Zhang dev_dbg(dev, "Dummy device initialized\n");
1219d3ba0b6SHao Zhang
1229d3ba0b6SHao Zhang return 0;
1239d3ba0b6SHao Zhang }
1249d3ba0b6SHao Zhang
dummy_remove(struct platform_device * pdev)1259d3ba0b6SHao Zhang static int dummy_remove(struct platform_device *pdev)
1269d3ba0b6SHao Zhang {
1279d3ba0b6SHao Zhang struct dummy_drvdata *drvdata = platform_get_drvdata(pdev);
1289d3ba0b6SHao Zhang struct device *dev = &pdev->dev;
1299d3ba0b6SHao Zhang
1309d3ba0b6SHao Zhang pm_runtime_disable(dev);
1319d3ba0b6SHao Zhang coresight_unregister(drvdata->csdev);
1329d3ba0b6SHao Zhang return 0;
1339d3ba0b6SHao Zhang }
1349d3ba0b6SHao Zhang
1359d3ba0b6SHao Zhang static const struct of_device_id dummy_match[] = {
1369d3ba0b6SHao Zhang {.compatible = "arm,coresight-dummy-source"},
1379d3ba0b6SHao Zhang {.compatible = "arm,coresight-dummy-sink"},
1389d3ba0b6SHao Zhang {},
1399d3ba0b6SHao Zhang };
1409d3ba0b6SHao Zhang
1419d3ba0b6SHao Zhang static struct platform_driver dummy_driver = {
1429d3ba0b6SHao Zhang .probe = dummy_probe,
1439d3ba0b6SHao Zhang .remove = dummy_remove,
1449d3ba0b6SHao Zhang .driver = {
1459d3ba0b6SHao Zhang .name = "coresight-dummy",
1469d3ba0b6SHao Zhang .of_match_table = dummy_match,
1479d3ba0b6SHao Zhang },
1489d3ba0b6SHao Zhang };
1499d3ba0b6SHao Zhang
150*28a03faeSYang Yingliang module_platform_driver(dummy_driver);
1519d3ba0b6SHao Zhang
1529d3ba0b6SHao Zhang MODULE_LICENSE("GPL");
1539d3ba0b6SHao Zhang MODULE_DESCRIPTION("CoreSight dummy driver");
154