/*memdev.c*/
#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> /* access_ok */
#include "memdev.h"
//#define MEMDEV_SIZE 1000
static int 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;
}
/*IO操作*/
int memdev_ioctl(struct inode *inode, struct file *filp, unsigned int cmd, unsigned long arg)
{
int err = 0;
int ret = 0;
int ioarg = 0; /*用于 接收 和 发送 数据存放*/
/*抽取类型 和 编号 位字段 并拒绝错误的命令号*/
if(_IOC_TYPE(cmd) != MEMDEV_IOC_MAGIC)
return -EINVAL;
if(_IOC_NR(cmd) > MEMDEV_IOC_MAXNR)
return -EINVAL;
/*根据命令类型,检测参数空间是否可以访问*/
if(_IOC_DIR(cmd) & _IOC_READ)
err = !access_ok(VERIFY_WRITE, (void *)arg, _IOC_SIZE(cmd));
else if (_IOC_DIR(cmd) & _IOC_WRITE)
err = !access_ok(VERIFY_READ, (void *)arg, _IOC_SIZE(cmd));
if(err)
return -EFAULT;
/*根据命令,执行相应的操作*/
switch(cmd){
/*打印当前设备信息*/
case MEMDEV_IOCPRINT:
printk("<---CMD MEMDEV_IOPRINT DONE --->\n\n");
break;
/*获取参数*/
case MEMDEV_IOCGETDATA:
ioarg = 1101;
ret = __put_user(ioarg, (int *)arg);
break;
/*设置参数*/
case MEMDEV_IOCSETDATA:
ret = __get_user(ioarg, (int *)arg );
printk("<--- In Kernel MEMDEV_IOCSETDATA ioarg = %d -->\n\n",ioarg);
break;
default:
return -EINVAL;
}
return ret;
}
static ssize_t mem_read(struct file *file, char __user *buf, size_t size, loff_t *ppos)
{
unsigned long p = *ppos;
unsigned int count = size;
int ret = 0;
struct mem_dev *dev = file->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 byte(s) from %ld\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; /*p 为偏移地址*/
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;
/*从用户空间写入数据 dev->data 为基地址*/
if(copy_from_user(dev->data + p, buf, count))
ret = -EFAULT;
else{
*ppos += count;
ret = count;
printk(KERN_INFO"write %d byte(s) from %ld\n", count, p);
}
return ret;
}
/*seek 文件定位函数*/
static loff_t mem_llseek(struct file *filp, loff_t offset, int whence)
{
loff_t newpos;
switch(whence){
case 0: /*SEEK_SET*/
newpos = offset;
break;
case 1: /*SEEK_CUR*/
newpos = filp->f_pos + offset;
break;
case 2: /*SEEK_END*/
newpos = MEMDEV_SIZE - 1 + offset;
break;
default: /*can't happen*/
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,
.ioctl = memdev_ioctl,
};
static int memdev_init(void)
{
int result;
int i = 0;
dev_t devno = MKDEV(mem_major, 0);
/*静态申请设备号*/
if(mem_major)
result = register_chrdev_region(devno, 2, "memdev");
else{
result = alloc_chrdev_region(&devno, 0, 2, "memdev");
mem_major = MAJOR(devno);
}
if(result < 0)
return result;
/*初始化cdev机构*/
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("<0> memdev_init\n");
return 0;
fail_malloc:
unregister_chrdev_region(devno, i);
return result;
}
/*模块卸载函数*/
static void memdev_exit(void)
{
cdev_del(&cdev); /*注销设备*/
kfree(mem_devp); /*释放设备结构体内存*/
unregister_chrdev_region(MKDEV(mem_major, 0), 2);/*释放设备号*/
printk("<0>memdev_exit\n");
}
MODULE_AUTHOR("wenhui");
MODULE_LICENSE("GPL");
module_init(memdev_init);
module_exit(memdev_exit);
/*memdev.h*/
#ifndef _MEMDEV_H_
#define _MEMDEV_H_
#include <linux/ioctl.h>
#ifndef MEMDEV_MAJOR
#define MEMDEV_MAJOR 251 /*预设的mem的主设备号*/
#endif
#ifndef MEMDEV_NR_DEVS
#define MEMDEV_NR_DEVS 2 /*设备数*/
#endif
#ifndef MEMDEV_SIZE
#define MEMDEV_SIZE 4096
#endif
/*mem 设备描述机构体*/
struct mem_dev
{
char *data;
unsigned long size;
};
/*定义幻数*/
#define MEMDEV_IOC_MAGIC 'k'
/*定义命令*/
#define MEMDEV_IOCPRINT _IO(MEMDEV_IOC_MAGIC, 1)
#define MEMDEV_IOCGETDATA _IOR(MEMDEV_IOC_MAGIC, 2, int)
#define MEMDEV_IOCSETDATA _IOW(MEMDEV_IOC_MAGIC, 3, int)
#define MEMDEV_IOC_MAXNR 3
#endif /*_MEMDEV_H_ */
测试程序1:正在修改中
测试程序2:app-ioctl.c
/*app_ioctl.c*/
#include <stdio.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include "memdev.h"
int main(void)
{
int fd = 0;
int cmd;
int arg;
char Buf[4096];
/*打开设备文件*/
fd = open("/dev/memdev0",O_RDWR);
if(fd < 0){
printf("Open Dev memdev0 Error!\n");
return -1;
}
/*调用命令MEMDEV_IOCPRINT*/
printf("<-- Call MEMDEV_IOCPRINT --->\n");
cmd = MEMDEV_IOCPRINT;
if(ioctl(fd, cmd, &arg) < 0){
printf("Call cmd MEMDEV_IOCPRINT fail\n");
return -1;
}
/*调用命令MEMDEV_IOCSETDATA*/
printf("<-- Call MEMDEV_IOCSETDATA --->\n");
cmd = MEMDEV_IOCSETDATA;
arg = 2011;
if(ioctl(fd, cmd, &arg) < 0){
printf("Call cmd MEMDEV_IOCSETDATA fail\n");
return -1;
}
/*调用命令MEMDEV_IOCGETDATA*/
printf("<-- Call MEMDEV_IOCSETDATA --->\n");
cmd = MEMDEV_IOCGETDATA;
if(ioctl(fd, cmd, &arg) < 0){
printf("Call cmd MEMDEV_IOCSETDATA fail\n");
return -1;
}
printf("<--- In User Space MEMDEV_IOCGETDATA Get data is %d --->\n\n", arg);
close(fd);
return 0;
}