cregit-Linux how code gets into the kernel

Release 4.12 drivers/media/rc/sir_ir.c

Directory: drivers/media/rc
/*
 * IR SIR driver, (C) 2000 Milan Pikula <www@fornax.sk>
 *
 * sir_ir - Device driver for use with SIR (serial infra red)
 * mode of IrDA on many notebooks.
 *
 *  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; either version 2 of the License, or
 *  (at your option) any later version.
 */


#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include <linux/module.h>
#include <linux/interrupt.h>
#include <linux/kernel.h>
#include <linux/serial_reg.h>
#include <linux/ktime.h>
#include <linux/delay.h>
#include <linux/platform_device.h>

#include <media/rc-core.h>

/* SECTION: Definitions */

#define PULSE '['

/* 9bit * 1s/115200bit in milli seconds = 78.125ms*/

#define TIME_CONST (9000000ul / 115200ul)

/* timeout for sequences in jiffies (=5/100s), must be longer than TIME_CONST */

#define SIR_TIMEOUT	(HZ * 5 / 100)

/* onboard sir ports are typically com3 */

static int io = 0x3e8;

static int irq = 4;

static int threshold = 3;

static DEFINE_SPINLOCK(timer_lock);

static struct timer_list timerlist;
/* time of last signal change detected */

static ktime_t last;
/* time of last UART data ready interrupt */

static ktime_t last_intr_time;

static int last_value;

static struct rc_dev *rcdev;


static struct platform_device *sir_ir_dev;

static DEFINE_SPINLOCK(hardware_lock);

/* SECTION: Prototypes */

/* Communication with user-space */
static void add_read_queue(int flag, unsigned long val);
static int init_chrdev(void);
/* Hardware */
static irqreturn_t sir_interrupt(int irq, void *dev_id);
static void send_space(unsigned long len);
static void send_pulse(unsigned long len);
static int init_hardware(void);
static void drop_hardware(void);
/* Initialisation */
static int init_port(void);
static void drop_port(void);


static inline unsigned int sinp(int offset) { return inb(io + offset); }

Contributors

PersonTokensPropCommitsCommitProp
Jarod Wilson19100.00%1100.00%
Total19100.00%1100.00%


static inline void soutp(int offset, int value) { outb(value, io + offset); }

Contributors

PersonTokensPropCommitsCommitProp
Jarod Wilson22100.00%1100.00%
Total22100.00%1100.00%

/* SECTION: Communication with user-space */
static int sir_tx_ir(struct rc_dev *dev, unsigned int *tx_buf, unsigned int count) { unsigned long flags; int i; local_irq_save(flags); for (i = 0; i < count;) { if (tx_buf[i]) send_pulse(tx_buf[i]); i++; if (i >= count) break; if (tx_buf[i]) send_space(tx_buf[i]); i++; } local_irq_restore(flags); return count; }

Contributors

PersonTokensPropCommitsCommitProp
Sean Young6163.54%150.00%
Jarod Wilson3536.46%150.00%
Total96100.00%2100.00%


static void add_read_queue(int flag, unsigned long val) { DEFINE_IR_RAW_EVENT(ev); pr_debug("add flag %d with val %lu\n", flag, val); /* * statistically, pulses are ~TIME_CONST/2 too long. we could * maybe make this more exact, but this is good enough */ if (flag) { /* pulse */ if (val > TIME_CONST / 2) val -= TIME_CONST / 2; else /* should not ever happen */ val = 1; ev.pulse = true; } else { val += TIME_CONST / 2; } ev.duration = US_TO_NS(val); ir_raw_event_store_with_filter(rcdev, &ev); }

Contributors

PersonTokensPropCommitsCommitProp
Jarod Wilson6170.11%133.33%
Sean Young2528.74%133.33%
Aya Mahfouz11.15%133.33%
Total87100.00%3100.00%


static int init_chrdev(void) { rcdev = devm_rc_allocate_device(&sir_ir_dev->dev, RC_DRIVER_IR_RAW); if (!rcdev) return -ENOMEM; rcdev->input_name = "SIR IrDA port"; rcdev->input_phys = KBUILD_MODNAME "/input0"; rcdev->input_id.bustype = BUS_HOST; rcdev->input_id.vendor = 0x0001; rcdev->input_id.product = 0x0001; rcdev->input_id.version = 0x0100; rcdev->tx_ir = sir_tx_ir; rcdev->allowed_protocols = RC_BIT_ALL_IR_DECODER; rcdev->driver_name = KBUILD_MODNAME; rcdev->map_name = RC_MAP_RC6_MCE; rcdev->timeout = IR_DEFAULT_TIMEOUT; rcdev->dev.parent = &sir_ir_dev->dev; return devm_rc_register_device(&sir_ir_dev->dev, rcdev); }

Contributors

PersonTokensPropCommitsCommitProp
Sean Young9373.81%250.00%
Jarod Wilson3326.19%250.00%
Total126100.00%4100.00%

