解惑一些关于Linux驱动代码的问题


大米饭
大米饭 2023-11-24 16:35:28 51001
分类专栏: 资讯
1. 前言

建议每一个 Linux 驱动工程师,都能瞄一眼本文。

 

之所以用 “瞄”,因此它很简单,几乎不需要花费心思就能理解。

之所有这建议,是因为它非常实用,可以解答一些困惑,可以使我们的代码变得简单、简洁。先看一个例子:

 /* drivers/media/platform/soc_camera/mx1_camera.c, line 695 */
static int __init mx1_camera_probe(struct platform_device *pdev)
{
...

res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
irq = platform_get_irq(pdev, 0);
if (!res || (int)irq <= 0) {
err = -ENODEV;
goto exit;
}

clk = clk_get(&pdev->dev, "csi_clk");
if (IS_ERR(clk)) {
err = PTR_ERR(clk);
goto exit;
}

pcdev = kzalloc(sizeof(*pcdev), GFP_KERNEL);
if (!pcdev) {
dev_err(&pdev->dev, "Could not allocate pcdev\n");
err = -ENOMEM;
goto exit_put_clk;
}

...

/*
* Request the regions.
*/
if (!request_mem_region(res->start, resource_size(res), DRIVER_NAME)) {
err = -EBUSY;
goto exit_kfree;
}

base = ioremap(res->start, resource_size(res));
if (!base) {
err = -ENOMEM;
goto exit_release;
}
...

/* request dma */
pcdev->dma_chan = imx_dma_request_by_prio(DRIVER_NAME, DMA_PRIO_HIGH);
if (pcdev->dma_chan < 0) {
dev_err(&pdev->dev, "Can't request DMA for MX1 CSI\n");
err = -EBUSY;
goto exit_iounmap;
}
...

/* request irq */
err = claim_fiq(&fh);
if (err) {
dev_err(&pdev->dev, "Camera interrupt register failed\n");
goto exit_free_dma;
}

...
err = soc_camera_host_register(&pcdev->soc_host);
if (err)
goto exit_free_irq;

dev_info(&pdev->dev, "MX1 Camera driver loaded\n");

return 0;

exit_free_irq:
disable_fiq(irq);
mxc_set_irq_fiq(irq, 0);
release_fiq(&fh);
exit_free_dma:
imx_dma_free(pcdev->dma_chan);
exit_iounmap:
iounmap(base);
exit_release:
release_mem_region(res->start, resource_size(res));
exit_kfree:
kfree(pcdev);
exit_put_clk:
clk_put(clk);
exit:
return err;
}

相信每一个写过 Linux driver 的工程师,都在 probe 函数中遇到过上面的困惑:要顺序申请多种资源(IRQ、Clock、memory、regions、ioremap、dma、等等),只要任意一种资源申请失败,就要回滚释放之前申请的所有资源。

于是函数的最后,一定会出现很多的 goto 标签(如上面的 exit_free_irq、exit_free_dma、等等),并在申请资源出错时,小心翼翼的 goto 到正确的标签上,以便释放已申请资源。

正像上面代码一样,整个函数被大段的、重复的 “if (condition) { err = xxx; goto xxx; }” 充斥,浪费精力,容易出错,不美观。有困惑,就有改善的余地,最终,Linux 设备模型借助 device resource management(设备资源管理),帮我们解决了这个问题。

