Commit 76e46488 authored by Hans Verkuil's avatar Hans Verkuil Committed by Mauro Carvalho Chehab

media: cec-gpio: support 5v testing

Add support for the new (optional) 5V gpio in order to debug 5V
changes. Some displays turn off CEC if the 5V is not detected,
so it is useful to be able to monitor this line.
Signed-off-by: default avatarHans Verkuil <hans.verkuil@cisco.com>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab+samsung@kernel.org>
parent 4786b0d6
...@@ -23,6 +23,11 @@ struct cec_gpio { ...@@ -23,6 +23,11 @@ struct cec_gpio {
int hpd_irq; int hpd_irq;
bool hpd_is_high; bool hpd_is_high;
ktime_t hpd_ts; ktime_t hpd_ts;
struct gpio_desc *v5_gpio;
int v5_irq;
bool v5_is_high;
ktime_t v5_ts;
}; };
static bool cec_gpio_read(struct cec_adapter *adap) static bool cec_gpio_read(struct cec_adapter *adap)
...@@ -65,6 +70,26 @@ static irqreturn_t cec_hpd_gpio_irq_handler_thread(int irq, void *priv) ...@@ -65,6 +70,26 @@ static irqreturn_t cec_hpd_gpio_irq_handler_thread(int irq, void *priv)
return IRQ_HANDLED; return IRQ_HANDLED;
} }
static irqreturn_t cec_5v_gpio_irq_handler(int irq, void *priv)
{
struct cec_gpio *cec = priv;
bool is_high = gpiod_get_value(cec->v5_gpio);
if (is_high == cec->v5_is_high)
return IRQ_HANDLED;
cec->v5_ts = ktime_get();
cec->v5_is_high = is_high;
return IRQ_WAKE_THREAD;
}
static irqreturn_t cec_5v_gpio_irq_handler_thread(int irq, void *priv)
{
struct cec_gpio *cec = priv;
cec_queue_pin_5v_event(cec->adap, cec->v5_is_high, cec->v5_ts);
return IRQ_HANDLED;
}
static irqreturn_t cec_hpd_gpio_irq_handler(int irq, void *priv) static irqreturn_t cec_hpd_gpio_irq_handler(int irq, void *priv)
{ {
struct cec_gpio *cec = priv; struct cec_gpio *cec = priv;
...@@ -119,6 +144,9 @@ static void cec_gpio_status(struct cec_adapter *adap, struct seq_file *file) ...@@ -119,6 +144,9 @@ static void cec_gpio_status(struct cec_adapter *adap, struct seq_file *file)
if (cec->hpd_gpio) if (cec->hpd_gpio)
seq_printf(file, "hpd: %s\n", seq_printf(file, "hpd: %s\n",
cec->hpd_is_high ? "high" : "low"); cec->hpd_is_high ? "high" : "low");
if (cec->v5_gpio)
seq_printf(file, "5V: %s\n",
cec->v5_is_high ? "high" : "low");
} }
static int cec_gpio_read_hpd(struct cec_adapter *adap) static int cec_gpio_read_hpd(struct cec_adapter *adap)
...@@ -130,6 +158,15 @@ static int cec_gpio_read_hpd(struct cec_adapter *adap) ...@@ -130,6 +158,15 @@ static int cec_gpio_read_hpd(struct cec_adapter *adap)
return gpiod_get_value(cec->hpd_gpio); return gpiod_get_value(cec->hpd_gpio);
} }
static int cec_gpio_read_5v(struct cec_adapter *adap)
{
struct cec_gpio *cec = cec_get_drvdata(adap);
if (!cec->v5_gpio)
return -ENOTTY;
return gpiod_get_value(cec->v5_gpio);
}
static void cec_gpio_free(struct cec_adapter *adap) static void cec_gpio_free(struct cec_adapter *adap)
{ {
cec_gpio_disable_irq(adap); cec_gpio_disable_irq(adap);
...@@ -144,6 +181,7 @@ static const struct cec_pin_ops cec_gpio_pin_ops = { ...@@ -144,6 +181,7 @@ static const struct cec_pin_ops cec_gpio_pin_ops = {
.status = cec_gpio_status, .status = cec_gpio_status,
.free = cec_gpio_free, .free = cec_gpio_free,
.read_hpd = cec_gpio_read_hpd, .read_hpd = cec_gpio_read_hpd,
.read_5v = cec_gpio_read_5v,
}; };
static int cec_gpio_probe(struct platform_device *pdev) static int cec_gpio_probe(struct platform_device *pdev)
...@@ -167,6 +205,10 @@ static int cec_gpio_probe(struct platform_device *pdev) ...@@ -167,6 +205,10 @@ static int cec_gpio_probe(struct platform_device *pdev)
if (IS_ERR(cec->hpd_gpio)) if (IS_ERR(cec->hpd_gpio))
return PTR_ERR(cec->hpd_gpio); return PTR_ERR(cec->hpd_gpio);
cec->v5_gpio = devm_gpiod_get_optional(dev, "v5", GPIOD_IN);
if (IS_ERR(cec->v5_gpio))
return PTR_ERR(cec->v5_gpio);
cec->adap = cec_pin_allocate_adapter(&cec_gpio_pin_ops, cec->adap = cec_pin_allocate_adapter(&cec_gpio_pin_ops,
cec, pdev->name, CEC_CAP_DEFAULTS | CEC_CAP_PHYS_ADDR | cec, pdev->name, CEC_CAP_DEFAULTS | CEC_CAP_PHYS_ADDR |
CEC_CAP_MONITOR_ALL | CEC_CAP_MONITOR_PIN); CEC_CAP_MONITOR_ALL | CEC_CAP_MONITOR_PIN);
...@@ -185,6 +227,18 @@ static int cec_gpio_probe(struct platform_device *pdev) ...@@ -185,6 +227,18 @@ static int cec_gpio_probe(struct platform_device *pdev)
return ret; return ret;
} }
if (cec->v5_gpio) {
cec->v5_irq = gpiod_to_irq(cec->v5_gpio);
ret = devm_request_threaded_irq(dev, cec->v5_irq,
cec_5v_gpio_irq_handler,
cec_5v_gpio_irq_handler_thread,
IRQF_ONESHOT |
IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING,
"v5-gpio", cec);
if (ret)
return ret;
}
ret = cec_register_adapter(cec->adap, &pdev->dev); ret = cec_register_adapter(cec->adap, &pdev->dev);
if (ret) { if (ret) {
cec_delete_adapter(cec->adap); cec_delete_adapter(cec->adap);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment