#include <linux/init.h>
#include <linux/module.h>
#include <linux/fs.h>
#include <linux/cdev.h>
#if 0
unsigned int major=0;
#else
unsigned int major=500;
#endif
unsigned int minor=0;
struct class *cls;
struct device *dev;
struct cdev *cdev;
dev_t devno;
char kbuf[128]={0};
int mycdev_open(struct inode *inode, struct file *file)
{
printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);
return 0;
}
ssize_t mycdev_read(struct file *file, char *ubuf, size_t size, loff_t *lof)
{
printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);
unsigned long ret;
if(size>sizeof(kbuf))
{
size=sizeof(kbuf);
}
ret=copy_from_user(kbuf,ubuf,size);
if(ret)
{
printk("copy_to_user filed\n");
return ret;
}
return 0;
}
ssize_t mycdev_write(struct file *file,const char *ubuf, size_t size, loff_t *lof)
{
unsigned long ret;
if(size>sizeof(kbuf))
size=sizeof(kbuf);
ret=copy_from_user(kbuf,ubuf,size);
if(ret)
{
printk("copy_to_user fild\n");
return ret;
}
return 0;
}
int mycdev_close(struct inode *inode, struct file *file)
{
printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);
return 0;
}
struct file_operations fops={
.open=mycdev_open,
.read=mycdev_read,
.write=mycdev_write,
.release=mycdev_close
};
struct cdev *cdev;
static int __init mycdev_init(void)
{
int ret;
// 1.分配字符设备驱动对象空间
cdev = cdev_alloc();
if(cdev==NULL)
{
printk("驱动对象空间申请失败\n");
goto err1;
}
printk("驱动对象空间申请成功\n");
// 2.初始化字符设备驱动对象
cdev_init(cdev,&fops);
// 3.申请设备号
if(major==0)
{
if(ret){
ret=alloc_chrdev_region(&devno,minor,3,"myled");
printk("动态申请设备号失败\n");
goto err2;
}
major=MAJOR(devon);
major=MINOR(devon);
}
else if(major>0)
{
ret=register_chrdev_region(MKDEV(major,minor),3,"myled");
if(ret)
{
printk("静态指定设备号失败\n");
goto err2;
}
}
printk("申请设备号成功\n");
// 4.注册
ret=cdev_add(cdev,MKDEV(major,minor),3);
if(ret)
{
printk("注册字符设备驱动对象失败\n");
goto err3;
}
// 5.向上提交目录信息
cls = class_create(THIS_MODULE,"myled");
if(IS_ERR(cls))
{
printk("向上提交目录失败\n");
ret=PTR_ERR(cls);
goto err4;
}
printk("向上提交目录成功\n");
// 6.向上提交设备节点信息
int i;
for(i=0;i<3;i++)
{
dev=device_creat(cls,NULL,MKDEV(major,i),NULL,"myled%d,i");
if(IS_ERR(dev))
{
printk("向上提交设备信息失败\n");
ret=PTR_ERR(dev);
goto err5;
}
}
return 0;
err5:
for(--i;i>=0;i--){
device_destroy(cls,MKDEV(major,i));
}
class_destroy(cls);
err4:
cdev_del(cdev);
err3:
unregister_chrdev_region(MKDEV(major,minor),3);
err2:
kfree(cdev);
err1:
return ret;
}
static void __exit mycdev_exit(void)
{
printk(KERN_ERR "卸载模块\n");
// 1.注销设备节点信息结构体
int i;
for(i=0;i<3;i++){
device_destroy(cls,MKDEV(major,i));
}
// 2.注销目录结构体
class_destroy(cls);
// 3.注销字符设备驱动对象
cdev_del(cdev);
// 4.释放设备号
unregister_chrdev_region(MKDEV(major,minor),3);
// 5.释放对象空间
kfree(cdev);
}
module_init(mycdev_init);
module_exit(mycdev_exit);
//用于声明遵循GPL协议
MODULE_LICENSE("GPL");
字符设备驱动注册
最新推荐文章于 2024-07-16 08:11:57 发布