就是:driver 你只管申请就行了,不用考虑释放,我设备模型帮你释放。最终,我们的 driver 可以这样写:

 static int __init mx1_camera_probe(struct platform_device *pdev)
{
...

res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
irq = platform_get_irq(pdev, 0);
if (!res || (int)irq <= 0) {
return -ENODEV;
}

clk = devm_clk_get(&pdev->dev, "csi_clk");
if (IS_ERR(clk)) {
return PTR_ERR(clk);
}

pcdev = devm_kzalloc(&pdev->dev, sizeof(*pcdev), GFP_KERNEL);
if (!pcdev) {
dev_err(&pdev->dev, "Could not allocate pcdev\n");
return -ENOMEM;
}

...

/*
* Request the regions.
*/
if (!devm_request_mem_region(&pdev->dev, res->start, resource_size(res), DRIVER_NAME)) {
return -EBUSY;
}

base = devm_ioremap(&pdev->dev, res->start, resource_size(res));
if (!base) {
return -ENOMEM;
}
...

/* request dma */
pcdev->dma_chan = imx_dma_request_by_prio(DRIVER_NAME, DMA_PRIO_HIGH);
if (pcdev->dma_chan < 0) {
dev_err(&pdev->dev, "Can't request DMA for MX1 CSI\n");
return -EBUSY;
}
...

/* request irq */
err = claim_fiq(&fh);
if (err) {
dev_err(&pdev->dev, "Camera interrupt register failed\n");
return err;
}

...
err = soc_camera_host_register(&pcdev->soc_host);
if (err)
return err;

dev_info(&pdev->dev, "MX1 Camera driver loaded\n");

return 0;
}

怎么做到呢?注意上面 “devm_” 开头的接口,答案就在那里。

不要再使用那些常规的资源申请接口,用 devm_xxx 的接口代替。为了保持兼容,这些新接口和旧接口的参数保持一致,只是名字前加了“devm_”,并多加一个 struct device 指针。

2. devm_xxx

下面列举一些常用的资源申请接口,它们由各个 framework(如 clock、regulator、gpio、等等)基于 device resource management 实现。

使用时,直接忽略 “devm_” 的前缀,后面剩下的部分,driver 工程师都很熟悉。只需记住一点,driver 可以只申请,不释放,设备模型会帮忙释放。

不过如果为了严谨,在 driver remove 时,可以主动释放(也有相应的接口,这里没有列出)。

 extern void *devm_kzalloc(struct device *dev, size_t size, gfp_t gfp);

void __iomem *devm_ioremap_resource(struct device *dev,
struct resource *res);
void __iomem *devm_ioremap(struct device *dev, resource_size_t offset,
unsigned long size);

struct clk *devm_clk_get(struct device *dev, const char *id);

int devm_gpio_request(struct device *dev, unsigned gpio,
const char *label);

static inline struct pinctrl * devm_pinctrl_get_select(
struct device *dev, const char *name)

static inline struct pwm_device *devm_pwm_get(struct device *dev,
const char *consumer);

struct regulator *devm_regulator_get(struct device *dev, const char *id);

static inline int devm_request_irq(struct device *dev, unsigned int irq,
irq_handler_t handler, unsigned long irqflags,
const char *devname, void *dev_id);

struct reset_control *devm_reset_control_get(struct device *dev,
const char *id);
3. 什么是 “设备资源”

一个设备能工作,需要依赖很多的外部条件,如供电、时钟等等,这些外部条件称作设备资源(device resouce)。对于现代计算机的体系结构,可能的资源包括:

a)power,供电。
b)clock,时钟。
c)memory,内存,在kernel中一般使用kzalloc分配。
d)GPIO,用户和CPU交换简单控制、状态等信息。
e)IRQ,触发中断。
f)DMA,无CPU参与情况下进行数据传输。
g)虚拟地址空间,一般使用ioremap、request_region等分配。
h)等等

而在 Linux kernel 的眼中,“资源” 的定义更为广义,比如 PWM、RTC、Reset,都可以抽象为资源,供 driver 使用。

在较早的 kernel 中,系统还不是特别复杂,且各个 framework 还没有成型,因此大多的资源都由 driver 自行维护。但随着系统复杂度的增加,driver 之间共用资源的情况越来越多,同时电源管理的需求也越来越迫切。于是 kernel 就将各个 resource 的管理权收回,基于 “device resource management” 的框架,由各个 framework 统一管理,包括分配和回收。

4. device resource management 的软件框架

图片

device resource management 位于 “drivers/base/devres.c” 中,它的实现非常简单,为什么呢?因为资源的种类有很多,表现形式也多种多样,而 devres 不可能一一知情,也就不能进行具体的分配和回收。因此,devres 能做的(也是它的唯一功能),就是:

提供一种机制,将系统中某个设备的所有资源,以链表的形式,组织起来,以便在 driver detach 的时候,自动释放。

