第三个驱动-tq2440

#include <linux/module.h>
#include <linux/kernel.h>
#include<linux/fs.h>
#include <linux/init.h>
#include <linux/irqreturn.h>
#include <linux/interrupt.h>

#include <linux/delay.h>
#include <asm/uaccess.h>
#include <asm/irq.h>
#include <asm/io.h>
#include <linux/device.h>


MODULE_LICENSE("GPL");

static struct class *thirddrv_class;
static struct class_device *thirddrv_class_dev;

volatile unsigned long *gpfcon;	 	//0x56000050 
volatile unsigned long *gpfdat; 		//0x56000054

static irqreturn_t buttons_irq(int irq, void *dev_id)
{
	printk("irq = %d\n", irq);
	return IRQ_HANDLED;
}

int third_drv_open  (struct inode *inode, struct file *file)
{
	//*gpfdat &= ~((0x3 < 0*2) | (0x3 < 1*2) | (0x23< 2*2) | (0x3 < 2*4)); 
	request_irq(IRQ_EINT1, buttons_irq,IRQ_TYPE_EDGE_BOTH,"S1",1);	/*IRQF_SHARED*/
	request_irq(IRQ_EINT4, buttons_irq, IRQ_TYPE_EDGE_BOTH,"S4",1);	
	request_irq(IRQ_EINT2, buttons_irq,IRQ_TYPE_EDGE_BOTH,"S2",1);	
	request_irq(IRQ_EINT0, buttons_irq, IRQ_TYPE_EDGE_BOTH,"S0",1);
	return 0;
}

ssize_t third_drv_read(struct file *file, char __user *buf, size_t size, loff_t *ppos)
{
	unsigned char key_value[4];
	int regval;

	if (size  < sizeof(key_value) )
	{
		return -EINVAL;
	}
	
	//regval = *gpfdat;
	//key_value[0] = (regval & (0x1 < 1))? 1:0;
	//key_value[1] = (regval & (0x1 < 4))? 1:0;
	//key_value[2] = (regval & (0x1 < 2))? 1:0;	
	//key_value[2] = (regval & (0x1 < 0))? 1:0;

	//copy_to_user( buf,  key_value,  sizeof(key_value) );
	
	return  0;
}

int third_drv_close (struct inode *inode, struct file *file)
{
	free_irq(IRQ_EINT1, 1);
	free_irq(IRQ_EINT4, 1);	
	free_irq(IRQ_EINT2, 1);
	free_irq(IRQ_EINT0, 1);

	return 0;
}

static struct file_operations third_drv_fops =
{
	.owner = THIS_MODULE,
	.open = third_drv_open,
	.read = third_drv_read,
	.release = third_drv_close,
};

int major;

static int third_drv_init(void)
{
	major = register_chrdev(0,"thirddrv", &third_drv_fops);
	
	thirddrv_class = class_create(THIS_MODULE, "thirddrv");
	if (IS_ERR(thirddrv_class))
		return PTR_ERR(thirddrv_class);

	thirddrv_class_dev = device_create(thirddrv_class, NULL, MKDEV(major,0), NULL, "buttons"); /* /dev/buttons */
	if (unlikely(IS_ERR(thirddrv_class_dev)))
		return PTR_ERR(thirddrv_class_dev);

	gpfcon = (volatile unsigned long *)ioremap(0x56000050,16);
	gpfdat = (volatile unsigned long *)ioremap(0x56000054,16);
	return 0;
}

static void third_drv_exit(void)
{
	unregister_chrdev(major,"thirddrv");
	device_unregister(thirddrv_class_dev);
	class_destroy(thirddrv_class);

	iounmap(gpfcon);
	iounmap(gpfdat);
}

module_init(third_drv_init);
module_exit(third_drv_exit);
MODULE_LICENSE("GPL");