Hi, Nancy:
On Mon, 2022-01-10 at 16:46 +0800, Nancy.Lin wrote:
> Add drm ovl_adaptor sub driver. Bring up ovl_adaptor sub driver if
> the component exists in the path.
>
> Signed-off-by: Nancy.Lin <nancy.lin@xxxxxxxxxxxx>
> ---
> drivers/gpu/drm/mediatek/mtk_drm_crtc.c | 16 ++++----
> drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c | 30 ++++++++++++---
> drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h | 1 +
> drivers/gpu/drm/mediatek/mtk_drm_drv.c | 41 +++++++++++++++--
> ----
> 4 files changed, 62 insertions(+), 26 deletions(-)
>
> diff --git a/drivers/gpu/drm/mediatek/mtk_drm_crtc.c
> b/drivers/gpu/drm/mediatek/mtk_drm_crtc.c
> index fe2871aca859..62529a954b62 100644
> --- a/drivers/gpu/drm/mediatek/mtk_drm_crtc.c
> +++ b/drivers/gpu/drm/mediatek/mtk_drm_crtc.c
> @@ -877,15 +877,13 @@ int mtk_drm_crtc_create(struct drm_device
> *drm_dev,
> node = priv->comp_node[comp_id];
> comp = &priv->ddp_comp[comp_id];
>
> - if (!node) {
if (!node && comp_id != MTK_DISP_OVL_ADAPTOR)
> - dev_info(dev,
> - "Not creating crtc %d because
> component %d is disabled or missing\n",
> - crtc_i, comp_id);
> - return 0;
> - }
> -
> - if (!comp->dev) {
> - dev_err(dev, "Component %pOF not
> initialized\n", node);
> + /* Not all drm components have a DTS device node, such
> as ovl_adaptor,
> + * which is the drm bring up sub driver
> + */
> + if (!node && !comp->dev) {
> + dev_err(dev,
> + "Not creating crtc %d because component
> %d is disabled, missing or not initialized\n",
> + crtc_i, comp_id);
> return -ENODEV;
> }
> }
> diff --git a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c
> b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c
> index 26d197da41c0..ce40bab9c56b 100644
> --- a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c
> +++ b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c
> @@ -385,6 +385,18 @@ static const struct mtk_ddp_comp_funcs ddp_ufoe
> = {
> .start = mtk_ufoe_start,
> };
>
> +static const struct mtk_ddp_comp_funcs ddp_ovl_adaptor = {
> + .clk_enable = mtk_ovl_adaptor_clk_enable,
> + .clk_disable = mtk_ovl_adaptor_clk_disable,
> + .config = mtk_ovl_adaptor_config,
> + .start = mtk_ovl_adaptor_start,
> + .stop = mtk_ovl_adaptor_stop,
> + .layer_nr = mtk_ovl_adaptor_layer_nr,
> + .layer_config = mtk_ovl_adaptor_layer_config,
> + .enable_vblank = mtk_ovl_adaptor_enable_vblank,
> + .disable_vblank = mtk_ovl_adaptor_disable_vblank,
> +};
> +
> static const char * const mtk_ddp_comp_stem[MTK_DDP_COMP_TYPE_MAX] =
> {
> [MTK_DISP_AAL] = "aal",
> [MTK_DISP_BLS] = "bls",
> @@ -398,6 +410,7 @@ static const char * const
> mtk_ddp_comp_stem[MTK_DDP_COMP_TYPE_MAX] = {
> [MTK_DISP_OD] = "od",
> [MTK_DISP_OVL] = "ovl",
> [MTK_DISP_OVL_2L] = "ovl-2l",
> + [MTK_DISP_OVL_ADAPTOR] = "ovl_adaptor",
> [MTK_DISP_POSTMASK] = "postmask",
> [MTK_DISP_PWM] = "pwm",
> [MTK_DISP_RDMA] = "rdma",
> @@ -443,6 +456,7 @@ static const struct mtk_ddp_comp_match
> mtk_ddp_matches[DDP_COMPONENT_ID_MAX] = {
> [DDP_COMPONENT_OVL_2L0] = { MTK_DISP_OVL_2L, 0,
> &ddp_ovl },
> [DDP_COMPONENT_OVL_2L1] = { MTK_DISP_OVL_2L, 1,
> &ddp_ovl },
> [DDP_COMPONENT_OVL_2L2] = { MTK_DISP_OVL_2L, 2,
> &ddp_ovl },
> + [DDP_COMPONENT_OVL_ADAPTOR] = { MTK_DISP_OVL_ADAPTOR,
> 0, &ddp_ovl_adaptor },
> [DDP_COMPONENT_POSTMASK0] = { MTK_DISP_POSTMASK, 0,
> &ddp_postmask },
> [DDP_COMPONENT_PWM0] = { MTK_DISP_PWM, 0,
> NULL },
> [DDP_COMPONENT_PWM1] = { MTK_DISP_PWM, 1,
> NULL },
> @@ -548,12 +562,17 @@ int mtk_ddp_comp_init(struct device_node *node,
> struct mtk_ddp_comp *comp,
>
> comp->id = comp_id;
> comp->funcs = mtk_ddp_matches[comp_id].funcs;
> - comp_pdev = of_find_device_by_node(node);
> - if (!comp_pdev) {
> - DRM_INFO("Waiting for device %s\n", node->full_name);
> - return -EPROBE_DEFER;
> + /* Not all drm components have a DTS device node, such as
> ovl_adaptor,
> + * which is the drm bring up sub driver
> + */
> + if (node) {
> + comp_pdev = of_find_device_by_node(node);
> + if (!comp_pdev) {
> + DRM_INFO("Waiting for device %s\n", node-
> >full_name);
> + return -EPROBE_DEFER;
> + }
> + comp->dev = &comp_pdev->dev;
> }
> - comp->dev = &comp_pdev->dev;
>
> /* Only DMA capable components need the LARB property */
> if (type == MTK_DISP_OVL ||
> @@ -573,6 +592,7 @@ int mtk_ddp_comp_init(struct device_node *node,
> struct mtk_ddp_comp *comp,
> type == MTK_DISP_MERGE ||
> type == MTK_DISP_OVL ||
> type == MTK_DISP_OVL_2L ||
> + type == MTK_DISP_OVL_ADAPTOR ||
> type == MTK_DISP_PWM ||
> type == MTK_DISP_RDMA ||
> type == MTK_DPI ||
> diff --git a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h
> b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h
> index 221e2e3a3c8d..5e1404dc20c4 100644
> --- a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h
> +++ b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h
> @@ -30,6 +30,7 @@ enum mtk_ddp_comp_type {
> MTK_DISP_OD,
> MTK_DISP_OVL,
> MTK_DISP_OVL_2L,
> + MTK_DISP_OVL_ADAPTOR,
> MTK_DISP_POSTMASK,
> MTK_DISP_PWM,
> MTK_DISP_RDMA,
> diff --git a/drivers/gpu/drm/mediatek/mtk_drm_drv.c
> b/drivers/gpu/drm/mediatek/mtk_drm_drv.c
> index a05703843af2..36430f956b4f 100644
> --- a/drivers/gpu/drm/mediatek/mtk_drm_drv.c
> +++ b/drivers/gpu/drm/mediatek/mtk_drm_drv.c
> @@ -351,9 +351,7 @@ static int mtk_drm_kms_init(struct drm_device
> *drm)
> {
> struct mtk_drm_private *private = drm->dev_private;
> struct mtk_drm_private *priv_n;
> - struct platform_device *pdev;
> - struct device_node *np = NULL;
> - struct device *dma_dev;
> + struct device *dma_dev = NULL;
> int ret, i, j;
>
> ret = drmm_mode_config_init(drm);
> @@ -400,8 +398,8 @@ static int mtk_drm_kms_init(struct drm_device
> *drm)
> if (ret)
> goto err_component_unbind;
>
> - if (!np)
> - np = priv_n->comp_node[priv_n-
> >data->main_path[0]];
> + if (!dma_dev)
> + dma_dev = priv_n-
> >ddp_comp[priv_n->data->main_path[0]].dev;
>
> continue;
> } else if (i == 1 && priv_n->data->ext_len) {
> @@ -410,8 +408,8 @@ static int mtk_drm_kms_init(struct drm_device
> *drm)
> if (ret)
> goto err_component_unbind;
>
> - if (!np)
> - np = priv_n->comp_node[priv_n-
> >data->ext_path[0]];
> + if (!dma_dev)
> + dma_dev = priv_n-
> >ddp_comp[priv_n->data->ext_path[0]].dev;
>
> continue;
> } else if (i == 2 && priv_n->data->third_len) {
> @@ -420,22 +418,20 @@ static int mtk_drm_kms_init(struct drm_device
> *drm)
> if (ret)
> goto err_component_unbind;
>
> - if (!np)
> - np = priv_n->comp_node[priv_n-
> >data->third_path[0]];
> + if (!dma_dev)
> + dma_dev = priv_n-
> >ddp_comp[priv_n->data->third_path[0]].dev;
>
> continue;
> }
> }
> }
>
> - pdev = of_find_device_by_node(np);
> - if (!pdev) {
> + if (!dma_dev) {
I don't know how ovl_adaptor could provide the dma function. As I know,
dma device has a device node, and there is iommu property in that node.
> ret = -ENODEV;
> dev_err(drm->dev, "Need at least one OVL device\n");
> goto err_component_unbind;
> }
>
> - dma_dev = &pdev->dev;
> for (i = 0; i < private->data->mmsys_dev_num; i++)
> private->all_drm_private[i]->dma_dev = dma_dev;
>
> @@ -514,6 +510,11 @@ static int compare_of(struct device *dev, void
> *data)
> return dev->of_node == data;
> }
>
> +static int compare_dev(struct device *dev, void *data)
> +{
> + return dev == (struct device *)data;
> +}
> +
> static int mtk_drm_bind(struct device *dev)
> {
> struct mtk_drm_private *private = dev_get_drvdata(dev);
> @@ -702,6 +703,7 @@ static int mtk_drm_probe(struct platform_device
> *pdev)
> struct mtk_drm_private *private;
> struct device_node *node;
> struct component_match *match = NULL;
> + struct platform_device *ovl_adaptor;
> int ret;
> int i;
>
> @@ -727,6 +729,19 @@ static int mtk_drm_probe(struct platform_device
> *pdev)
> return -ENODEV;
> }
>
> + /* Bringup ovl_adaptor */
> + if (mtk_drm_find_mmsys_comp(private,
> DDP_COMPONENT_OVL_ADAPTOR)) {
> + ovl_adaptor = platform_device_register_data(dev,
> "mediatek-disp-ovl-adaptor",
> + PLATFORM_DE
> VID_AUTO,
> + (void
> *)private->mmsys_dev,
> + sizeof(*pri
> vate->mmsys_dev));
> + private->ddp_comp[DDP_COMPONENT_OVL_ADAPTOR].dev =
> &ovl_adaptor->dev;
> + private->comp_node[DDP_COMPONENT_OVL_ADAPTOR] =
> ovl_adaptor->dev.of_node;
private->comp_node[DDP_COMPONENT_OVL_ADAPTOR] = NULL;
Regards,
CK
> + mtk_ddp_comp_init(NULL, &private-
> >ddp_comp[DDP_COMPONENT_OVL_ADAPTOR],
> + DDP_COMPONENT_OVL_ADAPTOR);
> + component_match_add(dev, &match, compare_dev,
> &ovl_adaptor->dev);
> + }
> +
> /* Iterate over sibling DISP function blocks */
> for_each_child_of_node(phandle->parent, node) {
> const struct of_device_id *of_id;
> @@ -780,6 +795,7 @@ static int mtk_drm_probe(struct platform_device
> *pdev)
> comp_type == MTK_DISP_MERGE ||
> comp_type == MTK_DISP_OVL ||
> comp_type == MTK_DISP_OVL_2L ||
> + comp_type == MTK_DISP_OVL_ADAPTOR ||
> comp_type == MTK_DISP_RDMA ||
> comp_type == MTK_DPI ||
> comp_type == MTK_DSI) {
> @@ -882,6 +898,7 @@ static struct platform_driver * const
> mtk_drm_drivers[] = {
> &mtk_disp_color_driver,
> &mtk_disp_gamma_driver,
> &mtk_disp_merge_driver,
> + &mtk_disp_ovl_adaptor_driver,
> &mtk_disp_ovl_driver,
> &mtk_disp_rdma_driver,
> &mtk_dpi_driver,
