@@ -627,8 +627,11 @@ int mtk_ddp_comp_init(struct device_node *node, struct mtk_ddp_comp *comp,
priv->regs = of_iomap(node, 0);
priv->clk = of_clk_get(node, 0);
- if (IS_ERR(priv->clk))
+ if (IS_ERR(priv->clk)) {
+ iounmap(priv->regs);
+ priv->regs = NULL;
return PTR_ERR(priv->clk);
+ }
#if IS_REACHABLE(CONFIG_MTK_CMDQ)
ret = cmdq_dev_get_client_reg(comp->dev, &priv->cmdq_reg, 0);
@@ -640,3 +643,36 @@ int mtk_ddp_comp_init(struct device_node *node, struct mtk_ddp_comp *comp,
return 0;
}
+
+void mtk_ddp_comp_destroy(struct mtk_ddp_comp *comp)
+{
+ struct mtk_ddp_comp_dev *priv;
+
+ if (!comp || !comp->dev)
+ return;
+
+ /* Complex components are destroyed with their own remove callback */
+ if (mtk_ddp_matches[comp->id].type == MTK_DISP_AAL ||
+ mtk_ddp_matches[comp->id].type == MTK_DISP_BLS ||
+ mtk_ddp_matches[comp->id].type == MTK_DISP_CCORR ||
+ mtk_ddp_matches[comp->id].type == MTK_DISP_COLOR ||
+ mtk_ddp_matches[comp->id].type == MTK_DISP_GAMMA ||
+ mtk_ddp_matches[comp->id].type == MTK_DISP_MERGE ||
+ mtk_ddp_matches[comp->id].type == MTK_DISP_OVL ||
+ mtk_ddp_matches[comp->id].type == MTK_DISP_OVL_2L ||
+ mtk_ddp_matches[comp->id].type == MTK_DISP_PWM ||
+ mtk_ddp_matches[comp->id].type == MTK_DISP_RDMA ||
+ mtk_ddp_matches[comp->id].type == MTK_DPI ||
+ mtk_ddp_matches[comp->id].type == MTK_DP_INTF ||
+ mtk_ddp_matches[comp->id].type == MTK_DSI)
+ return;
+
+ priv = dev_get_drvdata(comp->dev);
+ if (!priv)
+ return;
+
+ if (priv->regs) {
+ iounmap(priv->regs);
+ priv->regs = NULL;
+ }
+}
@@ -330,6 +330,7 @@ unsigned int mtk_drm_find_possible_crtc_by_comp(struct drm_device *drm,
struct device *dev);
int mtk_ddp_comp_init(struct device_node *comp_node, struct mtk_ddp_comp *comp,
unsigned int comp_id);
+void mtk_ddp_comp_destroy(struct mtk_ddp_comp *comp);
enum mtk_ddp_comp_type mtk_ddp_comp_get_type(unsigned int comp_id);
void mtk_ddp_write(struct cmdq_pkt *cmdq_pkt, unsigned int value,
struct cmdq_client_reg *cmdq_reg, void __iomem *regs,
@@ -946,8 +946,10 @@ static void mtk_drm_remove(struct platform_device *pdev)
component_master_del(&pdev->dev, &mtk_drm_ops);
pm_runtime_disable(&pdev->dev);
of_node_put(private->mutex_node);
- for (i = 0; i < DDP_COMPONENT_DRM_ID_MAX; i++)
+ for (i = 0; i < DDP_COMPONENT_DRM_ID_MAX; i++) {
+ mtk_ddp_comp_destroy(&private->ddp_comp[i]);
of_node_put(private->comp_node[i]);
+ }
}
static int mtk_drm_sys_prepare(struct device *dev)