|
@@ -1001,36 +1001,6 @@ static void *gsc_get_drv_data(struct platform_device *pdev)
|
|
|
return driver_data;
|
|
|
}
|
|
|
|
|
|
-static void gsc_clk_put(struct gsc_dev *gsc)
|
|
|
-{
|
|
|
- if (!IS_ERR(gsc->clock))
|
|
|
- clk_unprepare(gsc->clock);
|
|
|
-}
|
|
|
-
|
|
|
-static int gsc_clk_get(struct gsc_dev *gsc)
|
|
|
-{
|
|
|
- int ret;
|
|
|
-
|
|
|
- dev_dbg(&gsc->pdev->dev, "gsc_clk_get Called\n");
|
|
|
-
|
|
|
- gsc->clock = devm_clk_get(&gsc->pdev->dev, GSC_CLOCK_GATE_NAME);
|
|
|
- if (IS_ERR(gsc->clock)) {
|
|
|
- dev_err(&gsc->pdev->dev, "failed to get clock~~~: %s\n",
|
|
|
- GSC_CLOCK_GATE_NAME);
|
|
|
- return PTR_ERR(gsc->clock);
|
|
|
- }
|
|
|
-
|
|
|
- ret = clk_prepare(gsc->clock);
|
|
|
- if (ret < 0) {
|
|
|
- dev_err(&gsc->pdev->dev, "clock prepare failed for clock: %s\n",
|
|
|
- GSC_CLOCK_GATE_NAME);
|
|
|
- gsc->clock = ERR_PTR(-EINVAL);
|
|
|
- return ret;
|
|
|
- }
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
static int gsc_m2m_suspend(struct gsc_dev *gsc)
|
|
|
{
|
|
|
unsigned long flags;
|
|
@@ -1098,7 +1068,6 @@ static int gsc_probe(struct platform_device *pdev)
|
|
|
init_waitqueue_head(&gsc->irq_queue);
|
|
|
spin_lock_init(&gsc->slock);
|
|
|
mutex_init(&gsc->lock);
|
|
|
- gsc->clock = ERR_PTR(-EINVAL);
|
|
|
|
|
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
|
gsc->regs = devm_ioremap_resource(dev, res);
|
|
@@ -1111,9 +1080,19 @@ static int gsc_probe(struct platform_device *pdev)
|
|
|
return -ENXIO;
|
|
|
}
|
|
|
|
|
|
- ret = gsc_clk_get(gsc);
|
|
|
- if (ret)
|
|
|
+ gsc->clock = devm_clk_get(dev, GSC_CLOCK_GATE_NAME);
|
|
|
+ if (IS_ERR(gsc->clock)) {
|
|
|
+ dev_err(dev, "failed to get clock~~~: %s\n",
|
|
|
+ GSC_CLOCK_GATE_NAME);
|
|
|
+ return PTR_ERR(gsc->clock);
|
|
|
+ }
|
|
|
+
|
|
|
+ ret = clk_prepare(gsc->clock);
|
|
|
+ if (ret) {
|
|
|
+ dev_err(&gsc->pdev->dev, "clock prepare failed for clock: %s\n",
|
|
|
+ GSC_CLOCK_GATE_NAME);
|
|
|
return ret;
|
|
|
+ }
|
|
|
|
|
|
ret = devm_request_irq(dev, res->start, gsc_irq_handler,
|
|
|
0, pdev->name, gsc);
|
|
@@ -1148,7 +1127,7 @@ err_m2m:
|
|
|
err_v4l2:
|
|
|
v4l2_device_unregister(&gsc->v4l2_dev);
|
|
|
err_clk:
|
|
|
- gsc_clk_put(gsc);
|
|
|
+ clk_unprepare(gsc->clock);
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
@@ -1161,7 +1140,7 @@ static int gsc_remove(struct platform_device *pdev)
|
|
|
|
|
|
vb2_dma_contig_clear_max_seg_size(&pdev->dev);
|
|
|
pm_runtime_disable(&pdev->dev);
|
|
|
- gsc_clk_put(gsc);
|
|
|
+ clk_unprepare(gsc->clock);
|
|
|
|
|
|
dev_dbg(&pdev->dev, "%s driver unloaded\n", pdev->name);
|
|
|
return 0;
|