#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include "memdev.h"
static mem_major = MEMDEV_MAJOR;
module_param(mem_major, int, S_IRUGO);
struct mem_dev *mem_devp;
struct cdev cdev;
int mem_open(struct inode *inode, struct file *filp)
{
struct
mem_dev *dev;
int num =
MINOR(inode->i_rdev);
if (num
>= MEMDEV_NR_DEVS)
return -ENODEV;
dev =
&mem_devp[num]; //指明打开的哪一个设备
filp->private_data = dev;
return
0;
}
int mem_release(struct inode *inode, struct file *filp)
{
return 0;
}
static ssize_t mem_read(struct file *filp, char __user *buf, size_t
size, loff_t *ppos)
{
unsigned long p = *ppos;
unsigned int count = size;
int ret = 0;
struct mem_dev *dev = filp->private_data;
if (p >= MEMDEV_SIZE)
return
0;
if (count > MEMDEV_SIZE - p)
count =
MEMDEV_SIZE - p;
if (copy_to_user(buf, (void*)(dev->data + p),
count))
{
ret
= - EFAULT;
}
else
{
*ppos +=
count;
ret =
count;
printk(KERN_INFO "read %d bytes(s) from postion %d\n", count, p);
}
return ret;
}
static ssize_t mem_write(struct file *filp, const char __user *buf,
size_t size, loff_t *ppos)
{
unsigned long p = *ppos;
unsigned int count = size;
int ret = 0;
struct mem_dev *dev =
filp->private_data;
if (p >= MEMDEV_SIZE)
return
0;
if (count > MEMDEV_SIZE - p)
count =
MEMDEV_SIZE - p;
if (copy_from_user(dev->data + p, buf,
count))
ret
= - EFAULT;
else
{
*ppos +=
count;
ret =
count;
printk(KERN_INFO "written %d bytes(s) to postion %d\n", count,
p);
}
return ret;
}
static loff_t mem_llseek(struct file *filp, loff_t offset, int
whence)
{
loff_t
newpos;
switch(whence) {
case 0:
newpos = offset;
break;
case 1:
newpos = filp->f_pos + offset;
break;
case 2:
newpos = MEMDEV_SIZE -1 + offset;
break;
default:
return -EINVAL;
}
if
((newpos<0) || (newpos>MEMDEV_SIZE))
return -EINVAL;
filp->f_pos = newpos;
return
newpos;
}
static const struct file_operations mem_fops =
{
.owner = THIS_MODULE,
.llseek = mem_llseek,
.read = mem_read,
.write = mem_write,
.open = mem_open,
.release = mem_release,
};
static int memdev_init(void)
{
int result;
int i;
dev_t devno = MKDEV(mem_major, 0);
//只给出设备名 并没有给出次设备号
if (mem_major)
result =
register_chrdev_region(devno, MEMDEV_NR_DEVS, "memdev");
else {
result =
alloc_chrdev_region(&devno, 0, MEMDEV_NR_DEVS, "memdev");
mem_major =
MAJOR(devno);
} if (result < 0)
return
result;
cdev_init(&cdev, &mem_fops);
cdev.owner = THIS_MODULE;
cdev.ops = &mem_fops;
cdev_add(&cdev, MKDEV(mem_major, 0),
MEMDEV_NR_DEVS);
mem_devp = kmalloc(MEMDEV_NR_DEVS *
sizeof(struct mem_dev), GFP_KERNEL);
if
(!mem_devp) {
result
= - ENOMEM;
goto
fail_malloc;
}
memset(mem_devp, 0, sizeof(struct
mem_dev));
for (i=0; i < MEMDEV_NR_DEVS; i++)
{
mem_devp[i].size = MEMDEV_SIZE;
mem_devp[i].data = kmalloc(MEMDEV_SIZE, GFP_KERNEL);
memset(mem_devp[i].data, 0, MEMDEV_SIZE);
}
printk("memdev driver installed, with major
%d\n", mem_major);
printk("the device name is
%s\n","memdev");
return 0;
fail_malloc:
unregister_chrdev_region(devno, 1);
return result;
}
static void memdev_exit(void)
{
int i;
cdev_del(&cdev); for (i=0; i < MEMDEV_NR_DEVS; i++)
kfree(mem_devp[i].data);
kfree(mem_devp); unregister_chrdev_region(MKDEV(mem_major, 0),
2);
printk("memdev driver uninstalled\n");
}
MODULE_AUTHOR("kai");
MODULE_LICENSE("GPL");
module_init(memdev_init);
module_exit(memdev_exit);
测试程序:
#include
#include
int main()
{
FILE *fp0 = NULL;
char Buf[4096];
int result;
strcpy(Buf,"Mem is char dev!");
printf("BUF: %s\n",Buf);
//两个设备
fp0 = fopen("/dev/memdev0","r+");
if (fp0 == NULL)
{
perror("Open Memdev0
Error!\n");
return -1;
}
result = fwrite(Buf, sizeof(Buf), 1, fp0);
if (result == -1)
{
perror("fwrite
Error!\n");
return -1;
}
fseek(fp0,0,SEEK_SET);
strcpy(Buf,"Buf is NULL!");
printf("BUF: %s\n",Buf);
sleep(1);
result = fread(Buf, sizeof(Buf), 1, fp0);
if (result == -1)
{
perror("fread Error!\n");
return -1;
}
printf("BUF: %s\n",Buf);
return 0;
}