Commit 724e2495 authored by David Härdeman's avatar David Härdeman Committed by Mauro Carvalho Chehab

V4L/DVB: Teach drivers/media/IR/ir-raw-event.c to use durations

drivers/media/IR/ir-raw-event.c is currently written with the assumption
that all "raw" hardware will generate events only on state change (i.e.
when a pulse or space starts).

However, some hardware (like mceusb, probably the most popular IR receiver
out there) only generates duration data (and that data is buffered so using
any kind of timing on the data is futile).

Furthermore, using signed int's to represent pulse/space durations is a
well-known approach when writing ir decoders.

With this patch:

- s64 int's are used to represent pulse/space durations in ns

- a workqueue is used to decode the ir protocols outside of interrupt context

- #defines are added to make decoders clearer

- decoder reset is implemented by passing a zero duration to the kfifo queue
  and decoders are updated accordingly
Signed-off-by: default avatarDavid Härdeman <david@hardeman.nu>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@redhat.com>
parent d22e546e
...@@ -13,15 +13,16 @@ ...@@ -13,15 +13,16 @@
*/ */
#include <media/ir-core.h> #include <media/ir-core.h>
#include <linux/bitrev.h>
#define NEC_NBITS 32 #define NEC_NBITS 32
#define NEC_UNIT 559979 /* ns */ #define NEC_UNIT 562500 /* ns */
#define NEC_HEADER_MARK (16 * NEC_UNIT) #define NEC_HEADER_PULSE PULSE(16)
#define NEC_HEADER_SPACE (8 * NEC_UNIT) #define NEC_HEADER_SPACE SPACE(8)
#define NEC_REPEAT_SPACE (4 * NEC_UNIT) #define NEC_REPEAT_SPACE SPACE(4)
#define NEC_MARK (NEC_UNIT) #define NEC_BIT_PULSE PULSE(1)
#define NEC_0_SPACE (NEC_UNIT) #define NEC_BIT_0_SPACE SPACE(1)
#define NEC_1_SPACE (3 * NEC_UNIT) #define NEC_BIT_1_SPACE SPACE(3)
/* Used to register nec_decoder clients */ /* Used to register nec_decoder clients */
static LIST_HEAD(decoder_list); static LIST_HEAD(decoder_list);
...@@ -29,21 +30,13 @@ static DEFINE_SPINLOCK(decoder_lock); ...@@ -29,21 +30,13 @@ static DEFINE_SPINLOCK(decoder_lock);
enum nec_state { enum nec_state {
STATE_INACTIVE, STATE_INACTIVE,
STATE_HEADER_MARK,
STATE_HEADER_SPACE, STATE_HEADER_SPACE,
STATE_MARK, STATE_BIT_PULSE,
STATE_SPACE, STATE_BIT_SPACE,
STATE_TRAILER_MARK, STATE_TRAILER_PULSE,
STATE_TRAILER_SPACE, STATE_TRAILER_SPACE,
}; };
struct nec_code {
u8 address;
u8 not_address;
u8 command;
u8 not_command;
};
struct decoder_data { struct decoder_data {
struct list_head list; struct list_head list;
struct ir_input_dev *ir_dev; struct ir_input_dev *ir_dev;
...@@ -51,7 +44,7 @@ struct decoder_data { ...@@ -51,7 +44,7 @@ struct decoder_data {
/* State machine control */ /* State machine control */
enum nec_state state; enum nec_state state;
struct nec_code nec_code; u32 nec_bits;
unsigned count; unsigned count;
}; };
...@@ -62,7 +55,6 @@ struct decoder_data { ...@@ -62,7 +55,6 @@ struct decoder_data {
* *
* Returns the struct decoder_data that corresponds to a device * Returns the struct decoder_data that corresponds to a device
*/ */
static struct decoder_data *get_decoder_data(struct ir_input_dev *ir_dev) static struct decoder_data *get_decoder_data(struct ir_input_dev *ir_dev)
{ {
struct decoder_data *data = NULL; struct decoder_data *data = NULL;
...@@ -123,20 +115,20 @@ static struct attribute_group decoder_attribute_group = { ...@@ -123,20 +115,20 @@ static struct attribute_group decoder_attribute_group = {
.attrs = decoder_attributes, .attrs = decoder_attributes,
}; };
/** /**
* ir_nec_decode() - Decode one NEC pulse or space * ir_nec_decode() - Decode one NEC pulse or space
* @input_dev: the struct input_dev descriptor of the device * @input_dev: the struct input_dev descriptor of the device
* @ev: event array with type/duration of pulse/space * @duration: duration in ns of pulse/space
* *
* This function returns -EINVAL if the pulse violates the state machine * This function returns -EINVAL if the pulse violates the state machine
*/ */
static int ir_nec_decode(struct input_dev *input_dev, static int ir_nec_decode(struct input_dev *input_dev, s64 duration)
struct ir_raw_event *ev)
{ {
struct decoder_data *data; struct decoder_data *data;
struct ir_input_dev *ir_dev = input_get_drvdata(input_dev); struct ir_input_dev *ir_dev = input_get_drvdata(input_dev);
int bit, last_bit; int u;
u32 scancode;
u8 address, not_address, command, not_command;
data = get_decoder_data(ir_dev); data = get_decoder_data(ir_dev);
if (!data) if (!data)
...@@ -145,150 +137,107 @@ static int ir_nec_decode(struct input_dev *input_dev, ...@@ -145,150 +137,107 @@ static int ir_nec_decode(struct input_dev *input_dev,
if (!data->enabled) if (!data->enabled)
return 0; return 0;
/* Except for the initial event, what matters is the previous bit */ if (IS_RESET(duration)) {
bit = (ev->type & IR_PULSE) ? 1 : 0;
last_bit = !bit;
/* Discards spurious space last_bits when inactive */
/* Very long delays are considered as start events */
if (ev->delta.tv_nsec > NEC_HEADER_MARK + NEC_HEADER_SPACE - NEC_UNIT / 2)
data->state = STATE_INACTIVE; data->state = STATE_INACTIVE;
return 0;
}
if (ev->type & IR_START_EVENT) u = TO_UNITS(duration, NEC_UNIT);
data->state = STATE_INACTIVE; if (DURATION(u) == 0)
goto out;
IR_dprintk(2, "NEC decode started at state %d (%i units, %ius)\n",
data->state, u, TO_US(duration));
switch (data->state) { switch (data->state) {
case STATE_INACTIVE:
if (!bit) /* PULSE marks the start event */
return 0;
data->count = 0; case STATE_INACTIVE:
data->state = STATE_HEADER_MARK; if (u == NEC_HEADER_PULSE) {
memset (&data->nec_code, 0, sizeof(data->nec_code)); data->count = 0;
return 0; data->state = STATE_HEADER_SPACE;
case STATE_HEADER_MARK: }
if (!last_bit)
goto err;
if (ev->delta.tv_nsec < NEC_HEADER_MARK - 6 * NEC_UNIT)
goto err;
data->state = STATE_HEADER_SPACE;
return 0; return 0;
case STATE_HEADER_SPACE: case STATE_HEADER_SPACE:
if (last_bit) if (u == NEC_HEADER_SPACE) {
goto err; data->state = STATE_BIT_PULSE;
if (ev->delta.tv_nsec >= NEC_HEADER_SPACE - NEC_UNIT / 2) {
data->state = STATE_MARK;
return 0; return 0;
} } else if (u == NEC_REPEAT_SPACE) {
if (ev->delta.tv_nsec >= NEC_REPEAT_SPACE - NEC_UNIT / 2) {
ir_repeat(input_dev); ir_repeat(input_dev);
IR_dprintk(1, "Repeat last key\n"); IR_dprintk(1, "Repeat last key\n");
data->state = STATE_TRAILER_MARK; data->state = STATE_TRAILER_PULSE;
return 0; return 0;
} }
goto err; break;
case STATE_MARK:
if (!last_bit) case STATE_BIT_PULSE:
goto err; if (u == NEC_BIT_PULSE) {
if ((ev->delta.tv_nsec > NEC_MARK + NEC_UNIT / 2) || data->state = STATE_BIT_SPACE;
(ev->delta.tv_nsec < NEC_MARK - NEC_UNIT / 2)) return 0;
goto err; }
data->state = STATE_SPACE; break;
return 0;
case STATE_SPACE: case STATE_BIT_SPACE:
if (last_bit) if (u != NEC_BIT_0_SPACE && u != NEC_BIT_1_SPACE)
goto err; break;
if ((ev->delta.tv_nsec >= NEC_0_SPACE - NEC_UNIT / 2) && data->nec_bits <<= 1;
(ev->delta.tv_nsec < NEC_0_SPACE + NEC_UNIT / 2)) if (u == NEC_BIT_1_SPACE)
bit = 0; data->nec_bits |= 1;
else if ((ev->delta.tv_nsec >= NEC_1_SPACE - NEC_UNIT / 2) && data->count++;
(ev->delta.tv_nsec < NEC_1_SPACE + NEC_UNIT / 2))
bit = 1; if (data->count != NEC_NBITS) {
else { data->state = STATE_BIT_PULSE;
IR_dprintk(1, "Decode failed at %d-th bit (%s) @%luus\n", return 0;
data->count, }
last_bit ? "pulse" : "space",
(ev->delta.tv_nsec + 500) / 1000); address = bitrev8((data->nec_bits >> 24) & 0xff);
not_address = bitrev8((data->nec_bits >> 16) & 0xff);
goto err2; command = bitrev8((data->nec_bits >> 8) & 0xff);
not_command = bitrev8((data->nec_bits >> 0) & 0xff);
if ((command ^ not_command) != 0xff) {
IR_dprintk(1, "NEC checksum error: received 0x%08x\n",
data->nec_bits);
break;
} }
/* Ok, we've got a valid bit. proccess it */ if ((address ^ not_address) != 0xff) {
if (bit) { /* Extended NEC */
int shift = data->count; scancode = address << 16 |
not_address << 8 |
/* command;
* NEC transmit bytes on this temporal order: IR_dprintk(1, "NEC (Ext) scancode 0x%06x\n", scancode);
* address | not address | command | not command } else {
*/ /* normal NEC */
if (shift < 8) { scancode = address << 8 | command;
data->nec_code.address |= 1 << shift; IR_dprintk(1, "NEC scancode 0x%04x\n", scancode);
} else if (shift < 16) {
data->nec_code.not_address |= 1 << (shift - 8);
} else if (shift < 24) {
data->nec_code.command |= 1 << (shift - 16);
} else {
data->nec_code.not_command |= 1 << (shift - 24);
}
} }
if (++data->count == NEC_NBITS) {
u32 scancode; ir_keydown(input_dev, scancode, 0);
/* data->state = STATE_TRAILER_PULSE;
* Fixme: may need to accept Extended NEC protocol?
*/
if ((data->nec_code.command ^ data->nec_code.not_command) != 0xff)
goto checksum_err;
if ((data->nec_code.address ^ data->nec_code.not_address) != 0xff) {
/* Extended NEC */
scancode = data->nec_code.address << 16 |
data->nec_code.not_address << 8 |
data->nec_code.command;
IR_dprintk(1, "NEC scancode 0x%06x\n", scancode);
} else {
/* normal NEC */
scancode = data->nec_code.address << 8 |
data->nec_code.command;
IR_dprintk(1, "NEC scancode 0x%04x\n", scancode);
}
ir_keydown(input_dev, scancode, 0);
data->state = STATE_TRAILER_MARK;
} else
data->state = STATE_MARK;
return 0;
case STATE_TRAILER_MARK:
if (!last_bit)
goto err;
data->state = STATE_TRAILER_SPACE;
return 0; return 0;
case STATE_TRAILER_PULSE:
if (u > 0) {
data->state = STATE_TRAILER_SPACE;
return 0;
}
break;
case STATE_TRAILER_SPACE: case STATE_TRAILER_SPACE:
if (last_bit) if (u < 0) {
goto err; data->state = STATE_INACTIVE;
data->state = STATE_INACTIVE; return 0;
return 0; }
}
err: break;
IR_dprintk(1, "NEC decoded failed at state %d (%s) @ %luus\n", }
data->state,
bit ? "pulse" : "space",
(ev->delta.tv_nsec + 500) / 1000);
err2:
data->state = STATE_INACTIVE;
return -EINVAL;
checksum_err: out:
IR_dprintk(1, "NEC decode failed at state %d (%i units, %ius)\n",
data->state, u, TO_US(duration));
data->state = STATE_INACTIVE; data->state = STATE_INACTIVE;
IR_dprintk(1, "NEC checksum error: received 0x%02x%02x%02x%02x\n",
data->nec_code.address,
data->nec_code.not_address,
data->nec_code.command,
data->nec_code.not_command);
return -EINVAL; return -EINVAL;
} }
......
...@@ -15,9 +15,10 @@ ...@@ -15,9 +15,10 @@
#include <media/ir-core.h> #include <media/ir-core.h>
#include <linux/workqueue.h> #include <linux/workqueue.h>
#include <linux/spinlock.h> #include <linux/spinlock.h>
#include <linux/sched.h>
/* Define the max number of bit transitions per IR keycode */ /* Define the max number of pulse/space transitions to buffer */
#define MAX_IR_EVENT_SIZE 256 #define MAX_IR_EVENT_SIZE 512
/* Used to handle IR raw handler extensions */ /* Used to handle IR raw handler extensions */
static LIST_HEAD(ir_raw_handler_list); static LIST_HEAD(ir_raw_handler_list);
...@@ -53,19 +54,30 @@ static DEFINE_SPINLOCK(ir_raw_handler_lock); ...@@ -53,19 +54,30 @@ static DEFINE_SPINLOCK(ir_raw_handler_lock);
/* Used to load the decoders */ /* Used to load the decoders */
static struct work_struct wq_load; static struct work_struct wq_load;
static void ir_raw_event_work(struct work_struct *work)
{
s64 d;
struct ir_raw_event_ctrl *raw =
container_of(work, struct ir_raw_event_ctrl, rx_work);
while (kfifo_out(&raw->kfifo, &d, sizeof(d)) == sizeof(d))
RUN_DECODER(decode, raw->input_dev, d);
}
int ir_raw_event_register(struct input_dev *input_dev) int ir_raw_event_register(struct input_dev *input_dev)
{ {
struct ir_input_dev *ir = input_get_drvdata(input_dev); struct ir_input_dev *ir = input_get_drvdata(input_dev);
int rc, size; int rc;
ir->raw = kzalloc(sizeof(*ir->raw), GFP_KERNEL); ir->raw = kzalloc(sizeof(*ir->raw), GFP_KERNEL);
if (!ir->raw) if (!ir->raw)
return -ENOMEM; return -ENOMEM;
size = sizeof(struct ir_raw_event) * MAX_IR_EVENT_SIZE * 2; ir->raw->input_dev = input_dev;
size = roundup_pow_of_two(size); INIT_WORK(&ir->raw->rx_work, ir_raw_event_work);
rc = kfifo_alloc(&ir->raw->kfifo, size, GFP_KERNEL); rc = kfifo_alloc(&ir->raw->kfifo, sizeof(s64) * MAX_IR_EVENT_SIZE,
GFP_KERNEL);
if (rc < 0) { if (rc < 0) {
kfree(ir->raw); kfree(ir->raw);
ir->raw = NULL; ir->raw = NULL;
...@@ -90,6 +102,7 @@ void ir_raw_event_unregister(struct input_dev *input_dev) ...@@ -90,6 +102,7 @@ void ir_raw_event_unregister(struct input_dev *input_dev)
if (!ir->raw) if (!ir->raw)
return; return;
cancel_work_sync(&ir->raw->rx_work);
RUN_DECODER(raw_unregister, input_dev); RUN_DECODER(raw_unregister, input_dev);
kfifo_free(&ir->raw->kfifo); kfifo_free(&ir->raw->kfifo);
...@@ -97,74 +110,90 @@ void ir_raw_event_unregister(struct input_dev *input_dev) ...@@ -97,74 +110,90 @@ void ir_raw_event_unregister(struct input_dev *input_dev)
ir->raw = NULL; ir->raw = NULL;
} }
int ir_raw_event_store(struct input_dev *input_dev, enum raw_event_type type) /**
* ir_raw_event_store() - pass a pulse/space duration to the raw ir decoders
* @input_dev: the struct input_dev device descriptor
* @duration: duration of the pulse or space in ns
*
* This routine (which may be called from an interrupt context) stores a
* pulse/space duration for the raw ir decoding state machines. Pulses are
* signalled as positive values and spaces as negative values. A zero value
* will reset the decoding state machines.
*/
int ir_raw_event_store(struct input_dev *input_dev, s64 duration)
{ {
struct ir_input_dev *ir = input_get_drvdata(input_dev); struct ir_input_dev *ir = input_get_drvdata(input_dev);
struct timespec ts;
struct ir_raw_event event;
int rc;
if (!ir->raw) if (!ir->raw)
return -EINVAL; return -EINVAL;
event.type = type; if (kfifo_in(&ir->raw->kfifo, &duration, sizeof(duration)) != sizeof(duration))
event.delta.tv_sec = 0; return -ENOMEM;
event.delta.tv_nsec = 0;
ktime_get_ts(&ts); return 0;
}
EXPORT_SYMBOL_GPL(ir_raw_event_store);
if (timespec_equal(&ir->raw->last_event, &event.delta)) /**
event.type |= IR_START_EVENT; * ir_raw_event_store_edge() - notify raw ir decoders of the start of a pulse/space
else * @input_dev: the struct input_dev device descriptor
event.delta = timespec_sub(ts, ir->raw->last_event); * @type: the type of the event that has occurred
*
* This routine (which may be called from an interrupt context) is used to
* store the beginning of an ir pulse or space (or the start/end of ir
* reception) for the raw ir decoding state machines. This is used by
* hardware which does not provide durations directly but only interrupts
* (or similar events) on state change.
*/
int ir_raw_event_store_edge(struct input_dev *input_dev, enum raw_event_type type)
{
struct ir_input_dev *ir = input_get_drvdata(input_dev);
ktime_t now;
s64 delta; /* ns */
int rc = 0;
memcpy(&ir->raw->last_event, &ts, sizeof(ts)); if (!ir->raw)
return -EINVAL;
if (event.delta.tv_sec) { now = ktime_get();
event.type |= IR_START_EVENT; delta = ktime_to_ns(ktime_sub(now, ir->raw->last_event));
event.delta.tv_sec = 0;
event.delta.tv_nsec = 0;
}
kfifo_in(&ir->raw->kfifo, &event, sizeof(event)); /* Check for a long duration since last event or if we're
* being called for the first time, note that delta can't
* possibly be negative.
*/
if (delta > NSEC_PER_SEC || !ir->raw->last_type)
type |= IR_START_EVENT;
if (type & IR_START_EVENT)
ir_raw_event_reset(input_dev);
else if (ir->raw->last_type & IR_SPACE)
rc = ir_raw_event_store(input_dev, -delta);
else if (ir->raw->last_type & IR_PULSE)
rc = ir_raw_event_store(input_dev, delta);
else
return 0;
ir->raw->last_event = now;
ir->raw->last_type = type;
return rc; return rc;
} }
EXPORT_SYMBOL_GPL(ir_raw_event_store); EXPORT_SYMBOL_GPL(ir_raw_event_store_edge);
int ir_raw_event_handle(struct input_dev *input_dev) /**
* ir_raw_event_handle() - schedules the decoding of stored ir data
* @input_dev: the struct input_dev device descriptor
*
* This routine will signal the workqueue to start decoding stored ir data.
*/
void ir_raw_event_handle(struct input_dev *input_dev)
{ {
struct ir_input_dev *ir = input_get_drvdata(input_dev); struct ir_input_dev *ir = input_get_drvdata(input_dev);
int rc;
struct ir_raw_event ev;
int len, i;
/*
* Store the events into a temporary buffer. This allows calling more than
* one decoder to deal with the received data
*/
len = kfifo_len(&ir->raw->kfifo) / sizeof(ev);
if (!len)
return 0;
for (i = 0; i < len; i++) {
rc = kfifo_out(&ir->raw->kfifo, &ev, sizeof(ev));
if (rc != sizeof(ev)) {
IR_dprintk(1, "overflow error: received %d instead of %zd\n",
rc, sizeof(ev));
return -EINVAL;
}
IR_dprintk(2, "event type %d, time before event: %07luus\n",
ev.type, (ev.delta.tv_nsec + 500) / 1000);
rc = RUN_DECODER(decode, input_dev, &ev);
}
/* if (!ir->raw)
* Call all ir decoders. This allows decoding the same event with return;
* more than one protocol handler.
*/
return rc; schedule_work(&ir->raw->rx_work);
} }
EXPORT_SYMBOL_GPL(ir_raw_event_handle); EXPORT_SYMBOL_GPL(ir_raw_event_handle);
......
...@@ -21,11 +21,8 @@ ...@@ -21,11 +21,8 @@
#include <media/ir-core.h> #include <media/ir-core.h>
static unsigned int ir_rc5_remote_gap = 888888;
#define RC5_NBITS 14 #define RC5_NBITS 14
#define RC5_BIT (ir_rc5_remote_gap * 2) #define RC5_UNIT 888888 /* ns */
#define RC5_DURATION (ir_rc5_remote_gap * RC5_NBITS)
/* Used to register rc5_decoder clients */ /* Used to register rc5_decoder clients */
static LIST_HEAD(decoder_list); static LIST_HEAD(decoder_list);
...@@ -33,13 +30,9 @@ static DEFINE_SPINLOCK(decoder_lock); ...@@ -33,13 +30,9 @@ static DEFINE_SPINLOCK(decoder_lock);
enum rc5_state { enum rc5_state {
STATE_INACTIVE, STATE_INACTIVE,
STATE_MARKSPACE, STATE_BIT_START,
STATE_TRAILER, STATE_BIT_END,
}; STATE_FINISHED,
struct rc5_code {
u8 address;
u8 command;
}; };
struct decoder_data { struct decoder_data {
...@@ -49,8 +42,9 @@ struct decoder_data { ...@@ -49,8 +42,9 @@ struct decoder_data {
/* State machine control */ /* State machine control */
enum rc5_state state; enum rc5_state state;
struct rc5_code rc5_code; u32 rc5_bits;
unsigned code, elapsed, last_bit, last_code; int last_unit;
unsigned count;
}; };
...@@ -122,18 +116,19 @@ static struct attribute_group decoder_attribute_group = { ...@@ -122,18 +116,19 @@ static struct attribute_group decoder_attribute_group = {
}; };
/** /**
* handle_event() - Decode one RC-5 pulse or space * ir_rc5_decode() - Decode one RC-5 pulse or space
* @input_dev: the struct input_dev descriptor of the device * @input_dev: the struct input_dev descriptor of the device
* @ev: event array with type/duration of pulse/space * @duration: duration of pulse/space in ns
* *
* This function returns -EINVAL if the pulse violates the state machine * This function returns -EINVAL if the pulse violates the state machine
*/ */
static int ir_rc5_decode(struct input_dev *input_dev, static int ir_rc5_decode(struct input_dev *input_dev, s64 duration)
struct ir_raw_event *ev)
{ {
struct decoder_data *data; struct decoder_data *data;
struct ir_input_dev *ir_dev = input_get_drvdata(input_dev); struct ir_input_dev *ir_dev = input_get_drvdata(input_dev);
int is_pulse, scancode, delta, toggle; u8 command, system, toggle;
u32 scancode;
int u;
data = get_decoder_data(ir_dev); data = get_decoder_data(ir_dev);
if (!data) if (!data)
...@@ -142,79 +137,84 @@ static int ir_rc5_decode(struct input_dev *input_dev, ...@@ -142,79 +137,84 @@ static int ir_rc5_decode(struct input_dev *input_dev,
if (!data->enabled) if (!data->enabled)
return 0; return 0;
delta = DIV_ROUND_CLOSEST(ev->delta.tv_nsec, ir_rc5_remote_gap); if (IS_RESET(duration)) {
/* The duration time refers to the last bit time */
is_pulse = (ev->type & IR_PULSE) ? 1 : 0;
/* Very long delays are considered as start events */
if (delta > RC5_DURATION || (ev->type & IR_START_EVENT))
data->state = STATE_INACTIVE; data->state = STATE_INACTIVE;
switch (data->state) {
case STATE_INACTIVE:
IR_dprintk(2, "currently inative. Start bit (%s) @%uus\n",
is_pulse ? "pulse" : "space",
(unsigned)(ev->delta.tv_nsec + 500) / 1000);
/* Discards the initial start space */
if (!is_pulse)
goto err;
data->code = 1;
data->last_bit = 1;
data->elapsed = 0;
memset(&data->rc5_code, 0, sizeof(data->rc5_code));
data->state = STATE_MARKSPACE;
return 0; return 0;
case STATE_MARKSPACE: }
if (delta != 1)
data->last_bit = data->last_bit ? 0 : 1;
data->elapsed += delta; u = TO_UNITS(duration, RC5_UNIT);
if (DURATION(u) == 0)
goto out;
if ((data->elapsed % 2) == 1) again:
return 0; IR_dprintk(2, "RC5 decode started at state %i (%i units, %ius)\n",
data->state, u, TO_US(duration));
data->code <<= 1; if (DURATION(u) == 0 && data->state != STATE_FINISHED)
data->code |= data->last_bit; return 0;
/* Fill the 2 unused bits at the command with 0 */
if (data->elapsed / 2 == 6)
data->code <<= 2;
if (data->elapsed >= (RC5_NBITS - 1) * 2) { switch (data->state) {
scancode = data->code;
/* Check for the start bits */ case STATE_INACTIVE:
if ((scancode & 0xc000) != 0xc000) { if (IS_PULSE(u)) {
IR_dprintk(1, "Code 0x%04x doesn't have two start bits. It is not RC-5\n", scancode); data->state = STATE_BIT_START;
goto err; data->count = 1;
DECREASE_DURATION(u, 1);
goto again;
}
break;
case STATE_BIT_START:
if (DURATION(u) == 1) {
data->rc5_bits <<= 1;
if (IS_SPACE(u))
data->rc5_bits |= 1;
data->count++;
data->last_unit = u;
/*
* If the last bit is zero, a space will merge
* with the silence after the command.
*/
if (IS_PULSE(u) && data->count == RC5_NBITS) {
data->state = STATE_FINISHED;
goto again;
} }
toggle = (scancode & 0x2000) ? 1 : 0; data->state = STATE_BIT_END;
return 0;
}
break;
if (scancode == data->last_code) { case STATE_BIT_END:
IR_dprintk(1, "RC-5 repeat\n"); if (IS_TRANSITION(u, data->last_unit)) {
ir_repeat(input_dev); if (data->count == RC5_NBITS)
} else { data->state = STATE_FINISHED;
data->last_code = scancode; else
scancode &= 0x1fff; data->state = STATE_BIT_START;
IR_dprintk(1, "RC-5 scancode 0x%04x\n", scancode);
ir_keydown(input_dev, scancode, 0); DECREASE_DURATION(u, 1);
} goto again;
data->state = STATE_TRAILER;
} }
return 0; break;
case STATE_TRAILER:
case STATE_FINISHED:
command = (data->rc5_bits & 0x0003F) >> 0;
system = (data->rc5_bits & 0x007C0) >> 6;
toggle = (data->rc5_bits & 0x00800) ? 1 : 0;
command += (data->rc5_bits & 0x01000) ? 0 : 0x40;
scancode = system << 8 | command;
IR_dprintk(1, "RC5 scancode 0x%04x (toggle: %u)\n",
scancode, toggle);
ir_keydown(input_dev, scancode, toggle);
data->state = STATE_INACTIVE; data->state = STATE_INACTIVE;
return 0; return 0;
} }
err: out:
IR_dprintk(1, "RC-5 decoded failed at %s @ %luus\n", IR_dprintk(1, "RC5 decode failed at state %i (%i units, %ius)\n",
is_pulse ? "pulse" : "space", data->state, u, TO_US(duration));
(ev->delta.tv_nsec + 500) / 1000);
data->state = STATE_INACTIVE; data->state = STATE_INACTIVE;
return -EINVAL; return -EINVAL;
} }
......
...@@ -1018,7 +1018,7 @@ static int saa7134_raw_decode_irq(struct saa7134_dev *dev) ...@@ -1018,7 +1018,7 @@ static int saa7134_raw_decode_irq(struct saa7134_dev *dev)
saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN); saa_clearb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN); saa_setb(SAA7134_GPIO_GPMODE3, SAA7134_GPIO_GPRESCAN);
space = saa_readl(SAA7134_GPIO_GPSTATUS0 >> 2) & ir->mask_keydown; space = saa_readl(SAA7134_GPIO_GPSTATUS0 >> 2) & ir->mask_keydown;
ir_raw_event_store(dev->remote->dev, space ? IR_SPACE : IR_PULSE); ir_raw_event_store_edge(dev->remote->dev, space ? IR_SPACE : IR_PULSE);
/* /*
......
...@@ -65,14 +65,12 @@ struct ir_dev_props { ...@@ -65,14 +65,12 @@ struct ir_dev_props {
void (*close)(void *priv); void (*close)(void *priv);
}; };
struct ir_raw_event {
struct timespec delta; /* Time spent before event */
enum raw_event_type type; /* event type */
};
struct ir_raw_event_ctrl { struct ir_raw_event_ctrl {
struct kfifo kfifo; /* fifo for the pulse/space events */ struct work_struct rx_work; /* for the rx decoding workqueue */
struct timespec last_event; /* when last event occurred */ struct kfifo kfifo; /* fifo for the pulse/space durations */
ktime_t last_event; /* when last event occurred */
enum raw_event_type last_type; /* last event type */
struct input_dev *input_dev; /* pointer to the parent input_dev */
}; };
struct ir_input_dev { struct ir_input_dev {
...@@ -97,8 +95,7 @@ struct ir_input_dev { ...@@ -97,8 +95,7 @@ struct ir_input_dev {
struct ir_raw_handler { struct ir_raw_handler {
struct list_head list; struct list_head list;
int (*decode)(struct input_dev *input_dev, int (*decode)(struct input_dev *input_dev, s64 duration);
struct ir_raw_event *ev);
int (*raw_register)(struct input_dev *input_dev); int (*raw_register)(struct input_dev *input_dev);
int (*raw_unregister)(struct input_dev *input_dev); int (*raw_unregister)(struct input_dev *input_dev);
}; };
...@@ -154,8 +151,14 @@ void ir_unregister_class(struct input_dev *input_dev); ...@@ -154,8 +151,14 @@ void ir_unregister_class(struct input_dev *input_dev);
/* Routines from ir-raw-event.c */ /* Routines from ir-raw-event.c */
int ir_raw_event_register(struct input_dev *input_dev); int ir_raw_event_register(struct input_dev *input_dev);
void ir_raw_event_unregister(struct input_dev *input_dev); void ir_raw_event_unregister(struct input_dev *input_dev);
int ir_raw_event_store(struct input_dev *input_dev, enum raw_event_type type); void ir_raw_event_handle(struct input_dev *input_dev);
int ir_raw_event_handle(struct input_dev *input_dev); int ir_raw_event_store(struct input_dev *input_dev, s64 duration);
int ir_raw_event_store_edge(struct input_dev *input_dev, enum raw_event_type type);
static inline void ir_raw_event_reset(struct input_dev *input_dev)
{
ir_raw_event_store(input_dev, 0);
ir_raw_event_handle(input_dev);
}
int ir_raw_handler_register(struct ir_raw_handler *ir_raw_handler); int ir_raw_handler_register(struct ir_raw_handler *ir_raw_handler);
void ir_raw_handler_unregister(struct ir_raw_handler *ir_raw_handler); void ir_raw_handler_unregister(struct ir_raw_handler *ir_raw_handler);
void ir_raw_init(void); void ir_raw_init(void);
...@@ -174,4 +177,26 @@ void ir_raw_init(void); ...@@ -174,4 +177,26 @@ void ir_raw_init(void);
#define load_rc5_decode() 0 #define load_rc5_decode() 0
#endif #endif
/* macros for ir decoders */
#define PULSE(units) ((units))
#define SPACE(units) (-(units))
#define IS_RESET(duration) ((duration) == 0)
#define IS_PULSE(duration) ((duration) > 0)
#define IS_SPACE(duration) ((duration) < 0)
#define DURATION(duration) (abs((duration)))
#define IS_TRANSITION(x, y) ((x) * (y) < 0)
#define DECREASE_DURATION(duration, amount) \
do { \
if (IS_SPACE(duration)) \
duration += (amount); \
else if (IS_PULSE(duration)) \
duration -= (amount); \
} while (0)
#define TO_UNITS(duration, unit_len) \
((int)((duration) > 0 ? \
DIV_ROUND_CLOSEST(abs((duration)), (unit_len)) :\
-DIV_ROUND_CLOSEST(abs((duration)), (unit_len))))
#define TO_US(duration) ((int)TO_UNITS(duration, 1000))
#endif /* _IR_CORE */ #endif /* _IR_CORE */
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