[media] rc: nuvoton-cir: Add support for writing wakeup samples via sysfs filter...
authorAntti Seppälä <a.seppala@gmail.com>
Tue, 31 Mar 2015 17:48:12 +0000 (14:48 -0300)
committerMauro Carvalho Chehab <mchehab@osg.samsung.com>
Thu, 14 May 2015 17:37:03 +0000 (14:37 -0300)
Nuvoton-cir utilizes the encoding capabilities of rc-core to convert
scancodes from user space to pulse/space format understood by the
underlying hardware.

Converted samples are then written to the wakeup fifo along with other
necessary configuration to enable wake up functionality.

Signed-off-by: Antti Seppälä <a.seppala@gmail.com>
Signed-off-by: James Hogan <james@albanarts.com>
Cc: Jarod Wilson <jarod@redhat.com>
Signed-off-by: Mauro Carvalho Chehab <mchehab@osg.samsung.com>
drivers/media/rc/nuvoton-cir.c
drivers/media/rc/nuvoton-cir.h
include/media/rc-core.h

index 85af7a8691677a9b3965f469f37bc49b741de6b7..baeb5971fd52cecca1a01f436713f9f3a77c65ca 100644 (file)
@@ -526,6 +526,130 @@ static int nvt_set_tx_carrier(struct rc_dev *dev, u32 carrier)
        return 0;
 }
 
+static int nvt_write_wakeup_codes(struct rc_dev *dev,
+                                 const u8 *wakeup_sample_buf, int count)
+{
+       int i = 0;
+       u8 reg, reg_learn_mode;
+       unsigned long flags;
+       struct nvt_dev *nvt = dev->priv;
+
+       nvt_dbg_wake("writing wakeup samples");
+
+       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);
+
+       if (count > WAKE_FIFO_LEN) {
+               nvt_dbg_wake("HW FIFO too small for all wake samples");
+               count = WAKE_FIFO_LEN;
+       }
+
+       if (count)
+               pr_info("Wake samples (%d) =", count);
+       else
+               pr_info("Wake sample fifo cleared");
+
+       /* Write wake samples to fifo */
+       for (i = 0; i < count; i++) {
+               pr_cont(" %02x", wakeup_sample_buf[i]);
+               nvt_cir_wake_reg_write(nvt, wakeup_sample_buf[i],
+                                      CIR_WAKE_WR_FIFO_DATA);
+       }
+       pr_cont("\n");
+
+       /* 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, count ? count :
+                              CIR_WAKE_FIFO_CMP_BYTES,
+                              CIR_WAKE_FIFO_CMP_DEEP);
+
+       spin_unlock_irqrestore(&nvt->nvt_lock, flags);
+
+       return 0;
+}
+
+static int nvt_ir_raw_set_wakeup_filter(struct rc_dev *dev,
+                                       struct rc_scancode_filter *sc_filter)
+{
+       u8 *reg_buf;
+       u8 buf_val;
+       int i, ret, count;
+       unsigned int val;
+       struct ir_raw_event *raw;
+       bool complete;
+
+       /* Require both mask and data to be set before actually committing */
+       if (!sc_filter->mask || !sc_filter->data)
+               return 0;
+
+       raw = kmalloc_array(WAKE_FIFO_LEN, sizeof(*raw), GFP_KERNEL);
+       if (!raw)
+               return -ENOMEM;
+
+       ret = ir_raw_encode_scancode(dev->enabled_wakeup_protocols, sc_filter,
+                                    raw, WAKE_FIFO_LEN);
+       complete = (ret != -ENOBUFS);
+       if (!complete)
+               ret = WAKE_FIFO_LEN;
+       else if (ret < 0)
+               goto out_raw;
+
+       reg_buf = kmalloc_array(WAKE_FIFO_LEN, sizeof(*reg_buf), GFP_KERNEL);
+       if (!reg_buf) {
+               ret = -ENOMEM;
+               goto out_raw;
+       }
+
+       /* Inspect the ir samples */
+       for (i = 0, count = 0; i < ret && count < WAKE_FIFO_LEN; ++i) {
+               val = NS_TO_US((raw[i]).duration) / SAMPLE_PERIOD;
+
+               /* Split too large values into several smaller ones */
+               while (val > 0 && count < WAKE_FIFO_LEN) {
+
+                       /* Skip last value for better comparison tolerance */
+                       if (complete && i == ret - 1 && val < BUF_LEN_MASK)
+                               break;
+
+                       /* Clamp values to BUF_LEN_MASK at most */
+                       buf_val = (val > BUF_LEN_MASK) ? BUF_LEN_MASK : val;
+
+                       reg_buf[count] = buf_val;
+                       val -= buf_val;
+                       if ((raw[i]).pulse)
+                               reg_buf[count] |= BUF_PULSE_BIT;
+                       count++;
+               }
+       }
+
+       ret = nvt_write_wakeup_codes(dev, reg_buf, count);
+
+       kfree(reg_buf);
+out_raw:
+       kfree(raw);
+
+       return ret;
+}
+
+/* Dummy implementation. nuvoton is agnostic to the protocol used */
+static int nvt_ir_raw_change_wakeup_protocol(struct rc_dev *dev,
+                                            u64 *rc_type)
+{
+       return 0;
+}
+
 /*
  * nvt_tx_ir
  *
@@ -1043,11 +1167,14 @@ static int nvt_probe(struct pnp_dev *pdev, const struct pnp_device_id *dev_id)
        /* Set up the rc device */
        rdev->priv = nvt;
        rdev->driver_type = RC_DRIVER_IR_RAW;
+       rdev->encode_wakeup = true;
        rdev->allowed_protocols = RC_BIT_ALL;
        rdev->open = nvt_open;
        rdev->close = nvt_close;
        rdev->tx_ir = nvt_tx_ir;
        rdev->s_tx_carrier = nvt_set_tx_carrier;
+       rdev->s_wakeup_filter = nvt_ir_raw_set_wakeup_filter;
+       rdev->change_wakeup_protocol = nvt_ir_raw_change_wakeup_protocol;
        rdev->input_name = "Nuvoton w836x7hg Infrared Remote Transceiver";
        rdev->input_phys = "nuvoton/cir0";
        rdev->input_id.bustype = BUS_HOST;
index e1cf23c3875b16ead52464d4e6ad3c479fd1e951..9d0e161c2a886c511d3fde3928b154b0cfb7f0db 100644 (file)
@@ -63,6 +63,7 @@ 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;
index 9ae433c7f14b64476499a280338e275ae5709424..f1cb9daba489620796ee3952f1f6eb4075e44209 100644 (file)
@@ -246,6 +246,7 @@ static inline void init_ir_raw_event(struct ir_raw_event *ev)
 #define US_TO_NS(usec)         ((usec) * 1000)
 #define MS_TO_US(msec)         ((msec) * 1000)
 #define MS_TO_NS(msec)         ((msec) * 1000 * 1000)
+#define NS_TO_US(nsec)         DIV_ROUND_UP(nsec, 1000L)
 
 void ir_raw_event_handle(struct rc_dev *dev);
 int ir_raw_event_store(struct rc_dev *dev, struct ir_raw_event *ev);