M7350/kernel/drivers/video/msm/mipi_orise.c
2024-09-09 08:52:07 +00:00

211 lines
4.9 KiB
C

/* Copyright (c) 2012, 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 "msm_fb.h"
#include "mipi_dsi.h"
#include "mipi_orise.h"
#include "mdp4.h"
static struct mipi_dsi_panel_platform_data *mipi_orise_pdata;
static struct dsi_buf orise_tx_buf;
static struct dsi_buf orise_rx_buf;
static char enter_sleep[2] = {0x10, 0x00}; /* DTYPE_DCS_WRITE */
static char exit_sleep[2] = {0x11, 0x00}; /* DTYPE_DCS_WRITE */
static char display_off[2] = {0x28, 0x00}; /* DTYPE_DCS_WRITE */
static char display_on[2] = {0x29, 0x00}; /* DTYPE_DCS_WRITE */
static struct dsi_cmd_desc orise_video_on_cmds[] = {
{DTYPE_DCS_WRITE, 1, 0, 0, 10,
sizeof(exit_sleep), exit_sleep},
{DTYPE_DCS_WRITE, 1, 0, 0, 10,
sizeof(display_on), display_on},
};
static struct dsi_cmd_desc orise_cmd_on_cmds[] = {
{DTYPE_DCS_WRITE, 1, 0, 0, 10,
sizeof(exit_sleep), exit_sleep},
{DTYPE_DCS_WRITE, 1, 0, 0, 10,
sizeof(display_on), display_on},
};
static struct dsi_cmd_desc orise_display_off_cmds[] = {
{DTYPE_DCS_WRITE, 1, 0, 0, 10,
sizeof(display_off), display_off},
{DTYPE_DCS_WRITE, 1, 0, 0, 120,
sizeof(enter_sleep), enter_sleep}
};
static int mipi_orise_lcd_on(struct platform_device *pdev)
{
struct msm_fb_data_type *mfd;
struct mipi_panel_info *mipi;
struct msm_panel_info *pinfo;
struct dcs_cmd_req cmdreq;
mfd = platform_get_drvdata(pdev);
if (!mfd)
return -ENODEV;
if (mfd->key != MFD_KEY)
return -EINVAL;
pinfo = &mfd->panel_info;
mipi = &mfd->panel_info.mipi;
memset(&cmdreq, 0, sizeof(cmdreq));
if (mipi->mode == DSI_VIDEO_MODE) {
cmdreq.cmds = orise_video_on_cmds;
cmdreq.cmds_cnt = ARRAY_SIZE(orise_video_on_cmds);
cmdreq.flags = CMD_REQ_COMMIT;
cmdreq.rlen = 0;
cmdreq.cb = NULL;
mipi_dsi_cmdlist_put(&cmdreq);
} else {
cmdreq.cmds = orise_cmd_on_cmds;
cmdreq.cmds_cnt = ARRAY_SIZE(orise_cmd_on_cmds);
cmdreq.flags = CMD_REQ_COMMIT;
cmdreq.rlen = 0;
cmdreq.cb = NULL;
mipi_dsi_cmdlist_put(&cmdreq);
mipi_dsi_cmd_bta_sw_trigger(); /* clean up ack_err_status */
}
return 0;
}
static int mipi_orise_lcd_off(struct platform_device *pdev)
{
struct msm_fb_data_type *mfd;
struct dcs_cmd_req cmdreq;
mfd = platform_get_drvdata(pdev);
if (!mfd)
return -ENODEV;
if (mfd->key != MFD_KEY)
return -EINVAL;
memset(&cmdreq, 0, sizeof(cmdreq));
cmdreq.cmds = orise_display_off_cmds;
cmdreq.cmds_cnt = ARRAY_SIZE(orise_display_off_cmds);
cmdreq.flags = CMD_REQ_COMMIT;
cmdreq.rlen = 0;
cmdreq.cb = NULL;
mipi_dsi_cmdlist_put(&cmdreq);
return 0;
}
static int __devinit mipi_orise_lcd_probe(struct platform_device *pdev)
{
struct msm_fb_data_type *mfd;
struct mipi_panel_info *mipi;
struct platform_device *current_pdev;
static struct mipi_dsi_phy_ctrl *phy_settings;
if (pdev->id == 0) {
mipi_orise_pdata = pdev->dev.platform_data;
if (mipi_orise_pdata
&& mipi_orise_pdata->phy_ctrl_settings) {
phy_settings = (mipi_orise_pdata->phy_ctrl_settings);
}
return 0;
}
current_pdev = msm_fb_add_device(pdev);
if (current_pdev) {
mfd = platform_get_drvdata(current_pdev);
if (!mfd)
return -ENODEV;
if (mfd->key != MFD_KEY)
return -EINVAL;
mipi = &mfd->panel_info.mipi;
if (phy_settings != NULL)
mipi->dsi_phy_db = phy_settings;
}
return 0;
}
static struct platform_driver this_driver = {
.probe = mipi_orise_lcd_probe,
.driver = {
.name = "mipi_orise",
},
};
static struct msm_fb_panel_data orise_panel_data = {
.on = mipi_orise_lcd_on,
.off = mipi_orise_lcd_off,
};
static int ch_used[3];
int mipi_orise_device_register(struct msm_panel_info *pinfo,
u32 channel, u32 panel)
{
struct platform_device *pdev = NULL;
int ret;
if ((channel >= 3) || ch_used[channel])
return -ENODEV;
ch_used[channel] = TRUE;
pdev = platform_device_alloc("mipi_orise", (panel << 8)|channel);
if (!pdev)
return -ENOMEM;
orise_panel_data.panel_info = *pinfo;
ret = platform_device_add_data(pdev, &orise_panel_data,
sizeof(orise_panel_data));
if (ret) {
printk(KERN_ERR
"%s: platform_device_add_data failed!\n", __func__);
goto err_device_put;
}
ret = platform_device_add(pdev);
if (ret) {
printk(KERN_ERR
"%s: platform_device_register failed!\n", __func__);
goto err_device_put;
}
return 0;
err_device_put:
platform_device_put(pdev);
return ret;
}
static int __init mipi_orise_lcd_init(void)
{
mipi_dsi_buf_alloc(&orise_tx_buf, DSI_BUF_SIZE);
mipi_dsi_buf_alloc(&orise_rx_buf, DSI_BUF_SIZE);
return platform_driver_register(&this_driver);
}
module_init(mipi_orise_lcd_init);