2bb98fc1d4
dcss currently allocates and ioremaps quite a few resources in its probe function's call graph. Devres now provides convenient functions which perform the same task but do the cleanup automatically. Port all memory allocations and ioremap() calls to the devres counterparts. Signed-off-by: Philipp Stanner <pstanner@redhat.com> Reviewed-by: Laurentiu Palcu <laurentiu.palcu@oss.nxp.com> Signed-off-by: Laurentiu Palcu <laurentiu.palcu@oss.nxp.com> Link: https://patchwork.freedesktop.org/patch/msgid/20240124111904.18261-4-pstanner@redhat.com
128 lines
2.7 KiB
C
128 lines
2.7 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* Copyright 2019 NXP.
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/of.h>
|
|
#include <linux/platform_device.h>
|
|
#include <drm/drm_module.h>
|
|
#include <drm/drm_of.h>
|
|
|
|
#include "dcss-dev.h"
|
|
#include "dcss-kms.h"
|
|
|
|
struct dcss_drv {
|
|
struct dcss_dev *dcss;
|
|
struct dcss_kms_dev *kms;
|
|
};
|
|
|
|
struct dcss_dev *dcss_drv_dev_to_dcss(struct device *dev)
|
|
{
|
|
struct dcss_drv *mdrv = dev_get_drvdata(dev);
|
|
|
|
return mdrv ? mdrv->dcss : NULL;
|
|
}
|
|
|
|
struct drm_device *dcss_drv_dev_to_drm(struct device *dev)
|
|
{
|
|
struct dcss_drv *mdrv = dev_get_drvdata(dev);
|
|
|
|
return mdrv ? &mdrv->kms->base : NULL;
|
|
}
|
|
|
|
static int dcss_drv_platform_probe(struct platform_device *pdev)
|
|
{
|
|
struct device *dev = &pdev->dev;
|
|
struct device_node *remote;
|
|
struct dcss_drv *mdrv;
|
|
int err = 0;
|
|
bool hdmi_output = true;
|
|
|
|
if (!dev->of_node)
|
|
return -ENODEV;
|
|
|
|
remote = of_graph_get_remote_node(dev->of_node, 0, 0);
|
|
if (!remote)
|
|
return -ENODEV;
|
|
|
|
hdmi_output = !of_device_is_compatible(remote, "fsl,imx8mq-nwl-dsi");
|
|
|
|
of_node_put(remote);
|
|
|
|
mdrv = devm_kzalloc(dev, sizeof(*mdrv), GFP_KERNEL);
|
|
if (!mdrv)
|
|
return -ENOMEM;
|
|
|
|
mdrv->dcss = dcss_dev_create(dev, hdmi_output);
|
|
if (IS_ERR(mdrv->dcss))
|
|
return PTR_ERR(mdrv->dcss);
|
|
|
|
dev_set_drvdata(dev, mdrv);
|
|
|
|
mdrv->kms = dcss_kms_attach(mdrv->dcss);
|
|
if (IS_ERR(mdrv->kms)) {
|
|
err = PTR_ERR(mdrv->kms);
|
|
dev_err_probe(dev, err, "Failed to initialize KMS\n");
|
|
goto dcss_shutoff;
|
|
}
|
|
|
|
return 0;
|
|
|
|
dcss_shutoff:
|
|
dcss_dev_destroy(mdrv->dcss);
|
|
|
|
return err;
|
|
}
|
|
|
|
static void dcss_drv_platform_remove(struct platform_device *pdev)
|
|
{
|
|
struct dcss_drv *mdrv = dev_get_drvdata(&pdev->dev);
|
|
|
|
dcss_kms_detach(mdrv->kms);
|
|
dcss_dev_destroy(mdrv->dcss);
|
|
}
|
|
|
|
static void dcss_drv_platform_shutdown(struct platform_device *pdev)
|
|
{
|
|
struct dcss_drv *mdrv = dev_get_drvdata(&pdev->dev);
|
|
|
|
dcss_kms_shutdown(mdrv->kms);
|
|
}
|
|
|
|
static struct dcss_type_data dcss_types[] = {
|
|
[DCSS_IMX8MQ] = {
|
|
.name = "DCSS_IMX8MQ",
|
|
.blkctl_ofs = 0x2F000,
|
|
.ctxld_ofs = 0x23000,
|
|
.dtg_ofs = 0x20000,
|
|
.scaler_ofs = 0x1C000,
|
|
.ss_ofs = 0x1B000,
|
|
.dpr_ofs = 0x18000,
|
|
},
|
|
};
|
|
|
|
static const struct of_device_id dcss_of_match[] = {
|
|
{ .compatible = "nxp,imx8mq-dcss", .data = &dcss_types[DCSS_IMX8MQ], },
|
|
{},
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(of, dcss_of_match);
|
|
|
|
static struct platform_driver dcss_platform_driver = {
|
|
.probe = dcss_drv_platform_probe,
|
|
.remove_new = dcss_drv_platform_remove,
|
|
.shutdown = dcss_drv_platform_shutdown,
|
|
.driver = {
|
|
.name = "imx-dcss",
|
|
.of_match_table = dcss_of_match,
|
|
.pm = pm_ptr(&dcss_dev_pm_ops),
|
|
},
|
|
};
|
|
|
|
drm_module_platform_driver(dcss_platform_driver);
|
|
|
|
MODULE_AUTHOR("Laurentiu Palcu <laurentiu.palcu@nxp.com>");
|
|
MODULE_DESCRIPTION("DCSS driver for i.MX8MQ");
|
|
MODULE_LICENSE("GPL v2");
|