/* SECTION: Hardware */
static void sir_timeout(unsigned long data) { /* * if last received signal was a pulse, but receiving stopped * within the 9 bit frame, we need to finish this pulse and * simulate a signal change to from pulse to space. Otherwise * upper layers will receive two sequences next time. */ unsigned long flags; unsigned long pulse_end; /* avoid interference with interrupt */ spin_lock_irqsave(&timer_lock, flags); if (last_value) { /* clear unread bits in UART and restart */ outb(UART_FCR_CLEAR_RCVR, io + UART_FCR); /* determine 'virtual' pulse end: */ pulse_end = min_t(unsigned long, ktime_us_delta(last, last_intr_time), IR_MAX_DURATION); dev_dbg(&sir_ir_dev->dev, "timeout add %d for %lu usec\n", last_value, pulse_end); add_read_queue(last_value, pulse_end); last_value = 0; last = last_intr_time; } spin_unlock_irqrestore(&timer_lock, flags); ir_raw_event_handle(rcdev); }

Contributors

PersonTokensPropCommitsCommitProp
Jarod Wilson8081.63%125.00%
Sean Young99.18%125.00%
Ksenija Stanojevic66.12%125.00%
Aya Mahfouz33.06%125.00%
Total98100.00%4100.00%


static irqreturn_t sir_interrupt(int irq, void *dev_id) { unsigned char data; ktime_t curr_time; static unsigned long delt; unsigned long deltintr; unsigned long flags; int counter = 0; int iir, lsr; while ((iir = inb(io + UART_IIR) & UART_IIR_ID)) { if (++counter > 256) { dev_err(&sir_ir_dev->dev, "Trapped in interrupt"); break; } switch (iir & UART_IIR_ID) { /* FIXME toto treba preriedit */ case UART_IIR_MSI: (void)inb(io + UART_MSR); break; case UART_IIR_RLSI: case UART_IIR_THRI: (void)inb(io + UART_LSR); break; case UART_IIR_RDI: /* avoid interference with timer */ spin_lock_irqsave(&timer_lock, flags); do { del_timer(&timerlist); data = inb(io + UART_RX); curr_time = ktime_get(); delt = min_t(unsigned long, ktime_us_delta(last, curr_time), IR_MAX_DURATION); deltintr = min_t(unsigned long, ktime_us_delta(last_intr_time, curr_time), IR_MAX_DURATION); dev_dbg(&sir_ir_dev->dev, "t %lu, d %d\n", deltintr, (int)data); /* * if nothing came in last X cycles, * it was gap */ if (deltintr > TIME_CONST * threshold) { if (last_value) { dev_dbg(&sir_ir_dev->dev, "GAP\n"); /* simulate signal change */ add_read_queue(last_value, delt - deltintr); last_value = 0; last = last_intr_time; delt = deltintr; } } data = 1; if (data ^ last_value) { /* * deltintr > 2*TIME_CONST, remember? * the other case is timeout */ add_read_queue(last_value, delt - TIME_CONST); last_value = data; last = curr_time; last = ktime_sub_us(last, TIME_CONST); } last_intr_time = curr_time; if (data) { /* * start timer for end of * sequence detection */ timerlist.expires = jiffies + SIR_TIMEOUT; add_timer(&timerlist); } lsr = inb(io + UART_LSR); } while (lsr & UART_LSR_DR); /* data ready */ spin_unlock_irqrestore(&timer_lock, flags); break; default: break; } } ir_raw_event_handle(rcdev); return IRQ_RETVAL(IRQ_HANDLED); }

Contributors

PersonTokensPropCommitsCommitProp
Jarod Wilson26075.14%116.67%
Sean Young4111.85%350.00%
Ksenija Stanojevic3911.27%116.67%
Aya Mahfouz61.73%116.67%
Total346100.00%6100.00%


static void send_space(unsigned long len) { usleep_range(len, len + 25); }

Contributors

PersonTokensPropCommitsCommitProp
Jarod Wilson1473.68%150.00%
Sean Young526.32%150.00%
Total19100.00%2100.00%


static void send_pulse(unsigned long len) { long bytes_out = len / TIME_CONST; if (bytes_out == 0) bytes_out++; while (bytes_out--) { outb(PULSE, io + UART_TX); /* FIXME treba seriozne cakanie z char/serial.c */ while (!(inb(io + UART_LSR) & UART_LSR_THRE)) ; } }

Contributors

PersonTokensPropCommitsCommitProp
Arnd Bergmann3153.45%150.00%
Jarod Wilson2746.55%150.00%
Total58100.00%2100.00%


