linux设备驱动标准模板

/*Linux设备驱动标准模板，用于s3c2410实验，下面有配套应用程序内核版本：2.6.31交叉编译器：arm-linux-gccRead，write，ioctlS3C2410 GPF0~GPF3外接led灯，低电平点亮，高电平熄灭分别用write和ioctl实现led等的点亮经过验证，可点亮led流水灯*/#include<linux/module.h>#include<linux/kernel.h>#include<linux/fs.h>#include<linux/init.h>#include<linux/device.h>#include<linux/errno.h>#include<linux/semaphore.h>#include<linux/cdev.h>#include<linux/types.h>#include<asm/uaccess.h>#include<linux/wait.h>#include<linux/sched.h>#include<linux/slab.h>#include<linux/ioctl.h>#include<mach/regs-gpio.h>#include<mach/hardware.h>#include<asm/io.h>#define BUF_SIZE 100#define DEVICE_NAME "mydriver"#define MYDEV_MAGIC 'g'#define MYDEV_MAXNR 3#define MYDEV_FUNC1 _IO(MYDEV_MAGIC, 0)#define MYDEV_FUNC2 _IO(MYDEV_MAGIC, 1)#define MYDEV_FUNC3 _IO(MYDEV_MAGIC, 2)#define MYDEV_FUNC4 _IO(MYDEV_MAGIC, 3)#define GPFCON *((unsignedlong*) ioremap(0x56000050, 4))#define GPFDAT *((unsignedlong*) ioremap(0x56000054, 4))#define GPFUP *((unsignedlong*) ioremap(0x56000058, 4))staticint MYDRIVER_Major = 0;struct mydev{struct cdevcdev;struct semaphore sem;wait_queue_head_trq;wait_queue_head_twq;char *buf;};struct mydev *devp;staticint mydriver_open(struct inode *inode, struct file *file) {struct mydev *devp;printk(KERN_INFO "My Driver Open Called!\n");devp = container_of(inode->i_cdev, struct mydev, cdev);file->private_data = devp;try_module_get (THIS_MODULE);GPFCON = (GPFCON |0XFF) & 0X55;GPFUP = GPFUP & 0XF0;GPFDAT = GPFDAT | 0x0f;return 0;}staticint mydriver_release(struct inode *inode, struct file *file){printk(KERN_INFO "My Driver Release Called!\n");module_put(THIS_MODULE);return 0;}static ssize_tmydriver_read(struct file *filp, char __user*buf, size_t count, loff_t *f_pos) {struct mydev *devp = (struct mydev *)filp->private_data;ssize_tretval = 0;unsignedint readbyte = 0;char *my_buf = devp->buf;printk(KERN_INFO "My Driver Read Called!\n");if(down_interruptible(&devp->sem))return -ERESTARTSYS;while(*my_buf == 0){up(&devp->sem);if(filp->f_flags& O_NONBLOCK)return -EAGAIN;if(wait_event_interruptible(devp->rq, *my_buf != 0))return -ERESTARTSYS;if(down_interruptible(&devp->sem))return -ERESTARTSYS;}if(count <= 0){retval = 0;goto out;}elseif(count > BUF_SIZE)count = BUF_SIZE;while(*my_buf != 0 && count != 0){put_user(*my_buf++, buf++);readbyte++;count--;}retval = readbyte;memset(devp->buf, 0, BUF_SIZE);wake_up_interruptible(&devp->wq);out:up(&devp->sem);printk(KERN_INFO "Leave Read func!\n");return retval;}static ssize_tmydriver_write(struct file *filp, constchar __user*buf, size_t count, loff_t *f_pos){struct mydev *devp =(struct mydev *)filp->private_data;ssize_tretval = 0;unsignedint writebyte = 0;char *my_buf = devp->buf;printk(KERN_INFO "My Driver Write Called!\n");if(down_interruptible(&devp->sem))return -ERESTARTSYS;while(*my_buf != 0){up(&devp->sem);if(filp->f_flags& O_NONBLOCK)return -EAGAIN;if(wait_event_interruptible(devp->wq, *my_buf == 0))return -ERESTARTSYS;if(down_interruptible(&devp->sem))return -ERESTARTSYS;}if(count <= 0){retval = 0;goto out;}elseif(count > BUF_SIZE)count = BUF_SIZE;while(count != 0){get_user(*my_buf++, buf++);writebyte++;count--;}retval = writebyte;switch(*devp->buf){case'1':GPFDAT = (GPFDAT |0x0f) & 0xfe;break;case'2':GPFDAT = (GPFDAT | 0x0f) & 0xfd;break;case'3':GPFDAT = (GPFDAT | 0x0f) & 0xfb;break;case'4':GPFDAT = (GPFDAT | 0x0f) & 0xf7;break;}wake_up_interruptible(&devp->rq);out:up(&devp->sem);printk(KERN_INFO "Leave wirtefunc!\n");return retval;}staticint mydriver_ioctl( struct inode *inode, struct file *file, unsignedint cmd, unsignedlong arg){if(_IOC_TYPE(cmd) != MYDEV_MAGIC)return -ENOTTY;if(_IOC_NR(cmd) > MYDEV_MAXNR)return -ENOTTY;switch(cmd){case MYDEV_FUNC1:printk("ioctl mydev_func1\n");GPFDAT = (GPFDAT |0x0f) & 0xfe;break;case MYDEV_FUNC2:printk("ioctl mydev_func2\n");GPFDAT = (GPFDAT | 0x0f) & 0xfd;break;case MYDEV_FUNC3:printk("ioctl mydev_func3\n");GPFDAT = (GPFDAT | 0x0f) & 0xfb;break;case MYDEV_FUNC4:printk("ioctl mydev_func4\n");GPFDAT = (GPFDAT | 0x0f) & 0xf7;break;}return 0;}staticstruct file_operationsmydriver_fops ={.owner = THIS_MODULE,.open = mydriver_open,.release = mydriver_release,.read = mydriver_read,.write =mydriver_write,.ioctl =mydriver_ioctl,};staticint setup_cdev(struct mydev *devp){int ret = 0;cdev_init(&devp->cdev, &mydriver_fops);devp->cdev.owner = THIS_MODULE;ret = cdev_add(&devp->cdev, MKDEV(MYDRIVER_Major, 0), 1);return ret;}staticstructclass *mydriver_class;staticint __initmydriver_init(void){int ret;dev_tmydevno;printk(KERN_INFO "Enter initfunc\n");mydevno = MKDEV(MYDRIVER_Major, 0);if(mydevno)ret = register_chrdev_region(mydevno, 1, DEVICE_NAME);else{ret = alloc_chrdev_region(&mydevno, 0, 1, DEVICE_NAME);MYDRIVER_Major = MAJOR(mydevno);}if(ret < 0){printk(DEVICE_NAME " can't register major number\n");return ret;}printk("register My Driver OK! Major = %d\n", MYDRIVER_Major);devp = (struct mydev*)kmalloc(sizeof(struct mydev), GFP_KERNEL);if(!devp){printk("Allocmydev error!");ret = -ENOMEM;goto fail_malloc1;}devp->buf = (char*)kmalloc(BUF_SIZE, GFP_KERNEL);if(!devp->buf){printk("allocbuf error!");ret = -ENOMEM;goto fail_malloc2;}/*初?始º?化¡¥设¦¨¨备À?结¨¢构1体¬?*/memset(devp->buf, 0, BUF_SIZE);init_MUTEX(&devp->sem);init_waitqueue_head(&devp->rq);init_waitqueue_head(&devp->wq);ret = setup_cdev(devp);if(ret < 0){printk("setup cdev error!");goto fail_setup_cdev;}mydriver_class = class_create(THIS_MODULE, DEVICE_NAME);if(IS_ERR(mydriver_class)){printk("Err: failed in My Driver class. \n");goto fail_create_class;}device_create(mydriver_class, NULL, mydevno, NULL, DEVICE_NAME);printk(DEVICE_NAME " initialized\n");printk(KERN_INFO "Quit initfunc\n");return 0;fail_create_class:cdev_del(&devp->cdev);fail_setup_cdev:kfree(devp->buf);fail_malloc2:kfree(devp);fail_malloc1:unregister_chrdev_region(mydevno, 1);return ret;}staticvoid __exit mydriver_exit(void){printk(KERN_INFO "Enter exit func\n");unregister_chrdev_region(MKDEV(MYDRIVER_Major, 0), 1);cdev_del(&devp->cdev);kfree(devp->buf);kfree(devp);device_destroy(mydriver_class, MKDEV(MYDRIVER_Major, 0));class_destroy(mydriver_class);printk(KERN_INFO "Quit exit func\n");}module_init(mydriver_init);module_exit(mydriver_exit);MODULE_AUTHOR("Wzd");MODULE_DESCRIPTION("My Driver");MODULE_LICENSE("Dual BSD/GPL");/**上述驱动程序的配套应用程序*/#include<sys/types.h>#include<sys/stat.h>#include<stdio.h>#include<unistd.h>#include<fcntl.h>#include<string.h>#include<linux/ioctl.h>#include<sys/wait.h>#define MYDEV_MAGIC 'g'#define MYDEV_MAXNR 3#define MYDEV_FUNC1 _IO(MYDEV_MAGIC, 0)#define MYDEV_FUNC2 _IO(MYDEV_MAGIC, 1)#define MYDEV_FUNC3 _IO(MYDEV_MAGIC, 2)#define MYDEV_FUNC4 _IO(MYDEV_MAGIC, 3)char buff[100];char data[100]="1234";main(){int fd;unsignedlong count;char *p = buff;unsignedint num = 10;memset(buff, 0, 100);fd =open("/dev/mydriver",0666);if(fd< 0)printf("failed to open mydriver\n");printf("open dev_hello success\n");// count = read(fd,buff,sizeof(buff));//if(count < 0)// printf("failed to read mydriver\n");//printf("buff : %s\n",p);/* count = write(fd,data,strlen(data));if(count < 0)printf("failed to write mydriver\n");printf("write mydriver success\n");count = read(fd,buff,sizeof(buff));if(count < 0)printf("failed to read mydriver\n");printf("read mydriver success\n");if(strlen(buff) > 100)buff[99] = 0;printf("buff : %s\n",p);while(num--){ioctl(fd, MYDEV_FUNC1);sleep(1);ioctl(fd, MYDEV_FUNC2);sleep(1);ioctl(fd, MYDEV_FUNC3);sleep(1);ioctl(fd, MYDEV_FUNC4);sleep(1);}*/while(num--){write(fd, &data[0], 1);read(fd, p++, 1);sleep(1);write(fd, &data[1], 1);read(fd, p++, 1);sleep(1);write(fd, &data[2], 1);read(fd, p++, 1);sleep(1);write(fd, &data[3], 1);read(fd, p++,1);sleep(1);}if(strlen(buff) > 100)buff[99] = 0;printf("buff : %s\n",p);close(fd);return 0;}。