HID: picoLCD: Add support for CIR

Implement support for picoLCD's CIR header using RC_CORE for decoding
the IR event stream.

Signed-off-by: Bruno Prémont <bonbons@linux-vserver.org>
Signed-off-by: Jiri Kosina <jkosina@suse.cz>

diff --git a/drivers/hid/hid-picolcd.h b/drivers/hid/hid-picolcd.h
index dc4c795..240eb1c 100644 (file)
--- a/drivers/hid/hid-picolcd.h
+++ b/drivers/hid/hid-picolcd.h
@@ -85,7 +85,9 @@ struct picolcd_data {
        /* input stuff */
        u8 pressed_keys[2];
        struct input_dev *input_keys;
-       struct input_dev *input_cir;
+#ifdef CONFIG_HID_PICOLCD_CIR
+       struct rc_dev *rc_dev;
+#endif
        unsigned short keycode[PICOLCD_KEYS];
 
 #ifdef CONFIG_HID_PICOLCD_FB
@@ -114,6 +116,7 @@ struct picolcd_data {
        int status;
 #define PICOLCD_BOOTLOADER 1
 #define PICOLCD_FAILED 2
+#define PICOLCD_CIR_SHUN 4
 };
 
 #ifdef CONFIG_HID_PICOLCD_FB

diff --git a/drivers/hid/hid-picolcd_cir.c b/drivers/hid/hid-picolcd_cir.c
index dc632c3..14c5ce0 100644 (file)
--- a/drivers/hid/hid-picolcd_cir.c
+++ b/drivers/hid/hid-picolcd_cir.c
@@ -37,6 +37,7 @@
 #include <linux/completion.h>
 #include <linux/uaccess.h>
 #include <linux/module.h>
+#include <media/rc-core.h>
 
 #include "hid-picolcd.h"
 
@@ -44,18 +45,108 @@
 int picolcd_raw_cir(struct picolcd_data *data,
                struct hid_report *report, u8 *raw_data, int size)
 {
-       /* Need understanding of CIR data format to implement ... */
+       unsigned long flags;
+       int i, w, sz;
+       DEFINE_IR_RAW_EVENT(rawir);
+
+       /* ignore if rc_dev is NULL or status is shunned */
+       spin_lock_irqsave(&data->lock, flags);
+       if (data->rc_dev && (data->status & PICOLCD_CIR_SHUN)) {
+               spin_unlock_irqrestore(&data->lock, flags);
+               return 1;
+       }
+       spin_unlock_irqrestore(&data->lock, flags);
+
+       /* PicoLCD USB packets contain 16-bit intervals in network order,
+        * with value negated for pulse. Intervals are in microseconds.
+        *
+        * Note: some userspace LIRC code for PicoLCD says negated values
+        * for space - is it a matter of IR chip? (pulse for my TSOP2236)
+        *
+        * In addition, the first interval seems to be around 15000 + base
+        * interval for non-first report of IR data - thus the quirk below
+        * to get RC_CODE to understand Sony and JVC remotes I have at hand
+        */
+       sz = size > 0 ? min((int)raw_data[0], size-1) : 0;
+       for (i = 0; i+1 < sz; i += 2) {
+               init_ir_raw_event(&rawir);
+               w = (raw_data[i] << 8) | (raw_data[i+1]);
+               rawir.pulse = !!(w & 0x8000);
+               rawir.duration = US_TO_NS(rawir.pulse ? (65536 - w) : w);
+               /* Quirk!! - see above */
+               if (i == 0 && rawir.duration > 15000000)
+                       rawir.duration -= 15000000;
+               ir_raw_event_store(data->rc_dev, &rawir);
+       }
+       ir_raw_event_handle(data->rc_dev);
+
        return 1;
 }
 
+static int picolcd_cir_open(struct rc_dev *dev)
+{
+       struct picolcd_data *data = dev->priv;
+       unsigned long flags;
+
+       spin_lock_irqsave(&data->lock, flags);
+       data->status &= ~PICOLCD_CIR_SHUN;
+       spin_unlock_irqrestore(&data->lock, flags);
+       return 0;
+}
+
+static void picolcd_cir_close(struct rc_dev *dev)
+{
+       struct picolcd_data *data = dev->priv;
+       unsigned long flags;
+
+       spin_lock_irqsave(&data->lock, flags);
+       data->status |= PICOLCD_CIR_SHUN;
+       spin_unlock_irqrestore(&data->lock, flags);
+}
+
 /* initialize CIR input device */
 int picolcd_init_cir(struct picolcd_data *data, struct hid_report *report)
 {
-       /* support not implemented yet */
+       struct rc_dev *rdev;
+       int ret = 0;
+
+       rdev = rc_allocate_device();
+       if (!rdev)
+               return -ENOMEM;
+
+       rdev->priv             = data;
+       rdev->driver_type      = RC_DRIVER_IR_RAW;
+       rdev->allowed_protos   = RC_TYPE_ALL;
+       rdev->open             = picolcd_cir_open;
+       rdev->close            = picolcd_cir_close;
+       rdev->input_name       = data->hdev->name;
+       rdev->input_phys       = data->hdev->phys;
+       rdev->input_id.bustype = data->hdev->bus;
+       rdev->input_id.vendor  = data->hdev->vendor;
+       rdev->input_id.product = data->hdev->product;
+       rdev->input_id.version = data->hdev->version;
+       rdev->dev.parent       = &data->hdev->dev;
+       rdev->driver_name      = PICOLCD_NAME;
+       rdev->map_name         = RC_MAP_RC6_MCE;
+       rdev->timeout          = MS_TO_NS(100);
+       rdev->rx_resolution    = US_TO_NS(1);
+
+       ret = rc_register_device(rdev);
+       if (ret)
+               goto err;
+       data->rc_dev = rdev;
        return 0;
+
+err:
+       rc_free_device(rdev);
+       return ret;
 }
 
 void picolcd_exit_cir(struct picolcd_data *data)
 {
+       struct rc_dev *rdev = data->rc_dev;
+
+       data->rc_dev = NULL;
+       rc_unregister_device(rdev);
 }
 

diff --git a/drivers/hid/hid-picolcd_core.c b/drivers/hid/hid-picolcd_core.c
index e4fe342..0d0c798 100644 (file)
--- a/drivers/hid/hid-picolcd_core.c
+++ b/drivers/hid/hid-picolcd_core.c
@@ -356,8 +356,7 @@ static int picolcd_raw_event(struct hid_device *hdev,
                if (data->input_keys)
                        ret = picolcd_raw_keypad(data, report, raw_data+1, size-1);
        } else if (report->id == REPORT_IR_DATA) {
-               if (data->input_cir)
-                       ret = picolcd_raw_cir(data, report, raw_data+1, size-1);
+               ret = picolcd_raw_cir(data, report, raw_data+1, size-1);
        } else {
                spin_lock_irqsave(&data->lock, flags);
                /*