驱动
#include <linux/module.h>
#include <linux/init.h>
#include <linux/fs.h>
#include <asm/uaccess.h>
#include <mach/regs-gpio.h>
#include <mach/gpio-bank.h>
#include <linux/cdev.h>
#define DEMO_MAJOR 200
#define DEMO_CNT 1
#define DEMO_NAME "demo_char"
#define GPJ0CON *((volatile unsigned int *)S5PV210_GPJ0CON)
#define GPJ0DAT *((volatile unsigned int *)S5PV210_GPJ0DAT)
static dev_t mydev;
static struct cdev *pcdev;
static int demo_chrdev_open(struct inode *inode, struct file *file)
{
GPJ0CON &= 0xff000fff;
GPJ0CON |= (1<<12)|(1<<16)|(1<<20);
GPJ0DAT |= ((1<<3)|(1<<4)|(1<<5));
printk(KERN_INFO "demo_chrdev_open\n");
return 0;
}
static int demo_chrdev_release(struct inode *inode, struct file *file)
{
GPJ0DAT |= ((1<<3)|(1<<4)|(1<<5));
printk(KERN_INFO "demo_chrdev_release\n");
return 0;
}
static ssize_t demo_chrdev_write(struct file *file, const char __user *ubuf, size_t count, loff_t *ppos)
{
int ret = -1;
char kbuf[100] = {0};
ret = copy_from_user(kbuf,ubuf,count);
if(ret)
{
printk(KERN_ERR "copy_from_user fail\n");
return -EINVAL;
}
if(!strcmp(kbuf,"0"))
GPJ0DAT &= ~((1<<3)|(1<<4)|(1<<5));
else if(!strcmp(kbuf,"1"))
GPJ0DAT |= ((1<<3)|(1<<4)|(1<<5));
else
printk(KERN_INFO "input err\r\n");
printk(KERN_INFO "copy_from_user %s\r\n",kbuf);
return 0;
}
static const struct file_operations demo_fops = {
.owner = THIS_MODULE,
.open = demo_chrdev_open,
.release = demo_chrdev_release,
.write = demo_chrdev_write,
};
static int __init chrdev_init(void)
{
int ret = -1;
ret = alloc_chrdev_region(&mydev,12,DEMO_CNT,DEMO_NAME);
if(ret<0)
{
printk(KERN_ERR "register_chrdev_region error\r\n");
goto alloc_err;
}
pcdev = cdev_alloc();
pcdev->owner = THIS_MODULE;
pcdev->ops = &demo_fops;
ret = cdev_add(pcdev, mydev, DEMO_CNT);
if(ret)
{
printk(KERN_ERR "cdev_add error\r\n");
goto add_err;
}
printk(KERN_INFO "chrdev_init %d %d\n",MAJOR(mydev),MINOR(mydev));
return 0;
add_err: cdev_del(pcdev);
alloc_err: return -EINVAL;
}
static void __exit chrdev_exit(void)
{
cdev_del(pcdev);
unregister_chrdev_region(mydev,DEMO_CNT);
}
module_init(chrdev_init);
module_exit(chrdev_exit);
MODULE_LICENSE("GPL");
MODULE_AUTHOR("Xin-Ya Zhu<mhzhuxinya@outlook.com>");
MODULE_DESCRIPTION("demo test");
MODULE_ALIAS("alias xxx");
应用
int main(void)
{
int fd = -1;
char buf[100] = {0};
fd = open(FILE,O_RDWR);
if(fd<0)
{
printf("open error.\n");
return -1;
}
write(fd,LED_ON,strlen(LED_ON));
sleep(1);
write(fd,LED_OFF,strlen(LED_OFF));
sleep(1);
write(fd,LED_ON,strlen(LED_ON));
sleep(1);
write(fd,LED_OFF,strlen(LED_OFF));
sleep(1);
close(fd);
return 0;
}
/***************************
[root@zhuxinya text]
[ 16.507874] chrdev_init 250 12
[root@zhuxinya text]
[root@zhuxinya text]
[ 30.405199] demo_chrdev_open
[ 30.407220] copy_from_user 0
[ 31.489561] copy_from_user 1
[ 32.491128] copy_from_user 0
[ 33.492682] copy_from_user 1
[ 34.494248] demo_chrdev_release
[root@zhuxinya text]
[root@zhuxinya text]
*****************************/