信号量和队列:semaphore and wait_queue_head_t

原创 2012年08月07日 16:37:25

这一次是在globalmem的字符设备驱动的基础上,增加了并发控制(也就是多进程多共享资源的访问的控制),还增加了阻塞I/O 和poll轮询操作,因为我还是菜鸟,有很多东西还不懂,希望与大侠能指点学习Linux设备驱动的要点和关键点。还是看代码吧

#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 /* 清零全局内存的长度 */
#define GLOBALFIFO_MAJOR 250 /* 预设的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, 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;
	dev->cdev.ops = &globalfifo_fops;
	err = cdev_add(&dev->cdev, devno, 1);
	if (err)
		printk(KERN_INFO "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_LICENSE("Dual BSD/GPL");

module_param(globalfifo_major, int, S_IRUGO);

module_init(globalfifo_init);
module_exit(globalfifo_exit);


版权声明:本文为博主原创文章,未经博主允许不得转载。

相关文章推荐

31 completion完成量与wait_queue_head_t等待队列

完成量, 功能与信号量差不多, 最大不同可以唤醒多个休眠的进程或线程#include struct completion { unsigned int done; //done表示资源,上锁...

等待队列wait_queue_head_t使用

当你在用户空间需要读写一大片数据的时候,这个就用上了。 以下来自:http://www.yuanma.org/data/2006/1207/article_1916.htm 假设我们在 k...

linux内核的 等待队列 使用方法,wait_queue_head_t,进程休眠

以下来自:http://www.yuanma.org/data/2006/1207/article_1916.htm 假设我们在 kernel 里产生一个 buffer,user 可以经由read,...

linux内核的 等待队列 使用方法,wait_queue_head_t,进程休眠

当你在用户空间需要读写一大片数据的时候,这个就用上了。   以下来自:http://www.yuanma.org/data/2006/1207/article_1916.htm 假设我们在 ke...

Linux等待队列wait_queue_head_t和wait_queue_t

Linux等待队列wait_queue_head_t和wait_queue_t

linux等待队列wait_queue_head_t和wait_queue_t

等待队列在linux内核中有着举足轻重的作用,很多linux驱动都或多或少涉及到了等待队列。因此,对于linux内核及驱动开发者来说,掌握等待队列是必须课之一。 Linux内核的等待队列是以双循环链表...

30 spinlock_t自旋锁和semaphore信号量

自旋锁是一直循环检查, 直到锁上为止(锁不上也不会让进程休眠)。自旋锁只有两种状态,可锁上和锁不上. 锁上后确保执行的代码为原子操作, 直到解锁为止. 注意不能长时间锁上自旋锁, 不能在临界区里休眠....

GCD-信号量(dispatch_semaphore_t)

信号量在多线程开发中被广泛使用,当一个线程在进入一段关键代码之前,线程必须获取一个信号量,一旦该关键代码段完成了,那么该线程必须释放信号量。其它想进入该关键代码段的线程必须等待前面的线程释放信号量。 ...

dispatch_semaphore_t 信号量相关知识

dispatch_semaphore_t是GCD系列的产物,semaphore译词有信号量一说! 与之相关的有三个函数dispatch_semaphore_t dispatch_semaphore_c...
内容举报
返回顶部
收藏助手
不良信息举报
您举报文章:深度学习:神经网络中的前向传播和反向传播算法推导
举报原因:
原因补充:

(最多只允许输入30个字)