|
@@ -40,12 +40,20 @@ static int tpd_connect(struct omap_dss_device *dssdev,
|
|
|
struct omap_dss_device *dst)
|
|
|
{
|
|
|
struct panel_drv_data *ddata = to_panel_data(dssdev);
|
|
|
- struct omap_dss_device *in = ddata->in;
|
|
|
+ struct omap_dss_device *in;
|
|
|
int r;
|
|
|
|
|
|
+ in = omapdss_of_find_source_for_first_ep(dssdev->dev->of_node);
|
|
|
+ if (IS_ERR(in)) {
|
|
|
+ dev_err(dssdev->dev, "failed to find video source\n");
|
|
|
+ return PTR_ERR(in);
|
|
|
+ }
|
|
|
+
|
|
|
r = in->ops.hdmi->connect(in, dssdev);
|
|
|
- if (r)
|
|
|
+ if (r) {
|
|
|
+ omap_dss_put_device(in);
|
|
|
return r;
|
|
|
+ }
|
|
|
|
|
|
dst->src = dssdev;
|
|
|
dssdev->dst = dst;
|
|
@@ -56,6 +64,7 @@ static int tpd_connect(struct omap_dss_device *dssdev,
|
|
|
/* DC-DC converter needs at max 300us to get to 90% of 5V */
|
|
|
udelay(300);
|
|
|
|
|
|
+ ddata->in = in;
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
@@ -77,6 +86,9 @@ static void tpd_disconnect(struct omap_dss_device *dssdev,
|
|
|
dssdev->dst = NULL;
|
|
|
|
|
|
in->ops.hdmi->disconnect(in, &ddata->dssdev);
|
|
|
+
|
|
|
+ omap_dss_put_device(in);
|
|
|
+ ddata->in = NULL;
|
|
|
}
|
|
|
|
|
|
static int tpd_enable(struct omap_dss_device *dssdev)
|
|
@@ -269,23 +281,6 @@ static irqreturn_t tpd_hpd_isr(int irq, void *data)
|
|
|
return IRQ_HANDLED;
|
|
|
}
|
|
|
|
|
|
-static int tpd_probe_of(struct platform_device *pdev)
|
|
|
-{
|
|
|
- struct panel_drv_data *ddata = platform_get_drvdata(pdev);
|
|
|
- struct device_node *node = pdev->dev.of_node;
|
|
|
- struct omap_dss_device *in;
|
|
|
-
|
|
|
- in = omapdss_of_find_source_for_first_ep(node);
|
|
|
- if (IS_ERR(in)) {
|
|
|
- dev_err(&pdev->dev, "failed to find video source\n");
|
|
|
- return PTR_ERR(in);
|
|
|
- }
|
|
|
-
|
|
|
- ddata->in = in;
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
static int tpd_probe(struct platform_device *pdev)
|
|
|
{
|
|
|
struct omap_dss_device *in, *dssdev;
|
|
@@ -299,34 +294,24 @@ static int tpd_probe(struct platform_device *pdev)
|
|
|
|
|
|
platform_set_drvdata(pdev, ddata);
|
|
|
|
|
|
- r = tpd_probe_of(pdev);
|
|
|
- if (r)
|
|
|
- return r;
|
|
|
-
|
|
|
gpio = devm_gpiod_get_index_optional(&pdev->dev, NULL, 0,
|
|
|
GPIOD_OUT_LOW);
|
|
|
- if (IS_ERR(gpio)) {
|
|
|
- r = PTR_ERR(gpio);
|
|
|
- goto err_gpio;
|
|
|
- }
|
|
|
+ if (IS_ERR(gpio))
|
|
|
+ return PTR_ERR(gpio);
|
|
|
|
|
|
ddata->ct_cp_hpd_gpio = gpio;
|
|
|
|
|
|
gpio = devm_gpiod_get_index_optional(&pdev->dev, NULL, 1,
|
|
|
GPIOD_OUT_LOW);
|
|
|
- if (IS_ERR(gpio)) {
|
|
|
- r = PTR_ERR(gpio);
|
|
|
- goto err_gpio;
|
|
|
- }
|
|
|
+ if (IS_ERR(gpio))
|
|
|
+ return PTR_ERR(gpio);
|
|
|
|
|
|
ddata->ls_oe_gpio = gpio;
|
|
|
|
|
|
gpio = devm_gpiod_get_index(&pdev->dev, NULL, 2,
|
|
|
GPIOD_IN);
|
|
|
- if (IS_ERR(gpio)) {
|
|
|
- r = PTR_ERR(gpio);
|
|
|
- goto err_gpio;
|
|
|
- }
|
|
|
+ if (IS_ERR(gpio))
|
|
|
+ return PTR_ERR(gpio);
|
|
|
|
|
|
ddata->hpd_gpio = gpio;
|
|
|
|
|
@@ -337,7 +322,7 @@ static int tpd_probe(struct platform_device *pdev)
|
|
|
IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
|
|
|
"tpd12s015 hpd", ddata);
|
|
|
if (r)
|
|
|
- goto err_gpio;
|
|
|
+ return r;
|
|
|
|
|
|
dssdev = &ddata->dssdev;
|
|
|
dssdev->ops.hdmi = &tpd_hdmi_ops;
|
|
@@ -352,21 +337,16 @@ static int tpd_probe(struct platform_device *pdev)
|
|
|
r = omapdss_register_output(dssdev);
|
|
|
if (r) {
|
|
|
dev_err(&pdev->dev, "Failed to register output\n");
|
|
|
- goto err_reg;
|
|
|
+ return r;
|
|
|
}
|
|
|
|
|
|
return 0;
|
|
|
-err_reg:
|
|
|
-err_gpio:
|
|
|
- omap_dss_put_device(ddata->in);
|
|
|
- return r;
|
|
|
}
|
|
|
|
|
|
static int __exit tpd_remove(struct platform_device *pdev)
|
|
|
{
|
|
|
struct panel_drv_data *ddata = platform_get_drvdata(pdev);
|
|
|
struct omap_dss_device *dssdev = &ddata->dssdev;
|
|
|
- struct omap_dss_device *in = ddata->in;
|
|
|
|
|
|
omapdss_unregister_output(&ddata->dssdev);
|
|
|
|
|
@@ -378,8 +358,6 @@ static int __exit tpd_remove(struct platform_device *pdev)
|
|
|
if (omapdss_device_is_connected(dssdev))
|
|
|
tpd_disconnect(dssdev, dssdev->dst);
|
|
|
|
|
|
- omap_dss_put_device(in);
|
|
|
-
|
|
|
return 0;
|
|
|
}
|
|
|
|