而更为具体的事情,如怎么抽象某一种设备,则由上层的 framework 负责。

这些 framework 包括:regulator framework(管理 power 资源),clock framework(管理 clock 资源),interrupt framework(管理中断资源)、gpio framework(管理 gpio 资源),pwm framework(管理 PWM),等等。

其它的 driver,位于这些 framework 之上,使用它们提供的机制和接口,开发起来就非常方便了。

5. 代码分析
5.1 数据结构

先从 struct device 开始吧!该结构中有一个名称为 “devres_head” 的链表头,用于保存该设备申请的所有资源,如下:

 struct device {
...
spinlock_t devres_lock;
struct list_head devres_head;
...
}

那资源的数据结构呢?在 “drivers/base/devres.c” 中,名称为 struct devres,如下:

 struct devres {
struct devres_node node;
/* -- 3 pointers */
unsigned long long data[]; /* guarantee ull alignment */
};

咋一看非常简单,一个 struct devres_node 的变量 node,一个零长度数组 data,但其中有无穷奥妙,让我们继续分析。

node 用于将 devres 组织起来,方便插入到 device 结构的 devres_head 链表中,因此一定也有一个 list_head(见下面的 entry)。

另外,资源的存在形式到底是什么,device resource management 并不知情,因此需要上层模块提供一个 release 的回调函数,用于 release 资源,如下:

 struct devres_node {
struct list_head entry;
dr_release_t release;
#ifdef CONFIG_DEBUG_DEVRES
const char *name;
size_t size;
#endif
};

抛开用于 debug 的变量不说,也很简单,一个 entry list_head,一个 release 回调函数。看不出怎么抽象资源啊!别急,奥妙都在 data 这个零长度数组上面呢。

注 1:不知道您是否注意到,devres 有关的数据结构,是在 devres.c 中定义的(是 C 文件哦!)。换句话说,是对其它模块透明的。这真是优雅的设计(尽量屏蔽细节)!

5.2 一个无关话题:零长度数组

零长度数组的英文原名为 Arrays of Length Zero,是 GNU C 的规范,主要用途是用来作为结构体的最后一个成员,然后用它来访问此结构体对象之后的一段内存(通常是动态分配的内存)。什么意思呢?

以 struct devres 为例,node 变量的长度为 3 个指针的长度,而 struct devres 的长度也是 3 个指针的长度。而 data 只是一个标记,当有人分配了大于 3 个指针长度的空间并把它转换为 struct devres 类型的变量后,我们就可以通过 data 来访问多出来的 memory。

也就是说,有了零长度数组 data,struct devres 结构的长度可以不定,完全依赖于你分配的空间的大小。有什么用呢?

以本文的应用场景为例,多出来的、可通过 data 访问的空间,正是具体的 device resource 所占的空间。

资源的类型不同,占用的空间的多少也不同,但 devres 模块的主要功能又是释放资源所占的资源。

这是就是零长度数组的功能之一,因为整个 memory 空间是连续的,因此可以通过释 devres 指针,释放所有的空间,包括 data 所指的那片不定长度的、具体资源所用的空间。

零长度数组(data[0]),在不同的 C 版本中,有不同的实现方案,包括 1 长度数组(data[1])和不定长度数组(data[],本文所描述就是这一种),具体可参考 GCC 的规范:

https://gcc.gnu.org/onlinedocs/gcc/Zero-Length.html

5.3 向上层 framework 提供的接口:devres_alloc/devres_free、devres_add/devres_remove

先看一个使用 device resource management 的例子(IRQ 模块):

 /* include/linux/interrupt.h */
static inline int __must_check
devm_request_irq(struct device *dev, unsigned int irq, irq_handler_t handler,
unsigned long irqflags, const char *devname, void *dev_id)
{
return devm_request_threaded_irq(dev, irq, handler, NULL, irqflags,
devname, dev_id);
}


