kernel2.6.32.2 mini2440 led 驱动 之 中断（去抖动）处理

#include linux/module.h #include linux/init.h #include linux/mm.h #include linux/slab.h #include linux/types.h #include linux/semaphore.h #include linux/cdev.h #include linux/fs.h #include linux/semaphore.h #include linux/irq.h #include asm

#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include

#include
#include
#include

#define LED_MAJOR 250
#define LED_NAME “leds”

#define KEY_COUNT 4
#define KEY_DELAY HZ/50

DECLARE_WAIT_QUEUE_HEAD(r_wait); ／／初始化等待队列
//wait_queue_head_t r_wait;
//init_waitqueue_head(&r_wait);
static struct timer_list key_timers[KEY_COUNT]; ／／定义定时器
static volatile bool idetify;

static void buttons_timer(unsigned long);

static unsigned long led_table [] = {
S3C2410_GPB(5),
S3C2410_GPB(6),
S3C2410_GPB(7),
S3C2410_GPB(8),
};／／位地址

static unsigned int led_cfg_table [] = {
S3C2410_GPIO_OUTPUT,
S3C2410_GPIO_OUTPUT,
S3C2410_GPIO_OUTPUT,
S3C2410_GPIO_OUTPUT,
};／／控制led为输入

struct button_irq_key{
int irq;
int pin;
unsigned long flags;
char *name;
};

static struct button_irq_key button_irqs[] = {
{IRQ_EINT8, S3C2410_GPG(0), IRQF_TRIGGER_FALLING, “key1”},
{IRQ_EINT11, S3C2410_GPG(3), IRQF_TRIGGER_FALLING, “key2”},
{IRQ_EINT13, S本文来源gao@!dai!ma.com搞$$代^@码5网@3C2410_GPG(5), IRQF_TRIGGER_FALLING, “key3”},
{IRQ_EINT14, S3C2410_GPG(6), IRQF_TRIGGER_FALLING, “key4”},
};

static volatile int press_cnt[] = {0, 0, 0, 0};
static volatile int pressed = 0;

struct leds_cdev
{
struct cdev cdev;
struct semaphore sem;
};

int leds_major = LED_MAJOR;
struct leds_cdev dev;

static irqreturn_t buttons_interrupt(int irq, void *dev_id)／／按键中断处理函数
{
// volatile int *press_count = (volatile int*)dev_id;

//disable_irq(irq);
int key = 0;

switch(irq){
case 52:
key = 0;
break;
case 55:
key = 1;
break;
case 57:
key = 2;
break;
case 58:
key = 3;
break;
default:break;

}

key_timers[key].data = key;
mod_timer(&key_timers[key], jiffies + KEY_DELAY);
printk(KERN_EMERG “irq success”);
return IRQ_HANDLED;
}

static void buttons_timer(unsigned long arg)／／定时器中断处理函数，去抖实现
{
int key = arg;
int condition;
int nf;
condition = s3c2410_gpio_getpin(button_irqs[key].pin);
if(!condition)
{
while(!s3c2410_gpio_getpin(button_irqs[key].pin));

key_timers[key].expires = jiffies + KEY_DELAY;
add_timer(&key_timers[key]);
idetify = 1;

printk(KERN_EMERG “lower is appear”);
}else{

if(!idetify)
return;

press_cnt[key] += 1;
nf = press_cnt[key]%2;
s3c2410_gpio_setpin(led_table[key], nf);

pressed = 1;
wake_up_interruptible(&r_wait);
idetify = 0;

printk(KERN_EMERG “up is appear%d”, nf);
// enable_irq(button_irqs[key].irq);
}

// printk(KERN_EMERG “success of interruptible”);
}

static int led_buttons_open(struct inode *inode, struct file *filp)
{
int i;
int err;
for(i = 0; i < sizeof(button_irqs)/sizeof(button_irqs[0]); i++){
err = request_irq(button_irqs[i].irq, buttons_interrupt,
button_irqs[i].flags, button_irqs[i].name, (void*)&press_cnt[i]); ／／请求中断
if(err)
break;
/* init_timer(&key_timers[i]);
key_timers[i].data = i;
key_timers[i].function = buttons_timer;
*/
setup_timer(&key_timers[i], buttons_timer, i);初始化定时器
}
//key_timers[0].expires = jiffies + 3 * HZ;
//add_timer(&key_timers[0]);
if(err){
i–;
for(; i >= 0; i–)
free_irq(button_irqs[i].irq, (void *)press_cnt[i]);
return -EBUSY;
}

return 0;
}

static ssize_t led_buttons_read(struct file *filp, char __user *buf, size_t count, loff_t *ppos)
{
unsigned long err;
wait_event_interruptible(r_wait, pressed);

pressed = 0;

err = copy_to_user(buf, (const void *)press_cnt, sizeof(press_cnt));
memset((void *)press_cnt, 0, sizeof(press_cnt));
return err ? -EFAULT : 0 ;
}

static int led_buttons_close(struct inode *inode, struct file *filp)
{
int i;
for(i = 0; i < sizeof(button_irqs)/sizeof(button_irqs[0]); i++){
free_irq(button_irqs[i].irq, (void*)&press_cnt[i]);／／释放中断号
del_timer(&key_timers[i]);
}
return 0;
}

static int leds_ioctl(struct inode *inode, struct file *filp, unsigned int cmd, unsigned long arg)
{
switch(cmd)
{
case 0:
if(arg > 4){
return -EINVAL;
}
down(&dev.sem);
s3c2410_gpio_setpin(led_table[arg], 0);
up(&dev.sem);
return 0;
case 1:
if(arg > 4){
return -EINVAL;
}
down(&dev.sem);
s3c2410_gpio_setpin(led_table[arg], 1);
up(&dev.sem);
return 0;
default:
return -EINVAL;
}
}

struct file_operations cdev_fops = {
.owner = THIS_MODULE,
.ioctl = leds_ioctl,
.open = led_buttons_open,
.read = led_buttons_read,
.release = led_buttons_close,
};

static void leds_setup(struct leds_cdev *dev, int index)
{
int err, devno = MKDEV(leds_major, index);
cdev_init(&dev->cdev, &cdev_fops);
dev->cdev.owner = THIS_MODULE;
dev->cdev.ops = &cdev_fops;
err = cdev_add(&dev->cdev, devno, 1);
if(err)
printk(KERN_NOTICE “Error %d adding LED %d\n”, err, index);
}

喜欢 (0)赏

[搞代码]

分享 (0)