#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");
第二个驱动程序-tq2440
最新推荐文章于 2018-11-02 10:56:46 发布