From: Matus Ujhelyi <[email protected]>
Signed-off-by: Matus Ujhelyi <[email protected]>
---
drivers/media/rc/gpio-ir-recv.c | 84 ++++++++++++++++++++++++++++++---------
1 file changed, 66 insertions(+), 18 deletions(-)
diff --git a/drivers/media/rc/gpio-ir-recv.c b/drivers/media/rc/gpio-ir-recv.c
index ba1a1eb..cfba079 100644
--- a/drivers/media/rc/gpio-ir-recv.c
+++ b/drivers/media/rc/gpio-ir-recv.c
@@ -58,19 +58,49 @@ err_get_value:
return IRQ_HANDLED;
}
+static const struct of_device_id gpio_ir_of_match[] = {
+ {
+ .compatible = "gpio-ir-recv",
+ },
+};
+MODULE_DEVICE_TABLE(of, gpio_ir_of_matchof_match);
+
+static int __devinit gpio_ir_recv_dt_probe (struct gpio_rc_dev *gpio_dev,
+ struct rc_dev *rcdev, struct platform_device *pdev) {
+
+ struct device_node *node = pdev->dev.of_node;
+
+ if (!node) {
+ pr_err("Missing gpio_nr in the DT\n");
+ return -EINVAL;
+ }
+
+ if (of_property_read_u32(node, "gpio_nr", &gpio_dev->gpio_nr)) {
+ pr_err("Missing gpio_nr in the DT\n");
+ return -EINVAL;
+ }
+
+ if (of_property_read_u64(node, "allowed_protos",
&rcdev->allowed_protos))
+ rcdev->allowed_protos = RC_BIT_ALL;
+
+ if (of_property_read_bool(node, "active_low"))
+ gpio_dev->active_low = true;
+ else
+ gpio_dev->active_low = false;
+
+ if (of_property_read_string(node, "map_name", &rcdev->map_name))
+ rcdev->map_name = NULL;
+
+ return 0;
+}
+
static int __devinit gpio_ir_recv_probe(struct platform_device *pdev)
{
struct gpio_rc_dev *gpio_dev;
struct rc_dev *rcdev;
const struct gpio_ir_recv_platform_data *pdata =
pdev->dev.platform_data;
- int rc;
-
- if (!pdata)
- return -EINVAL;
-
- if (pdata->gpio_nr < 0)
- return -EINVAL;
+ int rc = -EINVAL;
gpio_dev = kzalloc(sizeof(struct gpio_rc_dev), GFP_KERNEL);
if (!gpio_dev)
@@ -82,6 +112,28 @@ static int __devinit gpio_ir_recv_probe(struct
platform_device *pdev)
goto err_allocate_device;
}
+ if (!pdata) {
+
+ if (gpio_ir_recv_dt_probe(gpio_dev, rcdev, pdev))
+ goto err_dt_create_of;
+
+ } else {
+
+ if (pdata->allowed_protos)
+ rcdev->allowed_protos = pdata->allowed_protos;
+ else
+ rcdev->allowed_protos = RC_BIT_ALL;
+ rcdev->map_name = pdata->map_name ?: RC_MAP_EMPTY;
+
+ gpio_dev->gpio_nr = pdata->gpio_nr;
+ gpio_dev->active_low = pdata->active_low;
+
+ }
+
+ if (gpio_dev->gpio_nr < 0) {
+ goto err_gpio_nr;
+ }
+
rcdev->priv = gpio_dev;
rcdev->driver_type = RC_DRIVER_IR_RAW;
rcdev->input_name = GPIO_IR_DEVICE_NAME;
@@ -92,20 +144,13 @@ static int __devinit gpio_ir_recv_probe(struct
platform_device *pdev)
rcdev->input_id.version = 0x0100;
rcdev->dev.parent = &pdev->dev;
rcdev->driver_name = GPIO_IR_DRIVER_NAME;
- if (pdata->allowed_protos)
- rcdev->allowed_protos = pdata->allowed_protos;
- else
- rcdev->allowed_protos = RC_BIT_ALL;
- rcdev->map_name = pdata->map_name ?: RC_MAP_EMPTY;
gpio_dev->rcdev = rcdev;
- gpio_dev->gpio_nr = pdata->gpio_nr;
- gpio_dev->active_low = pdata->active_low;
- rc = gpio_request(pdata->gpio_nr, "gpio-ir-recv");
+ rc = gpio_request(gpio_dev->gpio_nr, "gpio-ir-recv");
if (rc < 0)
goto err_gpio_request;
- rc = gpio_direction_input(pdata->gpio_nr);
+ rc = gpio_direction_input(gpio_dev->gpio_nr);
if (rc < 0)
goto err_gpio_direction_input;
@@ -117,7 +162,7 @@ static int __devinit gpio_ir_recv_probe(struct
platform_device *pdev)
platform_set_drvdata(pdev, gpio_dev);
- rc = request_any_context_irq(gpio_to_irq(pdata->gpio_nr),
+ rc = request_any_context_irq(gpio_to_irq(gpio_dev->gpio_nr),
gpio_ir_recv_irq,
IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING,
"gpio-ir-recv-irq", gpio_dev);
@@ -131,8 +176,10 @@ err_request_irq:
rc_unregister_device(rcdev);
err_register_rc_device:
err_gpio_direction_input:
- gpio_free(pdata->gpio_nr);
+ gpio_free(gpio_dev->gpio_nr);
err_gpio_request:
+err_dt_create_of:
+err_gpio_nr:
rc_free_device(rcdev);
rcdev = NULL;
err_allocate_device:
@@ -195,6 +242,7 @@ static struct platform_driver gpio_ir_recv_driver = {
#ifdef CONFIG_PM
.pm = &gpio_ir_recv_pm_ops,
#endif
+ .of_match_table = of_match_ptr(gpio_ir_of_match),
},
};
module_platform_driver(gpio_ir_recv_driver);
--
1.7.9.5
--
To unsubscribe from this list: send the line "unsubscribe linux-media" in
the body of a message to [email protected]
More majordomo info at http://vger.kernel.org/majordomo-info.html