1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * (C) COPYRIGHT 2018 ARM Limited. All rights reserved.
4 * Author: James.Qian.Wang <james.qian.wang@arm.com>
5 *
6 */
7 #include <linux/module.h>
8 #include <linux/kernel.h>
9 #include <linux/of.h>
10 #include <linux/platform_device.h>
11 #include <linux/pm_runtime.h>
12 #include <drm/clients/drm_client_setup.h>
13 #include <drm/drm_module.h>
14 #include <drm/drm_of.h>
15 #include "komeda_dev.h"
16 #include "komeda_kms.h"
17
18 struct komeda_drv {
19 struct komeda_dev *mdev;
20 struct komeda_kms_dev *kms;
21 };
22
dev_to_mdev(struct device * dev)23 struct komeda_dev *dev_to_mdev(struct device *dev)
24 {
25 struct komeda_drv *mdrv = dev_get_drvdata(dev);
26
27 return mdrv ? mdrv->mdev : NULL;
28 }
29
komeda_platform_remove(struct platform_device * pdev)30 static void komeda_platform_remove(struct platform_device *pdev)
31 {
32 struct device *dev = &pdev->dev;
33 struct komeda_drv *mdrv = dev_get_drvdata(dev);
34
35 komeda_kms_detach(mdrv->kms);
36
37 if (pm_runtime_enabled(dev))
38 pm_runtime_disable(dev);
39 else
40 komeda_dev_suspend(mdrv->mdev);
41
42 komeda_dev_destroy(mdrv->mdev);
43
44 dev_set_drvdata(dev, NULL);
45 devm_kfree(dev, mdrv);
46 }
47
komeda_platform_shutdown(struct platform_device * pdev)48 static void komeda_platform_shutdown(struct platform_device *pdev)
49 {
50 struct device *dev = &pdev->dev;
51 struct komeda_drv *mdrv = dev_get_drvdata(dev);
52
53 komeda_kms_shutdown(mdrv->kms);
54 }
55
komeda_platform_probe(struct platform_device * pdev)56 static int komeda_platform_probe(struct platform_device *pdev)
57 {
58 struct device *dev = &pdev->dev;
59 struct komeda_drv *mdrv;
60 int err;
61
62 err = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(40));
63 if (err)
64 return dev_err_probe(dev, err, "DMA mask error\n");
65
66 mdrv = devm_kzalloc(dev, sizeof(*mdrv), GFP_KERNEL);
67 if (!mdrv)
68 return -ENOMEM;
69
70 mdrv->mdev = komeda_dev_create(dev);
71 if (IS_ERR(mdrv->mdev)) {
72 err = PTR_ERR(mdrv->mdev);
73 goto free_mdrv;
74 }
75
76 pm_runtime_enable(dev);
77 if (!pm_runtime_enabled(dev)) {
78 err = komeda_dev_resume(mdrv->mdev);
79 if (err)
80 goto err_destroy_mdev;
81 }
82
83 mdrv->kms = komeda_kms_attach(mdrv->mdev);
84 if (IS_ERR(mdrv->kms)) {
85 err = PTR_ERR(mdrv->kms);
86 goto destroy_mdev;
87 }
88
89 dev_set_drvdata(dev, mdrv);
90 drm_client_setup(&mdrv->kms->base, NULL);
91
92 return 0;
93
94 destroy_mdev:
95 if (pm_runtime_enabled(dev))
96 pm_runtime_disable(dev);
97 else
98 komeda_dev_suspend(mdrv->mdev);
99 err_destroy_mdev:
100 komeda_dev_destroy(mdrv->mdev);
101
102 free_mdrv:
103 devm_kfree(dev, mdrv);
104 return err;
105 }
106
107 static const struct of_device_id komeda_of_match[] = {
108 { .compatible = "arm,mali-d71", .data = d71_identify, },
109 { .compatible = "arm,mali-d32", .data = d71_identify, },
110 { .compatible = "armchina,linlon-d6", .data = d71_identify, },
111 {},
112 };
113
114 MODULE_DEVICE_TABLE(of, komeda_of_match);
115
komeda_rt_pm_suspend(struct device * dev)116 static int __maybe_unused komeda_rt_pm_suspend(struct device *dev)
117 {
118 struct komeda_drv *mdrv = dev_get_drvdata(dev);
119
120 return komeda_dev_suspend(mdrv->mdev);
121 }
122
komeda_rt_pm_resume(struct device * dev)123 static int __maybe_unused komeda_rt_pm_resume(struct device *dev)
124 {
125 struct komeda_drv *mdrv = dev_get_drvdata(dev);
126
127 return komeda_dev_resume(mdrv->mdev);
128 }
129
komeda_pm_suspend(struct device * dev)130 static int __maybe_unused komeda_pm_suspend(struct device *dev)
131 {
132 struct komeda_drv *mdrv = dev_get_drvdata(dev);
133 int res;
134
135 res = drm_mode_config_helper_suspend(&mdrv->kms->base);
136
137 if (!pm_runtime_status_suspended(dev))
138 komeda_dev_suspend(mdrv->mdev);
139
140 return res;
141 }
142
komeda_pm_resume(struct device * dev)143 static int __maybe_unused komeda_pm_resume(struct device *dev)
144 {
145 struct komeda_drv *mdrv = dev_get_drvdata(dev);
146 int err = 0;
147
148 if (!pm_runtime_status_suspended(dev))
149 err = komeda_dev_resume(mdrv->mdev);
150
151 return err ? err : drm_mode_config_helper_resume(&mdrv->kms->base);
152 }
153
154 static const struct dev_pm_ops komeda_pm_ops = {
155 SET_SYSTEM_SLEEP_PM_OPS(komeda_pm_suspend, komeda_pm_resume)
156 SET_RUNTIME_PM_OPS(komeda_rt_pm_suspend, komeda_rt_pm_resume, NULL)
157 };
158
159 static struct platform_driver komeda_platform_driver = {
160 .probe = komeda_platform_probe,
161 .remove = komeda_platform_remove,
162 .shutdown = komeda_platform_shutdown,
163 .driver = {
164 .name = "komeda",
165 .of_match_table = komeda_of_match,
166 .pm = &komeda_pm_ops,
167 },
168 };
169
170 drm_module_platform_driver(komeda_platform_driver);
171
172 MODULE_AUTHOR("James.Qian.Wang <james.qian.wang@arm.com>");
173 MODULE_DESCRIPTION("Komeda KMS driver");
174 MODULE_LICENSE("GPL v2");
175