28.11.2019 16:34, Georgi Djakov пишет: > There is a new helper function for removing all nodes. Let's use it instead > of duplicating the code. > > In addition to the above, instead of duplicating the code, simplify the > probe function error path by calling driver removal function directly. > > Signed-off-by: Georgi Djakov <georgi.djakov@xxxxxxxxxx> > --- > drivers/interconnect/qcom/msm8974.c | 40 ++++++++++------------------- > drivers/interconnect/qcom/qcs404.c | 31 ++++++++-------------- > drivers/interconnect/qcom/sdm845.c | 29 +++++++-------------- > 3 files changed, 33 insertions(+), 67 deletions(-) > > diff --git a/drivers/interconnect/qcom/msm8974.c b/drivers/interconnect/qcom/msm8974.c > index 0a1a8ba6afa7..8823dce811c3 100644 > --- a/drivers/interconnect/qcom/msm8974.c > +++ b/drivers/interconnect/qcom/msm8974.c > @@ -644,6 +644,15 @@ static int msm8974_icc_set(struct icc_node *src, struct icc_node *dst) > return 0; > } > > +static int msm8974_icc_remove(struct platform_device *pdev) > +{ > + struct msm8974_icc_provider *qp = platform_get_drvdata(pdev); > + > + icc_nodes_remove(&qp->provider); > + clk_bulk_disable_unprepare(qp->num_clks, qp->bus_clks); > + return icc_provider_del(&qp->provider); > +} > + > static int msm8974_icc_probe(struct platform_device *pdev) > { > const struct msm8974_icc_desc *desc; > @@ -701,7 +710,8 @@ static int msm8974_icc_probe(struct platform_device *pdev) > ret = icc_provider_add(provider); > if (ret) { > dev_err(dev, "error adding interconnect provider: %d\n", ret); > - goto err_disable_clks; > + clk_bulk_disable_unprepare(qp->num_clks, qp->bus_clks); > + return ret; > } > > for (i = 0; i < num_nodes; i++) { > @@ -710,7 +720,7 @@ static int msm8974_icc_probe(struct platform_device *pdev) > node = icc_node_create(qnodes[i]->id); > if (IS_ERR(node)) { > ret = PTR_ERR(node); > - goto err_del_icc; > + goto err; > } > > node->name = qnodes[i]->name; > @@ -731,34 +741,12 @@ static int msm8974_icc_probe(struct platform_device *pdev) > > return 0; > > -err_del_icc: > - list_for_each_entry_safe(node, &provider->nodes, node_list) { > - icc_node_del(node); > - icc_node_destroy(node->id); > - } > - icc_provider_del(provider); > - > -err_disable_clks: > - clk_bulk_disable_unprepare(qp->num_clks, qp->bus_clks); > +err: > + msm8974_icc_remove(pdev); > > return ret; > } > > -static int msm8974_icc_remove(struct platform_device *pdev) > -{ > - struct msm8974_icc_provider *qp = platform_get_drvdata(pdev); > - struct icc_provider *provider = &qp->provider; > - struct icc_node *n; > - > - list_for_each_entry_safe(n, &provider->nodes, node_list) { > - icc_node_del(n); > - icc_node_destroy(n->id); > - } > - clk_bulk_disable_unprepare(qp->num_clks, qp->bus_clks); > - > - return icc_provider_del(provider); > -} > - > static const struct of_device_id msm8974_noc_of_match[] = { > { .compatible = "qcom,msm8974-bimc", .data = &msm8974_bimc}, > { .compatible = "qcom,msm8974-cnoc", .data = &msm8974_cnoc}, > diff --git a/drivers/interconnect/qcom/qcs404.c b/drivers/interconnect/qcom/qcs404.c > index d2b455021416..a4c6ba715f61 100644 > --- a/drivers/interconnect/qcom/qcs404.c > +++ b/drivers/interconnect/qcom/qcs404.c > @@ -406,6 +406,15 @@ static int qcom_icc_set(struct icc_node *src, struct icc_node *dst) > return 0; > } > > +static int qnoc_remove(struct platform_device *pdev) > +{ > + struct qcom_icc_provider *qp = platform_get_drvdata(pdev); > + > + clk_bulk_disable_unprepare(qp->num_clks, qp->bus_clks); > + icc_nodes_remove(&qp->provider); > + return icc_provider_del(&qp->provider); > +} > + > static int qnoc_probe(struct platform_device *pdev) > { > struct device *dev = &pdev->dev; > @@ -494,31 +503,11 @@ static int qnoc_probe(struct platform_device *pdev) > > return 0; > err: > - list_for_each_entry_safe(node, &provider->nodes, node_list) { > - icc_node_del(node); > - icc_node_destroy(node->id); > - } > - clk_bulk_disable_unprepare(qp->num_clks, qp->bus_clks); > - icc_provider_del(provider); > + qnoc_remove(pdev); > > return ret; > } > > -static int qnoc_remove(struct platform_device *pdev) > -{ > - struct qcom_icc_provider *qp = platform_get_drvdata(pdev); > - struct icc_provider *provider = &qp->provider; > - struct icc_node *n; > - > - list_for_each_entry_safe(n, &provider->nodes, node_list) { > - icc_node_del(n); > - icc_node_destroy(n->id); > - } > - clk_bulk_disable_unprepare(qp->num_clks, qp->bus_clks); > - > - return icc_provider_del(provider); > -} > - > static const struct of_device_id qcs404_noc_of_match[] = { > { .compatible = "qcom,qcs404-bimc", .data = &qcs404_bimc }, > { .compatible = "qcom,qcs404-pcnoc", .data = &qcs404_pcnoc }, > diff --git a/drivers/interconnect/qcom/sdm845.c b/drivers/interconnect/qcom/sdm845.c > index 924c2d056d85..2b8f13e78471 100644 > --- a/drivers/interconnect/qcom/sdm845.c > +++ b/drivers/interconnect/qcom/sdm845.c > @@ -768,6 +768,14 @@ static int cmp_vcd(const void *_l, const void *_r) > return 1; > } > > +static int qnoc_remove(struct platform_device *pdev) > +{ > + struct qcom_icc_provider *qp = platform_get_drvdata(pdev); > + > + icc_nodes_remove(&qp->provider); > + return icc_provider_del(&qp->provider); > +} > + > static int qnoc_probe(struct platform_device *pdev) > { > const struct qcom_icc_desc *desc; > @@ -855,29 +863,10 @@ static int qnoc_probe(struct platform_device *pdev) > > return ret; > err: > - list_for_each_entry(node, &provider->nodes, node_list) { > - icc_node_del(node); > - icc_node_destroy(node->id); > - } > - > - icc_provider_del(provider); > + qnoc_remove(pdev); This is wrong because platform_set_drvdata() is invoked at the end of qnoc_probe(), thus platform_get_drvdata() of qnoc_remove() returns NULL here. > return ret; > } > > -static int qnoc_remove(struct platform_device *pdev) > -{ > - struct qcom_icc_provider *qp = platform_get_drvdata(pdev); > - struct icc_provider *provider = &qp->provider; > - struct icc_node *n; > - > - list_for_each_entry_safe(n, &provider->nodes, node_list) { > - icc_node_del(n); > - icc_node_destroy(n->id); > - } > - > - return icc_provider_del(provider); > -} > - > static const struct of_device_id qnoc_of_match[] = { > { .compatible = "qcom,sdm845-rsc-hlos", .data = &sdm845_rsc_hlos }, > { }, >