static int init_hardware(void) { unsigned long flags; spin_lock_irqsave(&hardware_lock, flags); /* reset UART */ outb(0, io + UART_MCR); outb(0, io + UART_IER); /* init UART */ /* set DLAB, speed = 115200 */ outb(UART_LCR_DLAB | UART_LCR_WLEN7, io + UART_LCR); outb(1, io + UART_DLL); outb(0, io + UART_DLM); /* 7N1+start = 9 bits at 115200 ~ 3 bits at 44000 */ outb(UART_LCR_WLEN7, io + UART_LCR); /* FIFO operation */ outb(UART_FCR_ENABLE_FIFO, io + UART_FCR); /* interrupts */ /* outb(UART_IER_RLSI|UART_IER_RDI|UART_IER_THRI, io + UART_IER); */ outb(UART_IER_RDI, io + UART_IER); /* turn on UART */ outb(UART_MCR_DTR | UART_MCR_RTS | UART_MCR_OUT2, io + UART_MCR); spin_unlock_irqrestore(&hardware_lock, flags); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Jarod Wilson8466.67%150.00%
Sean Young4233.33%150.00%
Total126100.00%2100.00%


static void drop_hardware(void) { unsigned long flags; spin_lock_irqsave(&hardware_lock, flags); /* turn off interrupts */ outb(0, io + UART_IER); spin_unlock_irqrestore(&hardware_lock, flags); }

Contributors

PersonTokensPropCommitsCommitProp
Jarod Wilson2976.32%150.00%
Sean Young923.68%150.00%
Total38100.00%2100.00%

/* SECTION: Initialisation */
static int init_port(void) { int retval; setup_timer(&timerlist, sir_timeout, 0); /* get I/O port access and IRQ line */ if (!request_region(io, 8, KBUILD_MODNAME)) { pr_err("i/o port 0x%.4x already in use.\n", io); return -EBUSY; } retval = request_irq(irq, sir_interrupt, 0, KBUILD_MODNAME, NULL); if (retval < 0) { release_region(io, 8); pr_err("IRQ %d already in use.\n", irq); return retval; } pr_info("I/O port 0x%.4x, IRQ %d.\n", io, irq); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Sean Young6464.65%266.67%
Jarod Wilson3535.35%133.33%
Total99100.00%3100.00%


static void drop_port(void) { free_irq(irq, NULL); del_timer_sync(&timerlist); release_region(io, 8); }

Contributors

PersonTokensPropCommitsCommitProp
Sean Young1657.14%150.00%
Jarod Wilson1242.86%150.00%
Total28100.00%2100.00%


static int init_sir_ir(void) { int retval; retval = init_port(); if (retval < 0) return retval; init_hardware(); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Jarod Wilson3096.77%150.00%
Sean Young13.23%150.00%
Total31100.00%2100.00%


static int sir_ir_probe(struct platform_device *dev) { int retval; retval = init_chrdev(); if (retval < 0) return retval; return init_sir_ir(); }

Contributors

PersonTokensPropCommitsCommitProp
Sean Young2062.50%266.67%
Jarod Wilson1237.50%133.33%
Total32100.00%3100.00%


static int sir_ir_remove(struct platform_device *dev) { return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Jarod Wilson1392.86%150.00%
Sean Young17.14%150.00%
Total14100.00%2100.00%

static struct platform_driver sir_ir_driver = { .probe = sir_ir_probe, .remove = sir_ir_remove, .driver = { .name = "sir_ir", }, };
static int __init sir_ir_init(void) { int retval; retval = platform_driver_register(&sir_ir_driver); if (retval) return retval; sir_ir_dev = platform_device_alloc("sir_ir", 0); if (!sir_ir_dev) { retval = -ENOMEM; goto pdev_alloc_fail; } retval = platform_device_add(sir_ir_dev); if (retval) goto pdev_add_fail; return 0; pdev_add_fail: platform_device_put(sir_ir_dev); pdev_alloc_fail: platform_driver_unregister(&sir_ir_driver); return retval; }

Contributors

PersonTokensPropCommitsCommitProp
Jarod Wilson7789.53%250.00%
Sean Young910.47%250.00%
Total86100.00%4100.00%


static void __exit sir_ir_exit(void) { drop_hardware(); drop_port(); platform_device_unregister(sir_ir_dev); platform_driver_unregister(&sir_ir_driver); }

Contributors

PersonTokensPropCommitsCommitProp
Jarod Wilson2388.46%266.67%
Sean Young311.54%133.33%
Total26100.00%3100.00%

module_init(sir_ir_init); module_exit(sir_ir_exit); MODULE_DESCRIPTION("Infrared receiver driver for SIR type serial ports"); MODULE_AUTHOR("Milan Pikula"); MODULE_LICENSE("GPL"); module_param(io, int, 0444); MODULE_PARM_DESC(io, "I/O address base (0x3f8 or 0x2f8)"); module_param(irq, int, 0444); MODULE_PARM_DESC(irq, "Interrupt (4 or 3)"); module_param(threshold, int, 0444); MODULE_PARM_DESC(threshold, "space detection threshold (3)");

Overall Contributors

PersonTokensPropCommitsCommitProp
Jarod Wilson112068.13%213.33%
Sean Young42325.73%853.33%
Ksenija Stanojevic503.04%16.67%
Arnd Bergmann311.89%16.67%
Aya Mahfouz100.61%16.67%
Toshiaki Yamane70.43%16.67%
Derek Robson30.18%16.67%
Total1644100.00%15100.00%
Directory: drivers/media/rc
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.