139 lines
2.6 KiB
C
Executable file
139 lines
2.6 KiB
C
Executable file
/* SPDX-License-Identifier: GPL-2.0 */
|
|
/*
|
|
* Copyright (c) 2019 MediaTek Inc.
|
|
*/
|
|
|
|
#include <linux/err.h>
|
|
#include <linux/module.h>
|
|
|
|
#include <drm/drmP.h>
|
|
#include <drm/drm_atomic_helper.h>
|
|
#include <drm/drm_crtc_helper.h>
|
|
#include <drm/drm_mipi_dsi.h>
|
|
|
|
#include <drm/drm_panel.h>
|
|
|
|
#include "mtk_panel_ext.h"
|
|
|
|
struct _panel_rst_ctx {
|
|
struct drm_panel *panel;
|
|
panel_tch_rst rst_cb;
|
|
};
|
|
|
|
static DEFINE_MUTEX(panel_ext_lock);
|
|
static LIST_HEAD(panel_ext_list);
|
|
static struct _panel_rst_ctx panel_rst_ctx;
|
|
|
|
void mtk_panel_init(struct mtk_panel_ctx *ctx)
|
|
{
|
|
INIT_LIST_HEAD(&ctx->list);
|
|
}
|
|
|
|
void mtk_panel_add(struct mtk_panel_ctx *ctx)
|
|
{
|
|
mutex_lock(&panel_ext_lock);
|
|
list_add_tail(&ctx->list, &panel_ext_list);
|
|
mutex_unlock(&panel_ext_lock);
|
|
}
|
|
|
|
void mtk_panel_remove(struct mtk_panel_ctx *ctx)
|
|
{
|
|
mutex_lock(&panel_ext_lock);
|
|
list_del_init(&ctx->list);
|
|
mutex_unlock(&panel_ext_lock);
|
|
}
|
|
|
|
int mtk_panel_attach(struct mtk_panel_ctx *ctx, struct drm_panel *panel)
|
|
{
|
|
if (ctx->panel)
|
|
return -EBUSY;
|
|
|
|
ctx->panel = panel;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int mtk_panel_tch_handle_reg(struct drm_panel *panel)
|
|
{
|
|
mutex_lock(&panel_ext_lock);
|
|
if (panel_rst_ctx.panel) {
|
|
mutex_unlock(&panel_ext_lock);
|
|
return -EEXIST;
|
|
}
|
|
panel_rst_ctx.panel = panel;
|
|
mutex_unlock(&panel_ext_lock);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void **mtk_panel_tch_handle_init(void)
|
|
{
|
|
return (void **)&panel_rst_ctx.rst_cb;
|
|
}
|
|
|
|
int mtk_panel_tch_rst(struct drm_panel *panel)
|
|
{
|
|
int ret = 0;
|
|
|
|
mutex_lock(&panel_ext_lock);
|
|
if (panel_rst_ctx.rst_cb && panel_rst_ctx.panel == panel)
|
|
panel_rst_ctx.rst_cb();
|
|
else
|
|
ret = -EEXIST;
|
|
mutex_unlock(&panel_ext_lock);
|
|
|
|
return ret;
|
|
}
|
|
|
|
int mtk_panel_detach(struct mtk_panel_ctx *ctx)
|
|
{
|
|
ctx->panel = NULL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int mtk_panel_ext_create(struct device *dev,
|
|
struct mtk_panel_params *ext_params,
|
|
struct mtk_panel_funcs *ext_funcs,
|
|
struct drm_panel *panel)
|
|
{
|
|
struct mtk_panel_ctx *ext_ctx;
|
|
struct mtk_panel_ext *ext;
|
|
|
|
ext_ctx = devm_kzalloc(dev, sizeof(struct mtk_panel_ctx), GFP_KERNEL);
|
|
if (!ext_ctx)
|
|
return -ENOMEM;
|
|
|
|
ext = devm_kzalloc(dev, sizeof(struct mtk_panel_ext), GFP_KERNEL);
|
|
if (!ext)
|
|
return -ENOMEM;
|
|
|
|
mtk_panel_init(ext_ctx);
|
|
ext->params = ext_params;
|
|
ext->funcs = ext_funcs;
|
|
ext_ctx->ext = ext;
|
|
|
|
mtk_panel_add(ext_ctx);
|
|
mtk_panel_attach(ext_ctx, panel);
|
|
|
|
return 0;
|
|
}
|
|
|
|
struct mtk_panel_ext *find_panel_ext(struct drm_panel *panel)
|
|
{
|
|
// struct mtk_panel_ext *ext;
|
|
struct mtk_panel_ctx *ctx;
|
|
|
|
mutex_lock(&panel_ext_lock);
|
|
|
|
list_for_each_entry(ctx, &panel_ext_list, list) {
|
|
if (ctx->panel == panel) {
|
|
mutex_unlock(&panel_ext_lock);
|
|
return ctx->ext;
|
|
}
|
|
}
|
|
|
|
mutex_unlock(&panel_ext_lock);
|
|
return NULL;
|
|
}
|