forked from Minki/linux
1a1934fab0
The allowed and enabled protocol masks need to be expanded to be per filter type in order to support wakeup filter protocol selection. To ease that process abstract access to the rc_dev::allowed_protos and rc_dev::enabled_protocols members with inline functions. Signed-off-by: James Hogan <james.hogan@imgtec.com> Reviewed-by: Antti Seppälä <a.seppala@gmail.com> Signed-off-by: Mauro Carvalho Chehab <m.chehab@samsung.com>
254 lines
6.1 KiB
C
254 lines
6.1 KiB
C
/* Copyright (c) 2012, Code Aurora Forum. All rights reserved.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 and
|
|
* only version 2 as published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/init.h>
|
|
#include <linux/module.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/gpio.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of_gpio.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/irq.h>
|
|
#include <media/rc-core.h>
|
|
#include <media/gpio-ir-recv.h>
|
|
|
|
#define GPIO_IR_DRIVER_NAME "gpio-rc-recv"
|
|
#define GPIO_IR_DEVICE_NAME "gpio_ir_recv"
|
|
|
|
struct gpio_rc_dev {
|
|
struct rc_dev *rcdev;
|
|
int gpio_nr;
|
|
bool active_low;
|
|
};
|
|
|
|
#ifdef CONFIG_OF
|
|
/*
|
|
* Translate OpenFirmware node properties into platform_data
|
|
*/
|
|
static int gpio_ir_recv_get_devtree_pdata(struct device *dev,
|
|
struct gpio_ir_recv_platform_data *pdata)
|
|
{
|
|
struct device_node *np = dev->of_node;
|
|
enum of_gpio_flags flags;
|
|
int gpio;
|
|
|
|
gpio = of_get_gpio_flags(np, 0, &flags);
|
|
if (gpio < 0) {
|
|
if (gpio != -EPROBE_DEFER)
|
|
dev_err(dev, "Failed to get gpio flags (%d)\n", gpio);
|
|
return gpio;
|
|
}
|
|
|
|
pdata->gpio_nr = gpio;
|
|
pdata->active_low = (flags & OF_GPIO_ACTIVE_LOW);
|
|
/* probe() takes care of map_name == NULL or allowed_protos == 0 */
|
|
pdata->map_name = of_get_property(np, "linux,rc-map-name", NULL);
|
|
pdata->allowed_protos = 0;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct of_device_id gpio_ir_recv_of_match[] = {
|
|
{ .compatible = "gpio-ir-receiver", },
|
|
{ },
|
|
};
|
|
MODULE_DEVICE_TABLE(of, gpio_ir_recv_of_match);
|
|
|
|
#else /* !CONFIG_OF */
|
|
|
|
#define gpio_ir_recv_get_devtree_pdata(dev, pdata) (-ENOSYS)
|
|
|
|
#endif
|
|
|
|
static irqreturn_t gpio_ir_recv_irq(int irq, void *dev_id)
|
|
{
|
|
struct gpio_rc_dev *gpio_dev = dev_id;
|
|
int gval;
|
|
int rc = 0;
|
|
enum raw_event_type type = IR_SPACE;
|
|
|
|
gval = gpio_get_value_cansleep(gpio_dev->gpio_nr);
|
|
|
|
if (gval < 0)
|
|
goto err_get_value;
|
|
|
|
if (gpio_dev->active_low)
|
|
gval = !gval;
|
|
|
|
if (gval == 1)
|
|
type = IR_PULSE;
|
|
|
|
rc = ir_raw_event_store_edge(gpio_dev->rcdev, type);
|
|
if (rc < 0)
|
|
goto err_get_value;
|
|
|
|
ir_raw_event_handle(gpio_dev->rcdev);
|
|
|
|
err_get_value:
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static int 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 (pdev->dev.of_node) {
|
|
struct gpio_ir_recv_platform_data *dtpdata =
|
|
devm_kzalloc(&pdev->dev, sizeof(*dtpdata), GFP_KERNEL);
|
|
if (!dtpdata)
|
|
return -ENOMEM;
|
|
rc = gpio_ir_recv_get_devtree_pdata(&pdev->dev, dtpdata);
|
|
if (rc)
|
|
return rc;
|
|
pdata = dtpdata;
|
|
}
|
|
|
|
if (!pdata)
|
|
return -EINVAL;
|
|
|
|
if (pdata->gpio_nr < 0)
|
|
return -EINVAL;
|
|
|
|
gpio_dev = kzalloc(sizeof(struct gpio_rc_dev), GFP_KERNEL);
|
|
if (!gpio_dev)
|
|
return -ENOMEM;
|
|
|
|
rcdev = rc_allocate_device();
|
|
if (!rcdev) {
|
|
rc = -ENOMEM;
|
|
goto err_allocate_device;
|
|
}
|
|
|
|
rcdev->priv = gpio_dev;
|
|
rcdev->driver_type = RC_DRIVER_IR_RAW;
|
|
rcdev->input_name = GPIO_IR_DEVICE_NAME;
|
|
rcdev->input_phys = GPIO_IR_DEVICE_NAME "/input0";
|
|
rcdev->input_id.bustype = BUS_HOST;
|
|
rcdev->input_id.vendor = 0x0001;
|
|
rcdev->input_id.product = 0x0001;
|
|
rcdev->input_id.version = 0x0100;
|
|
rcdev->dev.parent = &pdev->dev;
|
|
rcdev->driver_name = GPIO_IR_DRIVER_NAME;
|
|
if (pdata->allowed_protos)
|
|
rc_set_allowed_protocols(rcdev, pdata->allowed_protos);
|
|
else
|
|
rc_set_allowed_protocols(rcdev, 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");
|
|
if (rc < 0)
|
|
goto err_gpio_request;
|
|
rc = gpio_direction_input(pdata->gpio_nr);
|
|
if (rc < 0)
|
|
goto err_gpio_direction_input;
|
|
|
|
rc = rc_register_device(rcdev);
|
|
if (rc < 0) {
|
|
dev_err(&pdev->dev, "failed to register rc device\n");
|
|
goto err_register_rc_device;
|
|
}
|
|
|
|
platform_set_drvdata(pdev, gpio_dev);
|
|
|
|
rc = request_any_context_irq(gpio_to_irq(pdata->gpio_nr),
|
|
gpio_ir_recv_irq,
|
|
IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING,
|
|
"gpio-ir-recv-irq", gpio_dev);
|
|
if (rc < 0)
|
|
goto err_request_irq;
|
|
|
|
return 0;
|
|
|
|
err_request_irq:
|
|
rc_unregister_device(rcdev);
|
|
rcdev = NULL;
|
|
err_register_rc_device:
|
|
err_gpio_direction_input:
|
|
gpio_free(pdata->gpio_nr);
|
|
err_gpio_request:
|
|
rc_free_device(rcdev);
|
|
err_allocate_device:
|
|
kfree(gpio_dev);
|
|
return rc;
|
|
}
|
|
|
|
static int gpio_ir_recv_remove(struct platform_device *pdev)
|
|
{
|
|
struct gpio_rc_dev *gpio_dev = platform_get_drvdata(pdev);
|
|
|
|
free_irq(gpio_to_irq(gpio_dev->gpio_nr), gpio_dev);
|
|
rc_unregister_device(gpio_dev->rcdev);
|
|
gpio_free(gpio_dev->gpio_nr);
|
|
kfree(gpio_dev);
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
static int gpio_ir_recv_suspend(struct device *dev)
|
|
{
|
|
struct platform_device *pdev = to_platform_device(dev);
|
|
struct gpio_rc_dev *gpio_dev = platform_get_drvdata(pdev);
|
|
|
|
if (device_may_wakeup(dev))
|
|
enable_irq_wake(gpio_to_irq(gpio_dev->gpio_nr));
|
|
else
|
|
disable_irq(gpio_to_irq(gpio_dev->gpio_nr));
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int gpio_ir_recv_resume(struct device *dev)
|
|
{
|
|
struct platform_device *pdev = to_platform_device(dev);
|
|
struct gpio_rc_dev *gpio_dev = platform_get_drvdata(pdev);
|
|
|
|
if (device_may_wakeup(dev))
|
|
disable_irq_wake(gpio_to_irq(gpio_dev->gpio_nr));
|
|
else
|
|
enable_irq(gpio_to_irq(gpio_dev->gpio_nr));
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct dev_pm_ops gpio_ir_recv_pm_ops = {
|
|
.suspend = gpio_ir_recv_suspend,
|
|
.resume = gpio_ir_recv_resume,
|
|
};
|
|
#endif
|
|
|
|
static struct platform_driver gpio_ir_recv_driver = {
|
|
.probe = gpio_ir_recv_probe,
|
|
.remove = gpio_ir_recv_remove,
|
|
.driver = {
|
|
.name = GPIO_IR_DRIVER_NAME,
|
|
.owner = THIS_MODULE,
|
|
.of_match_table = of_match_ptr(gpio_ir_recv_of_match),
|
|
#ifdef CONFIG_PM
|
|
.pm = &gpio_ir_recv_pm_ops,
|
|
#endif
|
|
},
|
|
};
|
|
module_platform_driver(gpio_ir_recv_driver);
|
|
|
|
MODULE_DESCRIPTION("GPIO IR Receiver driver");
|
|
MODULE_LICENSE("GPL v2");
|