/home/lihacker/develop/svn/ldd6410-read-only/training/kernel/drivers/globalfifo
< ch8 / globalfifo.c >
/*
* A globalfifo driver as an example of char device drivers
* This example is to introduce poll,blocking and non-blocking access
*
* The initial developer of the original code is Baohua Song
* <author@linuxdriver.cn>. All Rights Reserved.
*/
#include <linux/module.h>
#include <linux/types.h>
#include <linux/fs.h>
#include <linux/errno.h>
#include <linux/mm.h>
#include <linux/sched.h>
#include <linux/init.h>
#include <linux/cdev.h>
#include <asm/io.h>
#include <asm/system.h>
#include <asm/uaccess.h>
#include <linux/poll.h>
#define GLOBALFIFO_SIZE 0x1000 /*È«ŸÖfifo×îŽó4K×ÖœÚ*/
#define FIFO_CLEAR 0x1 /*Çå0È«ŸÖÄÚŽæµÄ³€¶È*/
#define GLOBALFIFO_MAJOR 249 /*Ô€ÉèµÄglobalfifoµÄÖ÷É豞ºÅ*/
static int globalfifo_major = GLOBALFIFO_MAJOR;
/*globalfifoÉ豞œá¹¹Ìå*/
struct globalfifo_dev {
struct cdev cdev; /*cdevœá¹¹Ìå*/
unsigned int current_len; /*fifoÓÐЧÊýŸÝ³€¶È*/
unsigned char mem[GLOBALFIFO_SIZE]; /*È«ŸÖÄÚŽæ*/
struct semaphore sem; /*²¢·¢¿ØÖÆÓõÄÐźÅÁ¿*/
wait_queue_head_t r_wait; /*×èÈû¶ÁÓõĵȎý¶ÓÁÐÍ·*/
wait_queue_head_t w_wait; /*×èÈûÐŽÓõĵȎý¶ÓÁÐÍ·*/
};
struct globalfifo_dev *globalfifo_devp; /*É豞œá¹¹ÌåÖžÕë*/
/*ÎÄŒþŽò¿ªº¯Êý*/
int globalfifo_open(struct inode *inode, struct file *filp)
{
/*œ«É豞œá¹¹ÌåÖžÕëž³ÖµžøÎÄŒþËœÓÐÊýŸÝÖžÕë*/
filp->private_data = globalfifo_devp;
return 0;
}
/*ÎÄŒþÊͷź¯Êý*/
int globalfifo_release(struct inode *inode, struct file *filp)
{
return 0;
}
/* ioctlÉ豞¿ØÖƺ¯Êý */
static int globalfifo_ioctl(struct inode *inodep, struct file *filp, unsigned
int cmd, unsigned long arg)
{
struct globalfifo_dev *dev = filp->private_data;/*»ñµÃÉ豞œá¹¹ÌåÖžÕë*/
switch (cmd) {
case FIFO_CLEAR:
down(&dev->sem); /* »ñµÃÐźÅÁ¿ */
dev->current_len = 0;
memset(dev->mem,0,GLOBALFIFO_SIZE);
up(&dev->sem); /* ÊÍ·ÅÐźÅÁ¿ */
printk(KERN_INFO "globalfifo is set to zero\n");
break;
default:
return - EINVAL;
}
return 0;
}
static unsigned int globalfifo_poll(struct file *filp, poll_table *wait)
{
unsigned int mask = 0;
struct globalfifo_dev *dev = filp->private_data; /*»ñµÃÉ豞œá¹¹ÌåÖžÕë*/
down(&dev->sem);
poll_wait(filp, &dev->r_wait, wait);
poll_wait(filp, &dev->w_wait, wait);
/*fifo·Ç¿Õ*/
if (dev->current_len != 0) {
mask |= POLLIN | POLLRDNORM; /*±êÊŸÊýŸÝ¿É»ñµÃ*/
}
/*fifo·ÇÂú*/
if (dev->current_len != GLOBALFIFO_SIZE) {
mask |= POLLOUT | POLLWRNORM; /*±êÊŸÊýŸÝ¿ÉÐŽÈë*/
}
up(&dev->sem);
return mask;
}
/*globalfifo¶Áº¯Êý*/
static ssize_t globalfifo_read(struct file *filp, char __user *buf, size_t count,
loff_t *ppos)
{
int ret;
struct globalfifo_dev *dev = filp->private_data;
DECLARE_WAITQUEUE(wait, current);
down(&dev->sem); /* »ñµÃÐźÅÁ¿ */
add_wait_queue(&dev->r_wait, &wait); /* œøÈë¶ÁµÈŽý¶ÓÁÐÍ· */
/* µÈŽýFIFO·Ç¿Õ */
if (dev->current_len == 0) {
if (filp->f_flags &O_NONBLOCK) {
ret = - EAGAIN;
goto out;
}
__set_current_state(TASK_INTERRUPTIBLE); /* žÄ±äœø³Ì׎̬Ϊ˯Ãß */
up(&dev->sem);
schedule(); /* µ÷¶ÈÆäËûœø³ÌÖŽÐÐ */
if (signal_pending(current)) {
/* Èç¹ûÊÇÒòΪÐźŻœÐÑ */
ret = - ERESTARTSYS;
goto out2;
}
down(&dev->sem);
}
/* ¿œ±ŽµœÓû§¿ÕŒä */
if (count > dev->current_len)
count = dev->current_len;
if (copy_to_user(buf, dev->mem, count)) {
ret = - EFAULT;
goto out;
} else {
memcpy(dev->mem, dev->mem + count, dev->current_len - count); /* fifoÊýŸÝÇ°ÒÆ */
dev->current_len -= count; /* ÓÐЧÊýŸÝ³€¶ÈŒõÉÙ */
printk(KERN_INFO "read %d bytes(s),current_len:%d\n", count, dev->current_len);
wake_up_interruptible(&dev->w_wait); /* »œÐÑÐŽµÈŽý¶ÓÁÐ */
ret = count;
}
out:
up(&dev->sem); /* ÊÍ·ÅÐźÅÁ¿ */
out2:
remove_wait_queue(&dev->w_wait, &wait); /* ŽÓžœÊôµÄµÈŽý¶ÓÁÐÍ·ÒƳý */
set_current_state(TASK_RUNNING);
return ret;
}
/*globalfifoÐŽ²Ù×÷*/
static ssize_t globalfifo_write(struct file *filp, const char __user *buf,
size_t count, loff_t *ppos)
{
struct globalfifo_dev *dev = filp->private_data;
int ret;
DECLARE_WAITQUEUE(wait, current);
down(&dev->sem);
add_wait_queue(&dev->w_wait, &wait);
/* µÈŽýFIFO·ÇÂú */
if (dev->current_len == GLOBALFIFO_SIZE) {
if (filp->f_flags &O_NONBLOCK) {
ret = - EAGAIN;
goto out;
}
__set_current_state(TASK_INTERRUPTIBLE); /* žÄ±äœø³Ì׎̬Ϊ˯Ãß */
up(&dev->sem);
schedule(); /* µ÷¶ÈÆäËûœø³ÌÖŽÐÐ */
if (signal_pending(current)) {
/* Èç¹ûÊÇÒòΪÐźŻœÐÑ */
ret = - ERESTARTSYS;
goto out2;
}
down(&dev->sem); /* »ñµÃÐźÅÁ¿ */
}
/*ŽÓÓû§¿ÕŒä¿œ±ŽµœÄں˿Ռä*/
if (count > GLOBALFIFO_SIZE - dev->current_len)
count = GLOBALFIFO_SIZE - dev->current_len;
if (copy_from_user(dev->mem + dev->current_len, buf, count)) {
ret = - EFAULT;
goto out;
} else {
dev->current_len += count;
printk(KERN_INFO "written %d bytes(s),current_len:%d\n", count, dev
->current_len);
wake_up_interruptible(&dev->r_wait); /* »œÐѶÁµÈŽý¶ÓÁÐ */
ret = count;
}
out:
up(&dev->sem); /* ÊÍ·ÅÐźÅÁ¿ */
out2:
remove_wait_queue(&dev->w_wait, &wait); /* ŽÓžœÊôµÄµÈŽý¶ÓÁÐÍ·ÒƳý */
set_current_state(TASK_RUNNING);
return ret;
}
/*ÎÄŒþ²Ù×÷œá¹¹Ìå*/
static const struct file_operations globalfifo_fops = {
.owner = THIS_MODULE,
.read = globalfifo_read,
.write = globalfifo_write,
.ioctl = globalfifo_ioctl,
.poll = globalfifo_poll,
.open = globalfifo_open,
.release = globalfifo_release,
};
/*³õÊŒ»¯²¢×¢²ácdev*/
static void globalfifo_setup_cdev(struct globalfifo_dev *dev, int index)
{
int err, devno = MKDEV(globalfifo_major, index);
cdev_init(&dev->cdev, &globalfifo_fops);
dev->cdev.owner = THIS_MODULE;
err = cdev_add(&dev->cdev, devno, 1);
if (err)
printk(KERN_NOTICE "Error %d adding LED%d", err, index);
}
/*É豞Çý¶¯Ä£¿éŒÓÔغ¯Êý*/
int globalfifo_init(void)
{
int ret;
dev_t devno = MKDEV(globalfifo_major, 0);
/* ÉêÇëÉ豞ºÅ*/
if (globalfifo_major)
ret = register_chrdev_region(devno, 1, "globalfifo");
else { /* ¶¯Ì¬ÉêÇëÉ豞ºÅ */
ret = alloc_chrdev_region(&devno, 0, 1, "globalfifo");
globalfifo_major = MAJOR(devno);
}
if (ret < 0)
return ret;
/* ¶¯Ì¬ÉêÇëÉ豞œá¹¹ÌåµÄÄÚŽæ*/
globalfifo_devp = kmalloc(sizeof(struct globalfifo_dev), GFP_KERNEL);
if (!globalfifo_devp) {
ret = - ENOMEM;
goto fail_malloc;
}
memset(globalfifo_devp, 0, sizeof(struct globalfifo_dev));
globalfifo_setup_cdev(globalfifo_devp, 0);
init_MUTEX(&globalfifo_devp->sem); /*³õÊŒ»¯ÐźÅÁ¿*/
init_waitqueue_head(&globalfifo_devp->r_wait); /*³õÊŒ»¯¶ÁµÈŽý¶ÓÁÐÍ·*/
init_waitqueue_head(&globalfifo_devp->w_wait); /*³õÊŒ»¯ÐŽµÈŽý¶ÓÁÐÍ·*/
return 0;
fail_malloc: unregister_chrdev_region(devno, 1);
return ret;
}
/*Ä£¿éжÔغ¯Êý*/
void globalfifo_exit(void)
{
cdev_del(&globalfifo_devp->cdev); /*×¢Ïúcdev*/
kfree(globalfifo_devp); /*ÊÍ·ÅÉ豞œá¹¹ÌåÄÚŽæ*/
unregister_chrdev_region(MKDEV(globalfifo_major, 0), 1); /*ÊÍ·ÅÉ豞ºÅ*/
}
MODULE_AUTHOR("Song Baohua");
MODULE_LICENSE("Dual BSD/GPL");
module_param(globalfifo_major, int, S_IRUGO);
module_init(globalfifo_init);
module_exit(globalfifo_exit);
< ch8 / Makefile >
KVERS = $(shell uname -r)
# Kernel modules
obj-m += globalfifo.o
# Specify flags for the module compilation.
EXTRA_CFLAGS=-g -O0
build: kernel_modules
kernel_modules:
make -C /lib/modules/$(KVERS)/build M=$(CURDIR) modules
clean:
make -C /lib/modules/$(KVERS)/build M=$(CURDIR) clean
< ch9 / globalfifo.c >
/*
* A globalfifo driver as an example of char device drivers
* This example is to introduce poll,blocking and non-blocking access
*
* The initial developer of the original code is Baohua Song
* <author@linuxdriver.cn>. All Rights Reserved.
*/
#include <linux/module.h>
#include <linux/types.h>
#include <linux/fs.h>
#include <linux/errno.h>
#include <linux/mm.h>
#include <linux/sched.h>
#include <linux/init.h>
#include <linux/cdev.h>
#include <asm/io.h>
#include <asm/system.h>
#include <asm/uaccess.h>
#include <linux/poll.h>
#define GLOBALFIFO_SIZE 0x1000 /*È«ŸÖfifo×îŽó4K×ÖœÚ*/
#define FIFO_CLEAR 0x1 /*Çå0È«ŸÖÄÚŽæµÄ³€¶È*/
#define GLOBALFIFO_MAJOR 249 /*Ô€ÉèµÄglobalfifoµÄÖ÷É豞ºÅ*/
static int globalfifo_major = GLOBALFIFO_MAJOR;
/*globalfifoÉ豞œá¹¹Ìå*/
struct globalfifo_dev {
struct cdev cdev; /*cdevœá¹¹Ìå*/
unsigned int current_len; /*fifoÓÐЧÊýŸÝ³€¶È*/
unsigned char mem[GLOBALFIFO_SIZE]; /*È«ŸÖÄÚŽæ*/
struct semaphore sem; /*²¢·¢¿ØÖÆÓõÄÐźÅÁ¿*/
wait_queue_head_t r_wait; /*×èÈû¶ÁÓõĵȎý¶ÓÁÐÍ·*/
wait_queue_head_t w_wait; /*×èÈûÐŽÓõĵȎý¶ÓÁÐÍ·*/
struct fasync_struct *async_queue; /* Ò천œá¹¹ÌåÖžÕ룬ÓÃÓÚ¶Á */
};
struct globalfifo_dev *globalfifo_devp; /*É豞œá¹¹ÌåÖžÕë*/
static int globalfifo_fasync(int fd, struct file *filp, int mode)
{
struct globalfifo_dev *dev = filp->private_data;
return fasync_helper(fd, filp, mode, &dev->async_queue);
}
/*ÎÄŒþŽò¿ªº¯Êý*/
int globalfifo_open(struct inode *inode, struct file *filp)
{
/*œ«É豞œá¹¹ÌåÖžÕëž³ÖµžøÎÄŒþËœÓÐÊýŸÝÖžÕë*/
filp->private_data = globalfifo_devp;
return 0;
}
/*ÎÄŒþÊͷź¯Êý*/
int globalfifo_release(struct inode *inode, struct file *filp)
{
/* œ«ÎÄŒþŽÓÒ천͚֪ÁбíÖÐÉŸ³ý */
globalfifo_fasync( - 1, filp, 0);
return 0;
}
/* ioctlÉ豞¿ØÖƺ¯Êý */
static int globalfifo_ioctl(struct inode *inodep, struct file *filp, unsigned
int cmd, unsigned long arg)
{
struct globalfifo_dev *dev = filp->private_data;/*»ñµÃÉ豞œá¹¹ÌåÖžÕë*/
switch (cmd) {
case FIFO_CLEAR:
down(&dev->sem); /* »ñµÃÐźÅÁ¿ */
dev->current_len = 0;
memset(dev->mem,0,GLOBALFIFO_SIZE);
up(&dev->sem); /* ÊÍ·ÅÐźÅÁ¿ */
printk(KERN_INFO "globalfifo is set to zero\n");
break;
default:
return - EINVAL;
}
return 0;
}
static unsigned int globalfifo_poll(struct file *filp, poll_table *wait)
{
unsigned int mask = 0;
struct globalfifo_dev *dev = filp->private_data; /*»ñµÃÉ豞œá¹¹ÌåÖžÕë*/
down(&dev->sem);
poll_wait(filp, &dev->r_wait, wait);
poll_wait(filp, &dev->w_wait, wait);
/*fifo·Ç¿Õ*/
if (dev->current_len != 0) {
mask |= POLLIN | POLLRDNORM; /*±êÊŸÊýŸÝ¿É»ñµÃ*/
}
/*fifo·ÇÂú*/
if (dev->current_len != GLOBALFIFO_SIZE) {
mask |= POLLOUT | POLLWRNORM; /*±êÊŸÊýŸÝ¿ÉÐŽÈë*/
}
up(&dev->sem);
return mask;
}
/*globalfifo¶Áº¯Êý*/
static ssize_t globalfifo_read(struct file *filp, char __user *buf, size_t count,
loff_t *ppos)
{
int ret;
struct globalfifo_dev *dev = filp->private_data;
DECLARE_WAITQUEUE(wait, current);
down(&dev->sem); /* »ñµÃÐźÅÁ¿ */
add_wait_queue(&dev->r_wait, &wait); /* œøÈë¶ÁµÈŽý¶ÓÁÐÍ· */
/* µÈŽýFIFO·Ç¿Õ */
if (dev->current_len == 0) {
if (filp->f_flags &O_NONBLOCK) {
ret = - EAGAIN;
goto out;
}
__set_current_state(TASK_INTERRUPTIBLE); /* žÄ±äœø³Ì׎̬Ϊ˯Ãß */
up(&dev->sem);
schedule(); /* µ÷¶ÈÆäËûœø³ÌÖŽÐÐ */
if (signal_pending(current)) {
/* Èç¹ûÊÇÒòΪÐźŻœÐÑ */
ret = - ERESTARTSYS;
goto out2;
}
down(&dev->sem);
}
/* ¿œ±ŽµœÓû§¿ÕŒä */
if (count > dev->current_len)
count = dev->current_len;
if (copy_to_user(buf, dev->mem, count)) {
ret = - EFAULT;
goto out;
} else {
memcpy(dev->mem, dev->mem + count, dev->current_len - count); /* fifoÊýŸÝÇ°ÒÆ */
dev->current_len -= count; /* ÓÐЧÊýŸÝ³€¶ÈŒõÉÙ */
printk(KERN_INFO "read %d bytes(s),current_len:%d\n", count, dev->current_len);
wake_up_interruptible(&dev->w_wait); /* »œÐÑÐŽµÈŽý¶ÓÁÐ */
ret = count;
}
out:
up(&dev->sem); /* ÊÍ·ÅÐźÅÁ¿ */
out2:
remove_wait_queue(&dev->w_wait, &wait); /* ŽÓžœÊôµÄµÈŽý¶ÓÁÐÍ·ÒƳý */
set_current_state(TASK_RUNNING);
return ret;
}
/*globalfifoÐŽ²Ù×÷*/
static ssize_t globalfifo_write(struct file *filp, const char __user *buf,
size_t count, loff_t *ppos)
{
struct globalfifo_dev *dev = filp->private_data;
int ret;
DECLARE_WAITQUEUE(wait, current);
down(&dev->sem);
add_wait_queue(&dev->w_wait, &wait);
/* µÈŽýFIFO·ÇÂú */
if (dev->current_len == GLOBALFIFO_SIZE) {
if (filp->f_flags &O_NONBLOCK) {
ret = - EAGAIN;
goto out;
}
__set_current_state(TASK_INTERRUPTIBLE); /* žÄ±äœø³Ì׎̬Ϊ˯Ãß */
up(&dev->sem);
schedule(); /* µ÷¶ÈÆäËûœø³ÌÖŽÐÐ */
if (signal_pending(current)) {
/* Èç¹ûÊÇÒòΪÐźŻœÐÑ */
ret = - ERESTARTSYS;
goto out2;
}
down(&dev->sem); /* »ñµÃÐźÅÁ¿ */
}
/*ŽÓÓû§¿ÕŒä¿œ±ŽµœÄں˿Ռä*/
if (count > GLOBALFIFO_SIZE - dev->current_len)
count = GLOBALFIFO_SIZE - dev->current_len;
if (copy_from_user(dev->mem + dev->current_len, buf, count)) {
ret = - EFAULT;
goto out;
} else {
dev->current_len += count;
printk(KERN_INFO "written %d bytes(s),current_len:%d\n", count, dev
->current_len);
wake_up_interruptible(&dev->r_wait); /* »œÐѶÁµÈŽý¶ÓÁÐ */
/* ²úÉúÒ천¶ÁÐźŠ*/
if (dev->async_queue) {
kill_fasync(&dev->async_queue, SIGIO, POLL_IN);
printk(KERN_DEBUG "%s kill SIGIO\n", __func__);
}
ret = count;
}
out:
up(&dev->sem); /* ÊÍ·ÅÐźÅÁ¿ */
out2:
remove_wait_queue(&dev->w_wait, &wait); /* ŽÓžœÊôµÄµÈŽý¶ÓÁÐÍ·ÒƳý */
set_current_state(TASK_RUNNING);
return ret;
}
/*ÎÄŒþ²Ù×÷œá¹¹Ìå*/
static const struct file_operations globalfifo_fops = {
.owner = THIS_MODULE,
.read = globalfifo_read,
.write = globalfifo_write,
.ioctl = globalfifo_ioctl,
.poll = globalfifo_poll,
.fasync = globalfifo_fasync,
.open = globalfifo_open,
.release = globalfifo_release,
};
/*³õÊŒ»¯²¢×¢²ácdev*/
static void globalfifo_setup_cdev(struct globalfifo_dev *dev, int index)
{
int err, devno = MKDEV(globalfifo_major, index);
cdev_init(&dev->cdev, &globalfifo_fops);
dev->cdev.owner = THIS_MODULE;
err = cdev_add(&dev->cdev, devno, 1);
if (err)
printk(KERN_NOTICE "Error %d adding LED%d", err, index);
}
/*É豞Çý¶¯Ä£¿éŒÓÔغ¯Êý*/
int globalfifo_init(void)
{
int ret;
dev_t devno = MKDEV(globalfifo_major, 0);
/* ÉêÇëÉ豞ºÅ*/
if (globalfifo_major)
ret = register_chrdev_region(devno, 1, "globalfifo");
else { /* ¶¯Ì¬ÉêÇëÉ豞ºÅ */
ret = alloc_chrdev_region(&devno, 0, 1, "globalfifo");
globalfifo_major = MAJOR(devno);
}
if (ret < 0)
return ret;
/* ¶¯Ì¬ÉêÇëÉ豞œá¹¹ÌåµÄÄÚŽæ*/
globalfifo_devp = kmalloc(sizeof(struct globalfifo_dev), GFP_KERNEL);
if (!globalfifo_devp) {
ret = - ENOMEM;
goto fail_malloc;
}
memset(globalfifo_devp, 0, sizeof(struct globalfifo_dev));
globalfifo_setup_cdev(globalfifo_devp, 0);
init_MUTEX(&globalfifo_devp->sem); /*³õÊŒ»¯ÐźÅÁ¿*/
init_waitqueue_head(&globalfifo_devp->r_wait); /*³õÊŒ»¯¶ÁµÈŽý¶ÓÁÐÍ·*/
init_waitqueue_head(&globalfifo_devp->w_wait); /*³õÊŒ»¯ÐŽµÈŽý¶ÓÁÐÍ·*/
return 0;
fail_malloc: unregister_chrdev_region(devno, 1);
return ret;
}
/*Ä£¿éжÔغ¯Êý*/
void globalfifo_exit(void)
{
cdev_del(&globalfifo_devp->cdev); /*×¢Ïúcdev*/
kfree(globalfifo_devp); /*ÊÍ·ÅÉ豞œá¹¹ÌåÄÚŽæ*/
unregister_chrdev_region(MKDEV(globalfifo_major, 0), 1); /*ÊÍ·ÅÉ豞ºÅ*/
}
MODULE_AUTHOR("Song Baohua");
MODULE_LICENSE("Dual BSD/GPL");
module_param(globalfifo_major, int, S_IRUGO);
module_init(globalfifo_init);
module_exit(globalfifo_exit);
< ch9 / Makefile >
KVERS = $(shell uname -r)
<pre name="code" class="cpp">< ch9 / globalfifo_test.c >
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <fcntl.h>
#include <signal.h>
#include <sys/stat.h>
/*œÓÊÕµœÒ천¶ÁÐźźóµÄ¶¯×÷*/
void input_handler(int signum)
{
printf("receive a signal from globalfifo,signalnum:%d\n",signum);
}
main()
{
int fd, oflags;
fd = open("/dev/globalfifo", O_RDWR, S_IRUSR | S_IWUSR);
if (fd != - 1) {
/* Æô¶¯ÐźÅÇý¶¯»úÖÆ */
signal(SIGIO, input_handler); /* ÈÃinput_handler()ŽŠÀíSIGIOÐźŠ*/
fcntl(fd, F_SETOWN, getpid());
oflags = fcntl(fd, F_GETFL);
fcntl(fd, F_SETFL, oflags | FASYNC);
while(1) {
sleep(100);
}
} else {
printf("device open failure\n");
}
}
# Kernel modules
obj-m += globalfifo.o
# Specify flags for the module compilation.
EXTRA_CFLAGS=-g -O0
build: kernel_modules user_test
kernel_modules:
make -C /lib/modules/$(KVERS)/build M=$(CURDIR) modules
user_test:
gcc -o globalfifo_test globalfifo_test.c
clean:
make -C /lib/modules/$(KVERS)/build M=$(CURDIR) clean
rm globalfifo_test globalfifo_test.o