/* ir-raw-event.c - handle IR Pulse/Space event * * Copyright (C) 2010 by Mauro Carvalho Chehab * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation version 2 of the License. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. */ #include #include #include /* Define the max number of bit transitions per IR keycode */ #define MAX_IR_EVENT_SIZE 256 /* Used to handle IR raw handler extensions */ static LIST_HEAD(ir_raw_handler_list); static spinlock_t ir_raw_handler_lock; /** * RUN_DECODER() - runs an operation on all IR decoders * @ops: IR raw handler operation to be called * @arg: arguments to be passed to the callback * * Calls ir_raw_handler::ops for all registered IR handlers. It prevents * new decode addition/removal while running, by locking ir_raw_handler_lock * mutex. If an error occurs, it stops the ops. Otherwise, it returns a sum * of the return codes. */ #define RUN_DECODER(ops, ...) ({ \ struct ir_raw_handler *_ir_raw_handler; \ int _sumrc = 0, _rc; \ spin_lock(&ir_raw_handler_lock); \ list_for_each_entry(_ir_raw_handler, &ir_raw_handler_list, list) { \ if (_ir_raw_handler->ops) { \ _rc = _ir_raw_handler->ops(__VA_ARGS__); \ if (_rc < 0) \ break; \ _sumrc += _rc; \ } \ } \ spin_unlock(&ir_raw_handler_lock); \ _sumrc; \ }) /* Used to load the decoders */ static struct work_struct wq_load; int ir_raw_event_register(struct input_dev *input_dev) { struct ir_input_dev *ir = input_get_drvdata(input_dev); int rc, size; ir->raw = kzalloc(sizeof(*ir->raw), GFP_KERNEL); if (!ir->raw) return -ENOMEM; size = sizeof(struct ir_raw_event) * MAX_IR_EVENT_SIZE * 2; size = roundup_pow_of_two(size); rc = kfifo_alloc(&ir->raw->kfifo, size, GFP_KERNEL); if (rc < 0) { kfree(ir->raw); ir->raw = NULL; return rc; } rc = RUN_DECODER(raw_register, input_dev); if (rc < 0) { kfifo_free(&ir->raw->kfifo); kfree(ir->raw); ir->raw = NULL; return rc; } return rc; } EXPORT_SYMBOL_GPL(ir_raw_event_register); void ir_raw_event_unregister(struct input_dev *input_dev) { struct ir_input_dev *ir = input_get_drvdata(input_dev); if (!ir->raw) return; RUN_DECODER(raw_unregister, input_dev); kfifo_free(&ir->raw->kfifo); kfree(ir->raw); ir->raw = NULL; } EXPORT_SYMBOL_GPL(ir_raw_event_unregister); int ir_raw_event_store(struct input_dev *input_dev, enum raw_event_type type) { struct ir_input_dev *ir = input_get_drvdata(input_dev); struct timespec ts; struct ir_raw_event event; int rc; if (!ir->raw) return -EINVAL; event.type = type; event.delta.tv_sec = 0; event.delta.tv_nsec = 0; ktime_get_ts(&ts); if (timespec_equal(&ir->raw->last_event, &event.delta)) event.type |= IR_START_EVENT; else event.delta = timespec_sub(ts, ir->raw->last_event); memcpy(&ir->raw->last_event, &ts, sizeof(ts)); if (event.delta.tv_sec) { event.type |= IR_START_EVENT; event.delta.tv_sec = 0; event.delta.tv_nsec = 0; } kfifo_in(&ir->raw->kfifo, &event, sizeof(event)); return rc; } EXPORT_SYMBOL_GPL(ir_raw_event_store); int ir_raw_event_handle(struct input_dev *input_dev) { struct ir_input_dev *ir = input_get_drvdata(input_dev); int rc; struct ir_raw_event *evs; 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(*evs); if (!len) return 0; evs = kmalloc(len * sizeof(*evs), GFP_ATOMIC); for (i = 0; i < len; i++) { rc = kfifo_out(&ir->raw->kfifo, &evs[i], sizeof(*evs)); if (rc != sizeof(*evs)) { IR_dprintk(1, "overflow error: received %d instead of %zd\n", rc, sizeof(*evs)); return -EINVAL; } IR_dprintk(2, "event type %d, time before event: %07luus\n", evs[i].type, (evs[i].delta.tv_nsec + 500) / 1000); } /* * Call all ir decoders. This allows decoding the same event with * more than one protocol handler. It returns the number of keystrokes * sent to the event interface */ rc = RUN_DECODER(decode, input_dev, evs, len); kfree(evs); return rc; } EXPORT_SYMBOL_GPL(ir_raw_event_handle); /* * Extension interface - used to register the IR decoders */ int ir_raw_handler_register(struct ir_raw_handler *ir_raw_handler) { spin_lock(&ir_raw_handler_lock); list_add_tail(&ir_raw_handler->list, &ir_raw_handler_list); spin_unlock(&ir_raw_handler_lock); return 0; } EXPORT_SYMBOL(ir_raw_handler_register); void ir_raw_handler_unregister(struct ir_raw_handler *ir_raw_handler) { spin_lock(&ir_raw_handler_lock); list_del(&ir_raw_handler->list); spin_unlock(&ir_raw_handler_lock); } EXPORT_SYMBOL(ir_raw_handler_unregister); static void init_decoders(struct work_struct *work) { /* Load the decoder modules */ load_nec_decode(); load_rc5_decode(); /* If needed, we may later add some init code. In this case, it is needed to change the CONFIG_MODULE test at ir-core.h */ } void ir_raw_init(void) { spin_lock_init(&ir_raw_handler_lock); #ifdef MODULE INIT_WORK(&wq_load, init_decoders); schedule_work(&wq_load); #endif }