unsigned int minor=0;
struct class *cls;
struct device *dev;
struct cdev *cdev;
dev_t devno;//设备号
static int __init mycdev_init(void)
{
int ret;
//1.分配字符设备驱动对象空间
cdev=cdev_alloc();
if(cdev==NULL)
{
printk("申请字符设备驱动对象空间失败\n");
ret=-ENOMEM;
goto ERR1;
}
printk("申请字符设备驱动对象空间成功\n");
//2.初始化字符设备驱动对象
cdev_init(cdev,&fops);
//3.申请设备号
if(major==0)//动态申请设备号
{
ret=alloc_chrdev_region(&devno,minor,3,"myled");
if(ret)
{
printk("动态申请设备号失败\n");
goto ERR2;
}
//通过设备号获取主设备号和次设备号
major=MAJOR(devno);
minor=MINOR(devno);
}
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_create(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)
{
//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);
}
该代码段展示了在Linux内核中创建并初始化一个字符设备驱动的过程,包括动态或静态申请设备号、初始化cdev对象、注册设备驱动、创建设备节点,以及相应的错误处理和资源释放。
1097

被折叠的 条评论
为什么被折叠?



