static int mdp3_get_metadata(struct msm_fb_data_type *mfd,
struct msmfb_metadata *metadata)
{
int ret = 0;
switch (metadata->op) {
case metadata_op_frame_rate:
metadata->data.panel_frame_rate =
mfd->panel_info->mipi.frame_rate;
break;
case metadata_op_get_caps:
metadata->data.caps.mdp_rev = 304;
metadata->data.caps.rgb_pipes = 0;
metadata->data.caps.vig_pipes = 0;
metadata->data.caps.dma_pipes = 1;
break;
case metadata_op_crc:
ret = mdp3_ctrl_res_req_clk(mfd, 1);
if (ret) {
pr_err("failed to turn on mdp clks\n");
return ret;
}
ret = mdp3_misr_get(&metadata->data.misr_request);
ret = mdp3_ctrl_res_req_clk(mfd, 0);
if (ret) {
pr_err("failed to release mdp clks\n");
return ret;
}
break;
default:
pr_warn("Unsupported request to MDP GET META IOCTL.\n");
ret = -EINVAL;
break;
}
return ret;
}
static int mdp3_set_metadata(struct msm_fb_data_type *mfd,
struct msmfb_metadata *metadata_ptr)
{
int ret = 0;
switch (metadata_ptr->op) {
case metadata_op_crc:
ret = mdp3_ctrl_res_req_clk(mfd, 1);
if (ret) {
pr_err("failed to turn on mdp clks\n");
return ret;
}
ret = mdp3_misr_set(&metadata_ptr->data.misr_request);
ret = mdp3_ctrl_res_req_clk(mfd, 0);
if (ret) {
pr_err("failed to release mdp clks\n");
return ret;
}
break;
default:
pr_warn("Unsupported request to MDP SET META IOCTL.\n");
ret = -EINVAL;
break;
}
return ret;
}
static int mdp3_ctrl_off(struct msm_fb_data_type *mfd)
{
int rc = 0;
struct mdp3_session_data *mdp3_session;
struct mdss_panel_data *panel;
pr_debug("mdp3_ctrl_off\n");
mdp3_session = (struct mdp3_session_data *)mfd->mdp.private1;
if (!mdp3_session || !mdp3_session->panel || !mdp3_session->dma ||
!mdp3_session->intf) {
pr_err("mdp3_ctrl_on no device");
return -ENODEV;
}
mutex_lock(&mdp3_session->lock);
if (!mdp3_session->status) {
pr_debug("fb%d is off already", mfd->index);
goto off_error;
}
pr_debug("mdp3_ctrl_off stop mdp3 dma engine\n");
rc = mdp3_session->dma->stop(mdp3_session->dma, mdp3_session->intf);
if (rc)
pr_err("fail to stop the MDP3 dma\n");
pr_debug("mdp3_ctrl_off stop dsi panel and controller\n");
panel = mdp3_session->panel;
if (panel->event_handler)
rc = panel->event_handler(panel, MDSS_EVENT_PANEL_OFF, NULL);
if (rc)
pr_err("fail to turn off the panel\n");
pr_debug("mdp3_ctrl_off release bus and clock\n");
rc = mdp3_ctrl_res_req_bus(mfd, 0);
if (rc)
pr_err("mdp bus resource release failed\n");
rc = mdp3_ctrl_res_req_clk(mfd, 0);
if (rc)
pr_err("mdp clock resource release failed\n");
rc = mdp3_iommu_disable(MDP3_CLIENT_DMA_P);
if (rc)
pr_err("fail to dettach MDP DMA SMMU\n");
off_error:
mdp3_session->status = 0;
mutex_unlock(&mdp3_session->lock);
if (mdp3_session->overlay.id != MSMFB_NEW_REQUEST)
mdp3_overlay_unset(mfd, mdp3_session->overlay.id);
return 0;
}
static int mdp3_ctrl_on(struct msm_fb_data_type *mfd)
{
int rc = 0;
struct mdp3_session_data *mdp3_session;
struct mdss_panel_data *panel;
pr_debug("mdp3_ctrl_on\n");
mdp3_session = (struct mdp3_session_data *)mfd->mdp.private1;
if (!mdp3_session || !mdp3_session->panel || !mdp3_session->dma ||
!mdp3_session->intf) {
pr_err("mdp3_ctrl_on no device");
return -ENODEV;
}
mutex_lock(&mdp3_session->lock);
if (mdp3_session->status) {
pr_debug("fb%d is on already", mfd->index);
goto on_error;
}
if (mdp3_session->intf->active) {
pr_debug("continuous splash screen, initialized already\n");
goto on_error;
}
mdp3_enable_regulator(true);
mdp3_ctrl_notifier_register(mdp3_session,
&mdp3_session->mfd->mdp_sync_pt_data.notifier);
/* request bus bandwidth before DSI DMA traffic */
rc = mdp3_ctrl_res_req_bus(mfd, 1);
if (rc) {
pr_err("fail to request bus resource\n");
goto on_error;
}
panel = mdp3_session->panel;
if (panel->event_handler) {
rc = panel->event_handler(panel, MDSS_EVENT_UNBLANK, NULL);
rc |= panel->event_handler(panel, MDSS_EVENT_PANEL_ON, NULL);
}
if (rc) {
pr_err("fail to turn on the panel\n");
goto on_error;
}
rc = mdp3_ctrl_res_req_clk(mfd, 1);
if (rc) {
pr_err("fail to request mdp clk resource\n");
goto on_error;
}
rc = mdp3_ctrl_dma_init(mfd, mdp3_session->dma);
if (rc) {
pr_err("dma init failed\n");
goto on_error;
}
rc = mdp3_ppp_init();
if (rc) {
pr_err("ppp init failed\n");
goto on_error;
}
rc = mdp3_ctrl_intf_init(mfd, mdp3_session->intf);
if (rc) {
pr_err("display interface init failed\n");
goto on_error;
}
mdp3_session->clk_on = 1;
mdp3_session->first_commit = true;
on_error:
if (!rc)
mdp3_session->status = 1;
mutex_unlock(&mdp3_session->lock);
return rc;
}
static int mdp3_ctrl_on(struct msm_fb_data_type *mfd)
{
int rc = 0;
struct mdp3_session_data *mdp3_session;
struct mdss_panel_data *panel;
pr_debug("mdp3_ctrl_on\n");
mdp3_session = (struct mdp3_session_data *)mfd->mdp.private1;
if (!mdp3_session || !mdp3_session->panel || !mdp3_session->dma ||
!mdp3_session->intf) {
pr_err("mdp3_ctrl_on no device");
return -ENODEV;
}
mutex_lock(&mdp3_session->lock);
if (mdp3_session->status) {
pr_debug("fb%d is on already", mfd->index);
goto on_error;
}
rc = mdp3_iommu_enable(MDP3_CLIENT_DMA_P);
if (rc) {
pr_err("fail to attach MDP DMA SMMU\n");
goto on_error;
}
/* request bus bandwidth before DSI DMA traffic */
rc = mdp3_ctrl_res_req_bus(mfd, 1);
if (rc) {
pr_err("fail to request bus resource\n");
goto on_error;
}
panel = mdp3_session->panel;
if (panel->event_handler)
rc = panel->event_handler(panel, MDSS_EVENT_PANEL_ON, NULL);
if (rc) {
pr_err("fail to turn on the panel\n");
goto on_error;
}
rc = mdp3_ctrl_res_req_clk(mfd, 1);
if (rc) {
pr_err("fail to request mdp clk resource\n");
goto on_error;
}
rc = mdp3_ctrl_dma_init(mfd, mdp3_session->dma);
if (rc) {
pr_err("dma init failed\n");
goto on_error;
}
rc = mdp3_ppp_init();
if (rc) {
pr_err("ppp init failed\n");
goto on_error;
}
rc = mdp3_ctrl_intf_init(mfd, mdp3_session->intf);
if (rc) {
pr_err("display interface init failed\n");
goto on_error;
}
rc = mdp3_session->dma->start(mdp3_session->dma, mdp3_session->intf);
if (rc) {
pr_err("fail to start the MDP display interface\n");
goto on_error;
}
on_error:
if (!rc)
mdp3_session->status = 1;
mutex_unlock(&mdp3_session->lock);
return rc;
}
static int mdp3_ctrl_off(struct msm_fb_data_type *mfd)
{
int rc = 0;
struct mdp3_session_data *mdp3_session;
struct mdss_panel_data *panel;
pr_debug("mdp3_ctrl_off\n");
mdp3_session = (struct mdp3_session_data *)mfd->mdp.private1;
if (!mdp3_session || !mdp3_session->panel || !mdp3_session->dma ||
!mdp3_session->intf) {
pr_err("mdp3_ctrl_on no device");
return -ENODEV;
}
panel = mdp3_session->panel;
mutex_lock(&mdp3_session->lock);
if (!mdp3_session->status) {
pr_debug("fb%d is off already", mfd->index);
goto off_error;
}
mdp3_histogram_stop(mdp3_session, MDP_BLOCK_DMA_P);
pr_debug("mdp3_ctrl_off turn panel off\n");
if (panel->set_backlight)
panel->set_backlight(panel, 0);
if (panel->event_handler)
rc = panel->event_handler(panel, MDSS_EVENT_PANEL_OFF, NULL);
if (rc)
pr_err("fail to turn off the panel\n");
rc = mdp3_session->dma->stop(mdp3_session->dma, mdp3_session->intf);
if (rc)
pr_err("fail to stop the MDP3 dma\n");
mdp3_irq_deregister();
pr_debug("mdp3_ctrl_off stop clock\n");
rc = mdp3_ctrl_res_req_clk(mfd, 0);
if (rc)
pr_err("mdp clock resource release failed\n");
pr_debug("mdp3_ctrl_off stop dsi controller\n");
if (panel->event_handler)
rc = panel->event_handler(panel, MDSS_EVENT_BLANK, NULL);
if (rc)
pr_err("fail to turn off the panel\n");
pr_debug("mdp3_ctrl_off release bus\n");
rc = mdp3_ctrl_res_req_bus(mfd, 0);
if (rc)
pr_err("mdp bus resource release failed\n");
rc = mdp3_iommu_disable(MDP3_CLIENT_DMA_P);
if (rc)
pr_err("fail to dettach MDP DMA SMMU\n");
off_error:
mdp3_session->status = 0;
mdp3_bufq_deinit(&mdp3_session->bufq_out);
if (mdp3_session->overlay.id != MSMFB_NEW_REQUEST) {
mdp3_session->overlay.id = MSMFB_NEW_REQUEST;
mdp3_bufq_deinit(&mdp3_session->bufq_in);
}
mutex_unlock(&mdp3_session->lock);
return 0;
}
static int mdp3_ctrl_on(struct msm_fb_data_type *mfd)
{
int rc = 0;
struct mdp3_session_data *mdp3_session;
struct mdss_panel_data *panel;
pr_info("mdp3_ctrl_on++\n");
mdp3_session = (struct mdp3_session_data *)mfd->mdp.private1;
if (!mdp3_session || !mdp3_session->panel || !mdp3_session->dma ||
!mdp3_session->intf) {
pr_err("mdp3_ctrl_on no device");
return -ENODEV;
}
mutex_lock(&mdp3_session->lock);
if (mdp3_session->status) {
pr_debug("fb%d is on already", mfd->index);
goto on_error;
}
if (mdp3_session->intf->active) {
pr_debug("continuous splash screen, initialized already\n");
goto on_error;
}
mdp3_batfet_ctrl(true);
rc = mdp3_iommu_enable(MDP3_CLIENT_DMA_P);
if (rc) {
pr_err("fail to attach MDP DMA SMMU\n");
goto on_error;
}
/* request bus bandwidth before DSI DMA traffic */
rc = mdp3_ctrl_res_req_bus(mfd, 1);
if (rc) {
pr_err("fail to request bus resource\n");
goto on_error;
}
panel = mdp3_session->panel;
if (panel->event_handler) {
rc = panel->event_handler(panel, MDSS_EVENT_UNBLANK, NULL);
rc |= panel->event_handler(panel, MDSS_EVENT_PANEL_ON, NULL);
}
if (rc) {
pr_err("fail to turn on the panel\n");
goto on_error;
}
rc = mdp3_ctrl_res_req_clk(mfd, 1);
if (rc) {
pr_err("fail to request mdp clk resource\n");
goto on_error;
}
mdp3_irq_register();
rc = mdp3_ctrl_dma_init(mfd, mdp3_session->dma);
if (rc) {
pr_err("dma init failed\n");
goto on_error;
}
rc = mdp3_ppp_init();
if (rc) {
pr_err("ppp init failed\n");
goto on_error;
}
rc = mdp3_ctrl_intf_init(mfd, mdp3_session->intf);
if (rc) {
pr_err("display interface init failed\n");
goto on_error;
}
mdp3_session->clk_on = 1;
pr_debug("mdp3_ctrl_on dma start\n");
if (mfd->fbi->screen_base) {
rc = mdp3_session->dma->start(mdp3_session->dma,
mdp3_session->intf);
if (rc) {
pr_err("fail to start the MDP display interface\n");
goto on_error;
}
} else {
mdp3_session->first_commit = true;
}
pr_info("mdp3_ctrl_on--\n");
on_error:
if (!rc)
mdp3_session->status = 1;
mutex_unlock(&mdp3_session->lock);
return rc;
}