/* kernel/irq/devres.c */ int devm_request_threaded_irq(struct device *dev, unsigned int irq,
irq_handler_t handler, irq_handler_t thread_fn,
unsigned long irqflags, const char *devname,
void *dev_id)
{
struct irq_devres *dr;
int rc;

dr = devres_alloc(devm_irq_release, sizeof(struct irq_devres),
GFP_KERNEL);
if (!dr)
return -ENOMEM;

rc = request_threaded_irq(irq, handler, thread_fn, irqflags, devname,
dev_id);
if (rc) {
devres_free(dr);
return rc;
}

dr->irq = irq;
dr->dev_id = dev_id;
devres_add(dev, dr);

return 0;
}
EXPORT_SYMBOL(devm_request_threaded_irq);

void devm_free_irq(struct device *dev, unsigned int irq, void *dev_id)
{
struct irq_devres match_data = { irq, dev_id };

WARN_ON(devres_destroy(dev, devm_irq_release, devm_irq_match,
&match_data));
free_irq(irq, dev_id);
}
EXPORT_SYMBOL(devm_free_irq);

前面我们提过,上层的 IRQ framework,会提供两个和 request_irq/free_irq 基本兼容的接口,这两个接口的实现非常简单,就是在原有的实现之上,封装一层 devres 的操作,如要包括:

1)一个自定义的数据结构(struct irq_devres),用于保存和 resource 有关的信息(对中断来说,就是 IRQ num),如下:

 /*
* Device resource management aware IRQ request/free implementation.
*/
struct irq_devres {
unsigned int irq;
void *dev_id;
};

2)一个用于 release resource 的回调函数(这里的 release,和 memory 无关,例如 free IRQ),如下:

 static void devm_irq_release(struct device *dev, void *res)
{
struct irq_devres *this = res;

free_irq(this->irq, this->dev_id);
}

因为回调函数是由 devres 模块调用的,由它的参数可知,struct irq_devres 变量就是实际的 “资源”,但对 devres 而言,它并不知道该资源的实际形态,因而是 void 类型指针。也只有这样,devres 模块才可以统一的处理所有类型的资源。

3)以回调函数、resource 的 size 为参数,调用 devres_alloc 接口,为 resource 分配空间。该接口的定义如下:

 void * devres_alloc(dr_release_t release, size_t size, gfp_t gfp)
{
struct devres *dr;

dr = alloc_dr(release, size, gfp);
if (unlikely(!dr))
return NULL;
return dr->data;
}

调用 alloc_dr,分配一个 struct devres 类型的变量,并返回其中的 data 指针(5.2 小节讲过了,data 变量实际上是资源的代表)。alloc_dr 的定义如下:

 static __always_inline struct devres * alloc_dr(dr_release_t release,
size_t size, gfp_t gfp)
{
size_t tot_size = sizeof(struct devres) + size;
struct devres *dr;

dr = kmalloc_track_caller(tot_size, gfp);
if (unlikely(!dr))
return NULL;

memset(dr, 0, tot_size);
INIT_LIST_HEAD(&dr->node.entry);
dr->node.release = release;
return dr;
}

看第一句就可以了,在资源 size 之前,加一个 struct devres 的 size,就是 total 分配的空间。除去 struct devres 的,就是资源的(由 data 指针访问)。之后是初始化 struct devres 变量的 node。

4)调用原来的中断注册接口(这里是 request_threaded_irq),注册中断。该步骤和 device resource management 无关。

5)注册成功后,以设备指针(dev)和资源指针(dr)为参数,调用 devres_add,将资源添加到设备的资源链表头(devres_head)中,该接口定义如下:

 void devres_add(struct device *dev, void *res)
{
struct devres *dr = container_of(res, struct devres, data);
unsigned long flags;

spin_lock_irqsave(&dev->devres_lock, flags);
add_dr(dev, &dr->node);
spin_unlock_irqrestore(&dev->devres_lock, flags);
}

从资源指针中,取出完整的 struct devres 指针,调用 add_dr 接口。add_dr 也很简单,把 struct devres 指针挂到设备的 devres_head 中即可:

 static void add_dr(struct device *dev, struct devres_node *node)
{
devres_log(dev, node, "ADD");
BUG_ON(!list_empty(&node->entry));
list_add_tail(&node->entry, &dev->devres_head);
}

