445 lines
10 KiB
C
445 lines
10 KiB
C
/*
|
|
* 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);
|
|
}
|
|
|
|
static inline void soutp(int offset, int value)
|
|
{
|
|
outb(value, io + offset);
|
|
}
|
|
|
|
/* 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;
|
|
}
|
|
|
|
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);
|
|
}
|
|
|
|
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);
|
|
}
|
|
|
|
/* 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);
|
|
}
|
|
|
|
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);
|
|
}
|
|
|
|
static void send_space(unsigned long len)
|
|
{
|
|
usleep_range(len, len + 25);
|
|
}
|
|
|
|
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))
|
|
;
|
|
}
|
|
}
|
|
|
|
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;
|
|
}
|
|
|
|
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);
|
|
}
|
|
|
|
/* 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;
|
|
}
|
|
|
|
static void drop_port(void)
|
|
{
|
|
free_irq(irq, NULL);
|
|
del_timer_sync(&timerlist);
|
|
release_region(io, 8);
|
|
}
|
|
|
|
static int init_sir_ir(void)
|
|
{
|
|
int retval;
|
|
|
|
retval = init_port();
|
|
if (retval < 0)
|
|
return retval;
|
|
init_hardware();
|
|
return 0;
|
|
}
|
|
|
|
static int sir_ir_probe(struct platform_device *dev)
|
|
{
|
|
int retval;
|
|
|
|
retval = init_chrdev();
|
|
if (retval < 0)
|
|
return retval;
|
|
|
|
return init_sir_ir();
|
|
}
|
|
|
|
static int sir_ir_remove(struct platform_device *dev)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
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;
|
|
}
|
|
|
|
static void __exit sir_ir_exit(void)
|
|
{
|
|
drop_hardware();
|
|
drop_port();
|
|
platform_device_unregister(sir_ir_dev);
|
|
platform_driver_unregister(&sir_ir_driver);
|
|
}
|
|
|
|
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)");
|