M7350/kernel/drivers/video/msm/mdp4_wfd_writeback.c

118 lines
2.8 KiB
C
Raw Normal View History

2024-09-09 08:52:07 +00:00
/* Copyright (c) 2011-2013, The Linux Foundation. All rights reserved.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 and
* only version 2 as published by the Free Software Foundation.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
*/
#include <linux/types.h>
#include <linux/list.h>
#include <linux/ioctl.h>
#include <linux/spinlock.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/version.h>
#include "mdp4_wfd_writeback_util.h"
#include "msm_fb.h"
static int writeback_on(struct platform_device *pdev)
{
return 0;
}
static int writeback_off(struct platform_device *pdev)
{
return 0;
}
static int writeback_probe(struct platform_device *pdev)
{
struct msm_fb_data_type *mfd;
struct platform_device *mdp_dev = NULL;
struct msm_fb_panel_data *pdata = NULL;
int rc = 0;
WRITEBACK_MSG_ERR("Inside writeback_probe\n");
mfd = platform_get_drvdata(pdev);
if (!mfd)
return -ENODEV;
if (mfd->key != MFD_KEY)
return -EINVAL;
mdp_dev = platform_device_alloc("mdp", pdev->id);
if (!mdp_dev)
return -ENOMEM;
/*
* link to the latest pdev
*/
mfd->pdev = mdp_dev;
mfd->dest = DISPLAY_LCD;
if (platform_device_add_data
(mdp_dev, pdev->dev.platform_data,
sizeof(struct msm_fb_panel_data))) {
pr_err("writeback_probe: "
"platform_device_add_data failed!\n");
platform_device_put(mdp_dev);
return -ENOMEM;
}
pdata = (struct msm_fb_panel_data *)mdp_dev->dev.platform_data;
pdata->on = writeback_on;
pdata->off = writeback_off;
pdata->next = pdev;
/*
* get/set panel specific fb info
*/
mfd->panel_info = pdata->panel_info;
mfd->fb_imgType = MDP_RGB_565;
platform_set_drvdata(mdp_dev, mfd);
mfd->writeback_sdev.name = "wfd";
rc = switch_dev_register(&mfd->writeback_sdev);
if (rc) {
pr_err("Failed to setup switch dev for writeback panel");
return rc;
}
rc = platform_device_add(mdp_dev);
if (rc) {
WRITEBACK_MSG_ERR("failed to add device");
platform_device_put(mdp_dev);
return rc;
}
return rc;
}
static int writeback_remove(struct platform_device *pdev)
{
struct msm_fb_data_type *mfd = platform_get_drvdata(pdev);
switch_dev_unregister(&mfd->writeback_sdev);
return 0;
}
static struct platform_driver writeback_driver = {
.probe = writeback_probe,
.remove = writeback_remove,
.driver = {
.name = "writeback",
},
};
static int __init writeback_driver_init(void)
{
int rc = 0;
WRITEBACK_MSG_ERR("Inside writeback_driver_init\n");
rc = platform_driver_register(&writeback_driver);
return rc;
}
module_init(writeback_driver_init);