6)如果失败,可以通过 devres_free 接口释放资源占用的空间,devm_free_irq 接口中,会调用 devres_destroy 接口,将 devres 从 devres_head 中移除,并释放资源。这里就不详细描述了。

5.4 向设备模型提供的接口:devres_release_all

这里是重点,用于自动释放资源。

先回忆一下设备模型中 probe 的流程(可参考 “Linux 设备模型 (5)_device 和 device driver”),devres_release_all 接口被调用的时机有两个:

1)probe 失败时,调用过程为(就不详细的贴代码了):

__driver_attach/__device_attach-->driver_probe_device—>really_probe,really_probe 调用 driver 或者 bus 的 probe 接口,如果失败(返回值非零,可参考本文开头的例子),则会调用 devres_release_all。

2)deriver dettach 时(就是 driver remove 时)

driver_detach/bus_remove_device-->__device_release_driver-->devres_release_all

devres_release_all 的实现如下:

 int devres_release_all(struct device *dev)
{
unsigned long flags;

/* Looks like an uninitialized device structure */
if (WARN_ON(dev->devres_head.next == NULL))
return -ENODEV;
spin_lock_irqsave(&dev->devres_lock, flags);
return release_nodes(dev, dev->devres_head.next, &dev->devres_head,
flags);
}

以设备指针为参数,直接调用 release_nodes:

 static int release_nodes(struct device *dev, struct list_head *first,
struct list_head *end, unsigned long flags)
__releases(&dev->devres_lock)
{
LIST_HEAD(todo);
int cnt;
struct devres *dr, *tmp;

cnt = remove_nodes(dev, first, end, &todo);

spin_unlock_irqrestore(&dev->devres_lock, flags);

/* Release. Note that both devres and devres_group are
* handled as devres in the following loop. This is safe.
*/
list_for_each_entry_safe_reverse(dr, tmp, &todo, node.entry) {
devres_log(dev, &dr->node, "REL");
dr->node.release(dev, dr->data);
kfree(dr);
}

return cnt;
}

release_nodes 会先调用 remove_nodes,将设备所有的 struct devres 指针从设备的 devres_head 中移除。

然后,调用所有资源的 release 回调函数(如 5.3 小节描述的 devm_irq_release),回调函数会回收具体的资源(如 free_irq)。

最后,调用 free,释放 devres 以及资源所占的空间。


文章来源于网络,版权归原作者所有,如有侵权,请联系删除

网站声明:如果转载,请联系本站管理员。否则一切后果自行承担。

本文链接:https://www.xckfsq.com/news/show.html?id=28956
赞同 0
评论 0 条
大米饭L0
粉丝 0 发表 14 + 关注 私信
上周热门
如何使用 StarRocks 管理和优化数据湖中的数据?  2941
【软件正版化】软件正版化工作要点  2860
统信UOS试玩黑神话:悟空  2819
信刻光盘安全隔离与信息交换系统  2712
镜舟科技与中启乘数科技达成战略合作,共筑数据服务新生态  1246
grub引导程序无法找到指定设备和分区  1213
华为全联接大会2024丨软通动力分论坛精彩议程抢先看!  163
点击报名 | 京东2025校招进校行程预告  162
2024海洋能源产业融合发展论坛暨博览会同期活动-海洋能源与数字化智能化论坛成功举办  160
华为纯血鸿蒙正式版9月底见!但Mate 70的内情还得接着挖...  157
本周热议
我的信创开放社区兼职赚钱历程 40
今天你签到了吗? 27
信创开放社区邀请他人注册的具体步骤如下 15
如何玩转信创开放社区—从小白进阶到专家 15
方德桌面操作系统 14
我有15积分有什么用? 13
用抖音玩法闯信创开放社区——用平台宣传企业产品服务 13
如何让你先人一步获得悬赏问题信息?(创作者必看) 12
2024中国信创产业发展大会暨中国信息科技创新与应用博览会 9
中央国家机关政府采购中心:应当将CPU、操作系统符合安全可靠测评要求纳入采购需求 8

加入交流群

请使用微信扫一扫!