第二个驱动程序-tq2440

#include <linux/module.h>
#include <linux/kernel.h>
#include<linux/fs.h>
#include <linux/init.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 *seconddrv_class;
static struct class_device *seconddrv_class_dev;

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


int second_drv_open  (struct inode *inode, struct file *file)
{
	*gpfdat &= ~((0x3 < 0*2) | (0x3 < 1*2) | (0x23< 2*2) | (0x3 < 2*4)); 
	return 0;
}

ssize_t second_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;
}

static struct file_operations second_drv_fops =
{
	.owner = THIS_MODULE,
	.open = second_drv_open,
	.read = second_drv_read,
};

int major;
static int second_drv_init()
{
	major = register_chrdev(0,"seconddrv", &second_drv_fops);
	
	seconddrv_class = class_create(THIS_MODULE, "seconddrv");
	if (IS_ERR(seconddrv_class))
		return PTR_ERR(seconddrv_class);

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

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

static void second_drv_exit()
{
	unregister_chrdev(major,"seconddrv");
	device_unregister(seconddrv_class_dev);
	class_destroy(seconddrv_class);

	iounmap(gpfcon);
	iounmap(gpfdat);
}

module_init(second_drv_init);

module_exit(second_drv_exit);


MODULE_LICENSE("GPL");