This patch adds support for reading/writing wakeup scancodes via sysfs
to nuvoton-cir hardware.
Signed-off-by: Antti Seppälä <a.sepp...@gmail.com>
---
drivers/media/rc/nuvoton-cir.c | 81 ++++++++++++++++++++++++++++++++++++++++++
drivers/media/rc/nuvoton-cir.h | 2 ++
2 files changed, 83 insertions(+)
diff --git a/drivers/media/rc/nuvoton-cir.c b/drivers/media/rc/nuvoton-cir.c
index 21ee0dc..c1b0cf2 100644
--- a/drivers/media/rc/nuvoton-cir.c
+++ b/drivers/media/rc/nuvoton-cir.c
@@ -531,6 +531,86 @@ static int nvt_set_tx_carrier(struct rc_dev *dev, u32
carrier)
return 0;
}
+static int nvt_wakeup_scancodes(struct rc_dev *dev,
+ struct list_head *scancode_list, int write)
+{
+ int i = 0;
+ u8 cnt, reg, reg_learn_mode;
+ unsigned long flags;
+ struct rc_wakeup_scancode *scancode;
+ struct nvt_dev *nvt = dev->priv;
+
+ if (write) {
+ nvt_dbg_wake("%s firing, write", __func__);
+
+ reg = nvt_cir_wake_reg_read(nvt, CIR_WAKE_IRCON);
+ reg_learn_mode = reg & ~CIR_WAKE_IRCON_MODE0;
+ reg_learn_mode |= CIR_WAKE_IRCON_MODE1;
+
+ /* Lock the learn area to prevent racing with wake-isr */
+ spin_lock_irqsave(&nvt->nvt_lock, flags);
+
+ /* Enable fifo writes */
+ nvt_cir_wake_reg_write(nvt, reg_learn_mode, CIR_WAKE_IRCON);
+
+ /* Clear cir wake rx fifo */
+ nvt_clear_cir_wake_fifo(nvt);
+
+ /* Write wake samples to fifo */
+ list_for_each_entry_reverse(scancode, scancode_list,
+ list_item) {
+ /* Prevent writing too many codes */
+ if (++i > WAKE_FIFO_LEN)
+ break;
+ nvt_cir_wake_reg_write(nvt, scancode->value,
+ CIR_WAKE_WR_FIFO_DATA);
+ }
+
+ /* Switch cir to wakeup mode and disable fifo writing */
+ nvt_cir_wake_reg_write(nvt, reg, CIR_WAKE_IRCON);
+
+ /* Set number of bytes needed for wake */
+ nvt_cir_wake_reg_write(nvt, i ? i :
+ CIR_WAKE_FIFO_CMP_BYTES,
+ CIR_WAKE_FIFO_CMP_DEEP);
+
+ spin_unlock_irqrestore(&nvt->nvt_lock, flags);
+
+ if (i > WAKE_FIFO_LEN)
+ return -EINVAL;
+ } else {
+ nvt_dbg_wake("%s firing, read", __func__);
+
+ /* Scroll to index 0 */
+ while (nvt_cir_wake_reg_read(nvt, CIR_WAKE_RD_FIFO_ONLY_IDX)) {
+ nvt_cir_wake_reg_read(nvt, CIR_WAKE_RD_FIFO_ONLY);
+
+ /* Stuck index guardian */
+ if (++i > 255) {
+ nvt_dbg_wake("Idx reg is stuck!");
+ break;
+ }
+ }
+
+ /* Get size of wake fifo and allocate memory for the bytes */
+ cnt = nvt_cir_wake_reg_read(nvt, CIR_WAKE_FIFO_COUNT);
+
+ for (i = 0; i < cnt; i++) {
+ scancode = kmalloc(sizeof(struct rc_wakeup_scancode),
+ GFP_KERNEL | GFP_ATOMIC);
+ if (!scancode)
+ return -ENOMEM;
+ scancode->value =
+ nvt_cir_wake_reg_read(nvt,
+ CIR_WAKE_RD_FIFO_ONLY);
+ list_add(&scancode->list_item, scancode_list);
+ }
+
+ return cnt;
+ }
+
+ return 0;
+}
/*
* nvt_tx_ir
*
@@ -1047,6 +1127,7 @@ static int nvt_probe(struct pnp_dev *pdev, const struct
pnp_device_id *dev_id)
rdev->close = nvt_close;
rdev->tx_ir = nvt_tx_ir;
rdev->s_tx_carrier = nvt_set_tx_carrier;
+ rdev->s_wakeup_scancodes = nvt_wakeup_scancodes;
rdev->input_name = "Nuvoton w836x7hg Infrared Remote Transceiver";
rdev->input_phys = "nuvoton/cir0";
rdev->input_id.bustype = BUS_HOST;
diff --git a/drivers/media/rc/nuvoton-cir.h b/drivers/media/rc/nuvoton-cir.h
index 07e8310..24ff630 100644
--- a/drivers/media/rc/nuvoton-cir.h
+++ b/drivers/media/rc/nuvoton-cir.h
@@ -64,6 +64,8 @@ static int debug;
#define TX_BUF_LEN 256
#define RX_BUF_LEN 32
+#define WAKE_FIFO_LEN 67
+
struct nvt_dev {
struct pnp_dev *pdev;
struct rc_dev *rdev;
--
1.8.3.2
--
To unsubscribe from this list: send the line "unsubscribe linux-media" in
the body of a message to majord...@vger.kernel.org
More majordomo info at http://vger.kernel.org/majordomo-info.html
