1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Copyright 2019 NXP.
4*4882a593Smuzhiyun */
5*4882a593Smuzhiyun
6*4882a593Smuzhiyun #include <linux/module.h>
7*4882a593Smuzhiyun #include <linux/kernel.h>
8*4882a593Smuzhiyun #include <linux/platform_device.h>
9*4882a593Smuzhiyun #include <drm/drm_of.h>
10*4882a593Smuzhiyun
11*4882a593Smuzhiyun #include "dcss-dev.h"
12*4882a593Smuzhiyun #include "dcss-kms.h"
13*4882a593Smuzhiyun
14*4882a593Smuzhiyun struct dcss_drv {
15*4882a593Smuzhiyun struct dcss_dev *dcss;
16*4882a593Smuzhiyun struct dcss_kms_dev *kms;
17*4882a593Smuzhiyun };
18*4882a593Smuzhiyun
dcss_drv_dev_to_dcss(struct device * dev)19*4882a593Smuzhiyun struct dcss_dev *dcss_drv_dev_to_dcss(struct device *dev)
20*4882a593Smuzhiyun {
21*4882a593Smuzhiyun struct dcss_drv *mdrv = dev_get_drvdata(dev);
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun return mdrv ? mdrv->dcss : NULL;
24*4882a593Smuzhiyun }
25*4882a593Smuzhiyun
dcss_drv_dev_to_drm(struct device * dev)26*4882a593Smuzhiyun struct drm_device *dcss_drv_dev_to_drm(struct device *dev)
27*4882a593Smuzhiyun {
28*4882a593Smuzhiyun struct dcss_drv *mdrv = dev_get_drvdata(dev);
29*4882a593Smuzhiyun
30*4882a593Smuzhiyun return mdrv ? &mdrv->kms->base : NULL;
31*4882a593Smuzhiyun }
32*4882a593Smuzhiyun
dcss_drv_platform_probe(struct platform_device * pdev)33*4882a593Smuzhiyun static int dcss_drv_platform_probe(struct platform_device *pdev)
34*4882a593Smuzhiyun {
35*4882a593Smuzhiyun struct device *dev = &pdev->dev;
36*4882a593Smuzhiyun struct device_node *remote;
37*4882a593Smuzhiyun struct dcss_drv *mdrv;
38*4882a593Smuzhiyun int err = 0;
39*4882a593Smuzhiyun bool hdmi_output = true;
40*4882a593Smuzhiyun
41*4882a593Smuzhiyun if (!dev->of_node)
42*4882a593Smuzhiyun return -ENODEV;
43*4882a593Smuzhiyun
44*4882a593Smuzhiyun remote = of_graph_get_remote_node(dev->of_node, 0, 0);
45*4882a593Smuzhiyun if (!remote)
46*4882a593Smuzhiyun return -ENODEV;
47*4882a593Smuzhiyun
48*4882a593Smuzhiyun hdmi_output = !of_device_is_compatible(remote, "fsl,imx8mq-nwl-dsi");
49*4882a593Smuzhiyun
50*4882a593Smuzhiyun of_node_put(remote);
51*4882a593Smuzhiyun
52*4882a593Smuzhiyun mdrv = kzalloc(sizeof(*mdrv), GFP_KERNEL);
53*4882a593Smuzhiyun if (!mdrv)
54*4882a593Smuzhiyun return -ENOMEM;
55*4882a593Smuzhiyun
56*4882a593Smuzhiyun mdrv->dcss = dcss_dev_create(dev, hdmi_output);
57*4882a593Smuzhiyun if (IS_ERR(mdrv->dcss)) {
58*4882a593Smuzhiyun err = PTR_ERR(mdrv->dcss);
59*4882a593Smuzhiyun goto err;
60*4882a593Smuzhiyun }
61*4882a593Smuzhiyun
62*4882a593Smuzhiyun dev_set_drvdata(dev, mdrv);
63*4882a593Smuzhiyun
64*4882a593Smuzhiyun mdrv->kms = dcss_kms_attach(mdrv->dcss);
65*4882a593Smuzhiyun if (IS_ERR(mdrv->kms)) {
66*4882a593Smuzhiyun err = PTR_ERR(mdrv->kms);
67*4882a593Smuzhiyun goto dcss_shutoff;
68*4882a593Smuzhiyun }
69*4882a593Smuzhiyun
70*4882a593Smuzhiyun return 0;
71*4882a593Smuzhiyun
72*4882a593Smuzhiyun dcss_shutoff:
73*4882a593Smuzhiyun dcss_dev_destroy(mdrv->dcss);
74*4882a593Smuzhiyun
75*4882a593Smuzhiyun dev_set_drvdata(dev, NULL);
76*4882a593Smuzhiyun
77*4882a593Smuzhiyun err:
78*4882a593Smuzhiyun kfree(mdrv);
79*4882a593Smuzhiyun return err;
80*4882a593Smuzhiyun }
81*4882a593Smuzhiyun
dcss_drv_platform_remove(struct platform_device * pdev)82*4882a593Smuzhiyun static int dcss_drv_platform_remove(struct platform_device *pdev)
83*4882a593Smuzhiyun {
84*4882a593Smuzhiyun struct dcss_drv *mdrv = dev_get_drvdata(&pdev->dev);
85*4882a593Smuzhiyun
86*4882a593Smuzhiyun if (!mdrv)
87*4882a593Smuzhiyun return 0;
88*4882a593Smuzhiyun
89*4882a593Smuzhiyun dcss_kms_detach(mdrv->kms);
90*4882a593Smuzhiyun dcss_dev_destroy(mdrv->dcss);
91*4882a593Smuzhiyun
92*4882a593Smuzhiyun dev_set_drvdata(&pdev->dev, NULL);
93*4882a593Smuzhiyun
94*4882a593Smuzhiyun kfree(mdrv);
95*4882a593Smuzhiyun
96*4882a593Smuzhiyun return 0;
97*4882a593Smuzhiyun }
98*4882a593Smuzhiyun
99*4882a593Smuzhiyun static struct dcss_type_data dcss_types[] = {
100*4882a593Smuzhiyun [DCSS_IMX8MQ] = {
101*4882a593Smuzhiyun .name = "DCSS_IMX8MQ",
102*4882a593Smuzhiyun .blkctl_ofs = 0x2F000,
103*4882a593Smuzhiyun .ctxld_ofs = 0x23000,
104*4882a593Smuzhiyun .dtg_ofs = 0x20000,
105*4882a593Smuzhiyun .scaler_ofs = 0x1C000,
106*4882a593Smuzhiyun .ss_ofs = 0x1B000,
107*4882a593Smuzhiyun .dpr_ofs = 0x18000,
108*4882a593Smuzhiyun },
109*4882a593Smuzhiyun };
110*4882a593Smuzhiyun
111*4882a593Smuzhiyun static const struct of_device_id dcss_of_match[] = {
112*4882a593Smuzhiyun { .compatible = "nxp,imx8mq-dcss", .data = &dcss_types[DCSS_IMX8MQ], },
113*4882a593Smuzhiyun {},
114*4882a593Smuzhiyun };
115*4882a593Smuzhiyun
116*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, dcss_of_match);
117*4882a593Smuzhiyun
118*4882a593Smuzhiyun static const struct dev_pm_ops dcss_dev_pm = {
119*4882a593Smuzhiyun SET_SYSTEM_SLEEP_PM_OPS(dcss_dev_suspend, dcss_dev_resume)
120*4882a593Smuzhiyun SET_RUNTIME_PM_OPS(dcss_dev_runtime_suspend,
121*4882a593Smuzhiyun dcss_dev_runtime_resume, NULL)
122*4882a593Smuzhiyun };
123*4882a593Smuzhiyun
124*4882a593Smuzhiyun static struct platform_driver dcss_platform_driver = {
125*4882a593Smuzhiyun .probe = dcss_drv_platform_probe,
126*4882a593Smuzhiyun .remove = dcss_drv_platform_remove,
127*4882a593Smuzhiyun .driver = {
128*4882a593Smuzhiyun .name = "imx-dcss",
129*4882a593Smuzhiyun .of_match_table = dcss_of_match,
130*4882a593Smuzhiyun .pm = &dcss_dev_pm,
131*4882a593Smuzhiyun },
132*4882a593Smuzhiyun };
133*4882a593Smuzhiyun
134*4882a593Smuzhiyun module_platform_driver(dcss_platform_driver);
135*4882a593Smuzhiyun
136*4882a593Smuzhiyun MODULE_AUTHOR("Laurentiu Palcu <laurentiu.palcu@nxp.com>");
137*4882a593Smuzhiyun MODULE_DESCRIPTION("DCSS driver for i.MX8MQ");
138*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
139