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....@mediatek.com>
> ---
>  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,

Reply via email to