Linux common clock framework(3)_实现逻辑分析

转载于 : http://www.wowotech.net/pm_subsystem/clock_framework_core.html

1. 前言

前面两篇clock framework的分析文章,分别从clock consumerclock provider的角度,介绍了Linux kernel怎么管理系统的clock资源,以及device driver怎么使用clock资源。本文将深入到clock framework的内部,分析相关的实现逻辑。

注:本文使用的kernel版本为linux-3.10.29。虽然最新版本的kernel增加了一些内容,但主要逻辑没有改变,就不紧跟kernel的步伐了。

2. struct clk结构

到目前为止,我们还没有仔细介绍过struct clk这个代表了一个clock的数据结构呢。对consumer和provider来说,可以不关心,但对内部实现逻辑来说,就不得不提了:

   1: /* include/linux/clk-private.h */
   2: struct clk {
   3:         const char              *name;
   4:         const struct clk_ops    *ops;
   5:         struct clk_hw           *hw;
   6:         struct clk              *parent;
   7:         const char              **parent_names;
   8:         struct clk              **parents;
   9:         u8                      num_parents;
  10:         unsigned long           rate;
  11:         unsigned long           new_rate;
  12:         unsigned long           flags;
  13:         unsigned int            enable_count;
  14:         unsigned int            prepare_count;
  15:         struct hlist_head       children;
  16:         struct hlist_node       child_node;
  17:         unsigned int            notifier_count;
  18: #ifdef CONFIG_COMMON_CLK_DEBUG
  19:         struct dentry           *dentry;
  20: #endif
  21: };

name, ops, hw, parents_name, num_parents, flags, 可参考“Linux common clock framework(2)_clock provider”中的相关描述;

parent,保存了该clock当前的parent clock的struct clk指针;

parents,一个指针数组,保存了所有可能的parent clock的struct clk指针;

rate,当前的clock rate;

new_rate,新设置的clock rate,之所要保存在这里,是因为set rate过程中有一些中间计算,后面再详解;

enable_count, prepare_count,该clock被enable和prepare的次数,用于确保enable/disable以及prepare/unprepare的成对调用;

children,该clock的children clocks(孩儿们),以链表的形式组织;

child_node,一个list node,自己作为child时,挂到parent的children list时使用;

notifier_count,记录注册到notifier的个数。

3.  clock regitser/unregister

在“Linux common clock framework(2)_clock provider”中已经讲过,clock provider需要将系统的clock以tree的形式组织起来,分门别类,并在系统初始化时,通过provider的初始化接口,或者clock framework core的DTS接口,将所有的clock注册到kernel。

clock的注册,统一由clk_regitser接口实现,但基于该接口,kernel也提供了其它更为便利注册接口,下面将会一一描述。

3.1 clk_regitser

clk_register是所有register接口的共同实现,负责将clock注册到kernel,并返回代表该clock的struct clk指针。分析该接口之前,我们先看一下下面的内容:

   1: 1 F   f    clk_register      .\arch\arm\mach-at91\clock.c
   2:              int __init clk_register(struct clk *clk)
   3: 2 F   v    clk_register      .\arch\arm\mach-davinci\clock.c
   4:              EXPORT_SYMBOL(clk_register);
   5: 3 F   f    clk_register      .\arch\arm\mach-davinci\clock.c
   6:              int clk_register(struct clk *clk)
   7: 4 F   v    clk_register      .\arch\arm\mach-omap1\clock.c
   8:              EXPORT_SYMBOL(clk_register);
   9: 5 F   f    clk_register      .\arch\arm\mach-omap1\clock.c
  10:              int clk_register(struct clk *clk)
  11: 6 F   v    clk_register      .\arch\c6x\platforms\pll.c
  12:              EXPORT_SYMBOL(clk_register);
  13: 7 F   f    clk_register      .\arch\c6x\platforms\pll.c
  14:              int clk_register(struct clk *clk)
  15: 8 F   v    clk_register      .\arch\unicore32\kernel\clock.c
  16:              EXPORT_SYMBOL(clk_register);
  17: 9 F   f    clk_register      .\arch\unicore32\kernel\clock.c
  18:              int clk_register(struct clk *clk)
  19: 0 F   v    clk_register      .\drivers\clk\clk.c
  20:              EXPORT_SYMBOL_GPL(clk_register);
  21: 1 F   f    clk_register      .\drivers\clk\clk.c
  22:              struct clk *clk_register(struct device *dev, struct clk_hw *hw)
  23: 2 F   v    clk_register      .\drivers\sh\clk\core.c
  24:              EXPORT_SYMBOL_GPL(clk_register);
  25: 3 F   f    clk_register      .\drivers\sh\clk\core.c
  26:              int clk_register(struct clk *clk)

上面是kernel中clk_register接口可能的实现位置,由此可以看出,clk_register在“include/linux/clk-provider.h”中声明,却可能在不同的C文件中实现。其它clock API也类似。这说明了什么?

这恰恰呼应了“Linux common clock framework”中“common”一词。

在旧的kernel中,clock framework只是规定了一系列的API声明,具体API的实现,由各个machine代码完成。这就导致每个machine目录下,都有一个类似clock.c的文件,以比较相似的逻辑,实现clock provider的功能。显然,这里面有很多冗余代码。

后来,kernel将这些公共代码,以clock provider的形式(上面drivers/clk/clk.c文件)抽象出来,就成了我们所说的common clock framework。

后面所有的描述,都会以common clock  framework的核心代码为基础,其它的,就不再涉及了。

下面是clk_register的实现:

   1: /**
   2:  * clk_register - allocate a new clock, register it and return an opaque cookie
   3:  * @dev: device that is registering this clock
   4:  * @hw: link to hardware-specific clock data
   5:  *
   6:  * clk_register is the primary interface for populating the clock tree with new
   7:  * clock nodes.  It returns a pointer to the newly allocated struct clk which
   8:  * cannot be dereferenced by driver code but may be used in conjuction with the
   9:  * rest of the clock API.  In the event of an error clk_register will return an
  10:  * error code; drivers must test for an error code after calling clk_register.
  11:  */
  12: struct clk *clk_register(struct device *dev, struct clk_hw *hw)
  13: {
  14:     int i, ret;
  15:     struct clk *clk;
  16:  
  17:     clk = kzalloc(sizeof(*clk), GFP_KERNEL);
  18:     if (!clk) {
  19:         pr_err("%s: could not allocate clk\n", __func__);
  20:         ret = -ENOMEM;
  21:         goto fail_out;
  22:     }
  23:  
  24:     clk->name = kstrdup(hw->init->name, GFP_KERNEL);
  25:     if (!clk->name) {
  26:         pr_err("%s: could not allocate clk->name\n", __func__);
  27:         ret = -ENOMEM;
  28:         goto fail_name;
  29:     }
  30:     clk->ops = hw->init->ops;
  31:     if (dev && dev->driver)
  32:         clk->owner = dev->driver->owner;
  33:     clk->hw = hw;
  34:     clk->flags = hw->init->flags;
  35:     clk->num_parents = hw->init->num_parents;
  36:     hw->clk = clk;
  37:  
  38:     /* allocate local copy in case parent_names is __initdata */
  39:     clk->parent_names = kcalloc(clk->num_parents, sizeof(char *),
  40:                     GFP_KERNEL);
  41:  
  42:     if (!clk->parent_names) {
  43:         pr_err("%s: could not allocate clk->parent_names\n", __func__);
  44:         ret = -ENOMEM;
  45:         goto fail_parent_names;
  46:     }
  47:  
  48:  
  49:     /* copy each string name in case parent_names is __initdata */
  50:     for (i = 0; i < clk->num_parents; i++) {
  51:         clk->parent_names[i] = kstrdup(hw->init->parent_names[i],
  52:                         GFP_KERNEL);
  53:         if (!clk->parent_names[i]) {
  54:             pr_err("%s: could not copy parent_names\n", __func__);
  55:             ret = -ENOMEM;
  56:             goto fail_parent_names_copy;
  57:         }
  58:     }
  59:  
  60:     ret = __clk_init(dev, clk);
  61:     if (!ret)
  62:         return clk;
  63:  
  64: fail_parent_names_copy:
  65:     while (--i >= 0)
  66:         kfree(clk->parent_names[i]);
  67:     kfree(clk->parent_names);
  68: fail_parent_names:
  69:     kfree(clk->name);
  70: fail_name:
  71:     kfree(clk);
  72: fail_out:
  73:     return ERR_PTR(ret);
  74: }
  75: EXPORT_SYMBOL_GPL(clk_register);

该接口接受一个struct clk_hw指针,该指针包含了将要注册的clock的信息(具体可参考“Linux common clock framework(2)_clock provider”),在内部分配一个struct clk变量后,将clock信息保存在变量中,并返回给调用者。实现逻辑如下:

分配struct clk空间;

根据struct clk_hw指针提供的信息,初始化clk的name、ops、hw、flags、num_parents、parents_names等变量;

调用内部接口__clk_init,执行后续的初始化操作。这个接口包含了clk_regitser的主要逻辑,具体如下。

   1: /**
   2:  * __clk_init - initialize the data structures in a struct clk
   3:  * @dev:    device initializing this clk, placeholder for now
   4:  * @clk:    clk being initialized
   5:  *
   6:  * Initializes the lists in struct clk, queries the hardware for the
   7:  * parent and rate and sets them both.
   8:  */
   9: int __clk_init(struct device *dev, struct clk *clk)
  10: {
  11:     int i, ret = 0;
  12:     struct clk *orphan;
  13:     struct hlist_node *tmp2;
  14:  
  15:     if (!clk)
  16:         return -EINVAL;
  17:  
  18:     clk_prepare_lock();
  19:  
  20:     /* check to see if a clock with this name is already registered */
  21:     if (__clk_lookup(clk->name)) {
  22:         pr_debug("%s: clk %s already initialized\n",
  23:                 __func__, clk->name);
  24:         ret = -EEXIST;
  25:         goto out;
  26:     }
  27:  
  28:     /* check that clk_ops are sane.  See Documentation/clk.txt */
  29:     if (clk->ops->set_rate &&
  30:             !(clk->ops->round_rate && clk->ops->recalc_rate)) {
  31:         pr_warning("%s: %s must implement .round_rate & .recalc_rate\n",
  32:                 __func__, clk->name);
  33:         ret = -EINVAL;
  34:         goto out;
  35:     }
  36:  
  37:     if (clk->ops->set_parent && !clk->ops->get_parent) {
  38:         pr_warning("%s: %s must implement .get_parent & .set_parent\n",
  39:                 __func__, clk->name);
  40:         ret = -EINVAL;
  41:         goto out;
  42:     }
  43:  
  44:     /* throw a WARN if any entries in parent_names are NULL */
  45:     for (i = 0; i < clk->num_parents; i++)
  46:         WARN(!clk->parent_names[i],
  47:                 "%s: invalid NULL in %s's .parent_names\n",
  48:                 __func__, clk->name);
  49:  
  50:     /*
  51:      * Allocate an array of struct clk *'s to avoid unnecessary string
  52:      * look-ups of clk's possible parents.  This can fail for clocks passed
  53:      * in to clk_init during early boot; thus any access to clk->parents[]
  54:      * must always check for a NULL pointer and try to populate it if
  55:      * necessary.
  56:      *
  57:      * If clk->parents is not NULL we skip this entire block.  This allows
  58:      * for clock drivers to statically initialize clk->parents.
  59:      */
  60:     if (clk->num_parents > 1 && !clk->parents) {
  61:         clk->parents = kzalloc((sizeof(struct clk*) * clk->num_parents),
  62:                 GFP_KERNEL);
  63:         /*
  64:          * __clk_lookup returns NULL for parents that have not been
  65:          * clk_init'd; thus any access to clk->parents[] must check
  66:          * for a NULL pointer.  We can always perform lazy lookups for
  67:          * missing parents later on.
  68:          */
  69:         if (clk->parents)
  70:             for (i = 0; i < clk->num_parents; i++)
  71:                 clk->parents[i] =
  72:                     __clk_lookup(clk->parent_names[i]);
  73:     }
  74:  
  75:     clk->parent = __clk_init_parent(clk);
  76:  
  77:     /*
  78:      * Populate clk->parent if parent has already been __clk_init'd.  If
  79:      * parent has not yet been __clk_init'd then place clk in the orphan
  80:      * list.  If clk has set the CLK_IS_ROOT flag then place it in the root
  81:      * clk list.
  82:      *
  83:      * Every time a new clk is clk_init'd then we walk the list of orphan
  84:      * clocks and re-parent any that are children of the clock currently
  85:      * being clk_init'd.
  86:      */
  87:     if (clk->parent)
  88:         hlist_add_head(&clk->child_node,
  89:                 &clk->parent->children);
  90:     else if (clk->flags & CLK_IS_ROOT)
  91:         hlist_add_head(&clk->child_node, &clk_root_list);
  92:     else
  93:         hlist_add_head(&clk->child_node, &clk_orphan_list);
  94:  
  95:     /*
  96:      * Set clk's rate.  The preferred method is to use .recalc_rate.  For
  97:      * simple clocks and lazy developers the default fallback is to use the
  98:      * parent's rate.  If a clock doesn't have a parent (or is orphaned)
  99:      * then rate is set to zero.
 100:      */
 101:     if (clk->ops->recalc_rate)
 102:         clk->rate = clk->ops->recalc_rate(clk->hw,
 103:                 __clk_get_rate(clk->parent));
 104:     else if (clk->parent)
 105:         clk->rate = clk->parent->rate;
 106:     else
 107:         clk->rate = 0;
 108:  
 109:     /*
 110:      * walk the list of orphan clocks and reparent any that are children of
 111:      * this clock
 112:      */
 113:     hlist_for_each_entry_safe(orphan, tmp2, &clk_orphan_list, child_node) {
 114:         if (orphan->ops->get_parent) {
 115:             i = orphan->ops->get_parent(orphan->hw);
 116:             if (!strcmp(clk->name, orphan->parent_names[i]))
 117:                 __clk_reparent(orphan, clk);
 118:             continue;
 119:         }
 120:  
 121:         for (i = 0; i < orphan->num_parents; i++)
 122:             if (!strcmp(clk->name, orphan->parent_names[i])) {
 123:                 __clk_reparent(orphan, clk);
 124:                 break;
 125:             }
 126:      }
 127:  
 128:     /*
 129:      * optional platform-specific magic
 130:      *
 131:      * The .init callback is not used by any of the basic clock types, but
 132:      * exists for weird hardware that must perform initialization magic.
 133:      * Please consider other ways of solving initialization problems before
 134:      * using this callback, as it's use is discouraged.
 135:      */
 136:     if (clk->ops->init)
 137:         clk->ops->init(clk->hw);
 138:  
 139:     clk_debug_register(clk);
 140:  
 141: out:
 142:     clk_prepare_unlock();
 143:  
 144:     return ret;
 145: }

__clk_init接口的实现相当繁琐,做的事情包括:

20~26行,以clock name为参数,调用__clk_lookup接口,查找是否已有相同name的clock注册,如果有,则返回错误。由此可以看出,clock framework以name唯一识别一个clock,因此不能有同名的clock存在;

28~42行,检查clk ops的完整性,例如:如果提供了set_rate接口,就必须提供round_rate和recalc_rate接口;如果提供了set_parent,就必须提供get_parent。这些逻辑背后的含义,会在后面相应的地方详细描述;

50~73行,分配一个struct clk *类型的数组,缓存该clock的parents clock。具体方法是根据parents_name,查找相应的struct clk指针;

75行,获取当前的parent clock,并将其保存在parent指针中。具体可参考下面“说明2”;

77~93行,根据该clock的特性,将它添加到clk_root_list、clk_orphan_list或者parent->children三个链表中的一个,具体请参考下面“说明1”;

95~107行,计算clock的初始rate,具体请参考下面“说明3”;

109~126行,尝试reparent当前所有的孤儿(orphan)clock,具体请参考下面“说明4”;

128~137行,如果clock ops提供了init接口,执行之(由注释可知,kernel不建议提供init接口)。

上面的clock init流程,有下面4点补充说明:

说明1:clock的管理和查询

clock framework有2条全局的链表:clk_root_list和clk_orphan_list。所有设置了CLK_IS_ROOT属性的clock都会挂在clk_root_list中。其它clock,如果有valid的parent ,则会挂到parent的“children”链表中,如果没有valid的parent,则会挂到clk_orphan_list中。

查询时(__clk_lookup接口做的事情),依次搜索:clk_root_list-->root_clk-->children-->child's children,clk_orphan_list-->orphan_clk-->children-->child's children,即可。

说明2:当前parent clock的选择(__clk_init_parent)

对于没有parent,或者只有1个parent 的clock来说,比较简单,设置为NULL,或者根据parent name获得parent的struct clk指针接。

对于有多个parent的clock,就必须提供.get_parent ops,该ops要根据当前硬件的配置情况,例如寄存器值,返回当前所有使用的parent的index(即第几个parent)。然后根据index,取出对应parent clock的struct clk指针,作为当前的parent。

说明3:clock的初始rate计算

对于提供.recalc_rate ops的clock来说,优先使用该ops获取初始的rate。如果没有提供,退而求其次,直接使用parent clock的rate。最后,如果该clock没有parent,则初始的rate只能选择为0。

.recalc_rate ops的功能,是以parent clock的rate为输入参数,根据当前硬件的配置情况,如寄存器值,计算获得自身的rate值。

说明4:orphan clocks的reparent

有些情况下,child clock会先于parent clock注册,此时该child就会成为orphan clock,被收养在clk_orphan_list中。

而每当新的clock注册时,kernel都会检查这个clock是否是某个orphan的parent,如果是,就把这个orphan从clk_orphan_list中移除,放到新注册的clock的怀抱。这就是reparent的功能,它的处理逻辑是:

a) 遍历orphan list,如果orphan提供了.get_parent ops,则通过该ops得到当前parent的index,并从parent_names中取出该parent的name,然后和新注册的clock name比较,如果相同,呵呵,找到parent了,执行__clk_reparent,进行后续的操作。

b) 如果没有提供.get_parent ops,只能遍历自己的parent_names,检查是否有和新注册clock匹配的,如果有,执行__clk_reparent,进行后续的操作。

c) __clk_reparent会把这个orphan从clk_orphan_list中移除,并挂到新注册的clock上。然后调用__clk_recalc_rates,重新计算自己以及自己所有children的rate。计算过程和上面的clock rate设置类似。

3.2 clk_unregister/devm_clk_register/devm_clk_unregister

clock的regitser和init,几乎占了clock framework大部分的实现逻辑。clk_unregister是regitser接口的反操作,不过当前没有实现(不需要)。而devm_clk_register/devm_clk_unregister则是clk_register/clk_unregister的device resource manager版本。

3.3 fixed rate clock的注册

“Linux common clock framework(2)_clock provider”中已经对fixed rate clock有过详细的介绍,这种类型的clock有两种注册方式,通过API注册和通过DTS注册,具体的实现位于“drivers/clk/clk-fixed-rate.c”中,介绍如下。

1)通过API注册

   1: struct clk *clk_register_fixed_rate(struct device *dev, const char *name,
   2:                 const char *parent_name, unsigned long flags,
   3:                 unsigned long fixed_rate)
   4: {
   5:         struct clk_fixed_rate *fixed;
   6:         struct clk *clk;
   7:         struct clk_init_data init;
   8:  
   9:         /* allocate fixed-rate clock */
  10:         fixed = kzalloc(sizeof(struct clk_fixed_rate), GFP_KERNEL);
  11:         if (!fixed) {
  12:                 pr_err("%s: could not allocate fixed clk\n", __func__);
  13:                 return ERR_PTR(-ENOMEM);
  14:         }
  15:  
  16:         init.name = name;
  17:         init.ops = &clk_fixed_rate_ops;
  18:         init.flags = flags | CLK_IS_BASIC;
  19:         init.parent_names = (parent_name ? &parent_name: NULL);
  20:         init.num_parents = (parent_name ? 1 : 0);
  21:  
  22:         /* struct clk_fixed_rate assignments */
  23:         fixed->fixed_rate = fixed_rate;
  24:         fixed->hw.init = &init;
  25:  
  26:         /* register the clock */
  27:         clk = clk_register(dev, &fixed->hw);
  28:  
  29:         if (IS_ERR(clk))
  30:                 kfree(fixed);
  31:  
  32:         return clk;
  33: }

clk_register_fixed_rate API用于注册fixed rate clock,它接收传入的name、parent_name、flags、fixed_rate等参数,并转换为struct clk_hw结构,最终调用clk_register接口,注册clock。大致的逻辑如下:

16~20行,定义一个struct clk_init_data类型的变量(init),并根据传入的参数以及fixed rate clock的特性,初始化该变量;

22~30行,分配一个私有的数据结构(struct clk_fixed_rate),并将init的指针保存在其中,最后调用clk_regitser注册该clock。

说明1:struct clk_init_data类型的变量

struct clk_init_data类型的变量(init),是一个局部变量,传递给clk_regitser使用时,用的是它的指针,说明了什么?说明该变量不会再后面使用了。再回忆一下clk_regitser的实现逻辑,会把所有的信息copy一遍,这里就好理解了。后面其它类型的clock注册时,道理相同。

说明2:fixed rate clock的实现思路

私有数据结构的定义如下:

   1: struct clk_fixed_rate {
   2:         struct          clk_hw hw;
   3:         unsigned long   fixed_rate;
   4:         u8              flags;
   5: };

包含一个struct clk_hw变量,用于clk_regitser。另外两个变量,则为该类型clock特有的属性。私有数据结构变量(fixed)是通过kzalloc分配的,说明后续还需要使用。那怎么用呢?

由clk_regitser的实现可知,fixed rate clock注册时hw);>,把fixed指针中hw变量的地址保存在了struct clk指针中了。因此,在任何时候,通过struct clk指针(clock的代表),就可以找到所对应clock的struct clk_hw指针,从而可以找到相应的私有变量(fixed)的指针以及其中的私有数据。

基于此,fixed rate ops的实现就顺利成章了:

   1: #define to_clk_fixed_rate(_hw) container_of(_hw, struct clk_fixed_rate, hw)
   2:  
   3: static unsigned long clk_fixed_rate_recalc_rate(struct clk_hw *hw,
   4:                 unsigned long parent_rate)
   5: {
   6:         return to_clk_fixed_rate(hw)->fixed_rate;
   7: }
   8:  
   9: const struct clk_ops clk_fixed_rate_ops = {
  10:         .recalc_rate = clk_fixed_rate_recalc_rate,
  11: };
  12: EXPORT_SYMBOL_GPL(clk_fixed_rate_ops);

 

2)通过DTS注册

fixed rate clock是非常简单的一种clock,因而可以直接通过DTS的形式注册,clock framework负责解析DTS,并调用API注册clock,如下:

   1: #ifdef CONFIG_OF
   2: /**
   3:  * of_fixed_clk_setup() - Setup function for simple fixed rate clock
   4:  */
   5: void of_fixed_clk_setup(struct device_node *node)
   6: {
   7:         struct clk *clk;
   8:         const char *clk_name = node->name;
   9:         u32 rate;
  10:  
  11:         if (of_property_read_u32(node, "clock-frequency", &rate))
  12:                 return;
  13:  
  14:         of_property_read_string(node, "clock-output-names", &clk_name);
  15:  
  16:         clk = clk_register_fixed_rate(NULL, clk_name, NULL, CLK_IS_ROOT, rate);
  17:         if (!IS_ERR(clk))
  18:                 of_clk_add_provider(node, of_clk_src_simple_get, clk);
  19: }
  20: EXPORT_SYMBOL_GPL(of_fixed_clk_setup);
  21: CLK_OF_DECLARE(fixed_clk, "fixed-clock", of_fixed_clk_setup);
  22: #endif

首先看一下CLK_OF_DECLARE宏,它的定义位于“include/linux/clk-provider.h”中,负责在指定的section中(以__clk_of_table开始的位置),定义struct of_device_id类型的变量,并由of_clk_init接口解析、匹配,如果匹配成功,则执行相应的回调函数(这里为of_fixed_clk_setup);

初始化的时候,device tree负责读取DTS,并和这些变量的名字(这里为"fixed-clock")匹配,如果匹配成功,则执行相应的回调函数(这里为of_fixed_clk_setup);

of_fixed_clk_setup会解析两个DTS字段"clock-frequency"和"clock-output-names",然后调用clk_register_fixed_rate,注册clock。注意,注册时的flags为CLK_IS_ROOT,说明目前只支持ROOT类型的clock通过DTS注册;

最后,调用of_clk_add_provider接口,将该clock添加到provider list中,方便后续的查找使用。该接口会在后面再详细介绍。

of_clk_init负责从DTS中扫描并初始化clock provider,如下:

   1: /* drivers/clk/clk.c */
   2: /**
   3:  * of_clk_init() - Scan and init clock providers from the DT
   4:  * @matches: array of compatible values and init functions for providers.
   5:  *
   6:  * This function scans the device tree for matching clock providers and
   7:  * calls their initialization functions
   8:  */
   9: void __init of_clk_init(const struct of_device_id *matches)
  10: {
  11:         struct device_node *np;
  12:  
  13:         if (!matches)
  14:                 matches = __clk_of_table;
  15:  
  16:         for_each_matching_node(np, matches) {
  17:                 const struct of_device_id *match = of_match_node(matches, np);
  18:                 of_clk_init_cb_t clk_init_cb = match->data;
  19:                 clk_init_cb(np);
  20:         }
  21: }

该接口有一个输入参数,用于指定需要扫描的OF id,如果留空,则会扫描__clk_of_table,就是通过CLK_OF_DECLARE宏指定的fixed rate等类型的clock。

在最新的kernel中,会在初始化代码(time_init)中以NULL为参数调用一次of_clk_init,以便自动匹配并初始化DTS中的描述的类似fixed rate的clock。

注2:这里使用大量篇幅描述一个简单的fixed rate clock的注册方式,主要目的是给大家介绍一种通用的实现方式,或者说通用思路。后面其它类型的clock,包括我们自定义的类型,实现方法都是一样的。这里就不罗嗦了,大家看代码就可以了。

3.4 gate、devider、mux、fixed factor、composite以及自定义类型clock的注册

和fixed rate类似,不再一一说明。

4. 通用API的实现

4.1 clock get

clock get是通过clock名称获取struct clk指针的过程,由clk_get、devm_clk_get、clk_get_sys、of_clk_get、of_clk_get_by_name、of_clk_get_from_provider等接口负责实现,这里以clk_get为例,分析其实现过程(位于drivers/clk/clkdev.c中)。

1)clk_get

   1: struct clk *clk_get(struct device *dev, const char *con_id)
   2: {
   3:         const char *dev_id = dev ? dev_name(dev) : NULL;
   4:         struct clk *clk;
   5:  
   6:         if (dev) {
   7:                 clk = of_clk_get_by_name(dev->of_node, con_id);
   8:                 if (!IS_ERR(clk) && __clk_get(clk))
   9:                         return clk;
  10:         }
  11:  
  12:         return clk_get_sys(dev_id, con_id);
  13: }

如果提供了struct device指针,则调用of_clk_get_by_name接口,通过device tree接口获取clock指针。否则,如果没有提供设备指针,或者通过device tree不能正确获取clock,则进一步调用clk_get_sys。

这两个接口的定义如下。

2) of_clk_get_by_name

我们在“Linux common clock framework(2)_clock provider”中已经提过,clock consumer会在本设备的DTS中,以clocks、clock-names为关键字,定义所需的clock。系统启动后,device tree会简单的解析,以struct device_node指针的形式,保存在本设备的of_node变量中。

而of_clk_get_by_name,就是通过扫描所有“clock-names”中的值,和传入的name比较,如果相同,获得它的index(即“clock-names”中的第几个),调用of_clk_get,取得clock指针。

   1: struct clk *of_clk_get_by_name(struct device_node *np, const char *name)
   2: {
   3:         struct clk *clk = ERR_PTR(-ENOENT);
   4:  
   5:         /* Walk up the tree of devices looking for a clock that matches */
   6:         while (np) {
   7:                 int index = 0;
   8:  
   9:                 /*
  10:                  * For named clocks, first look up the name in the
  11:                  * "clock-names" property.  If it cannot be found, then
  12:                  * index will be an error code, and of_clk_get() will fail.
  13:                  */
  14:                 if (name)
  15:                         index = of_property_match_string(np, "clock-names", name);
  16:                 clk = of_clk_get(np, index);
  17:                 if (!IS_ERR(clk))
  18:                         break;
  19:                 else if (name && index >= 0) {
  20:                         pr_err("ERROR: could not get clock %s:%s(%i)\n",
  21:                                 np->full_name, name ? name : "", index);
  22:                         return clk;
  23:                 }
  24:  
  25:                 /*
  26:                  * No matching clock found on this node.  If the parent node
  27:                  * has a "clock-ranges" property, then we can try one of its
  28:                  * clocks.
  29:                  */
  30:                 np = np->parent;
  31:                 if (np && !of_get_property(np, "clock-ranges", NULL))
  32:                         break;
  33:         }
  34:  
  35:         return clk;
  36: }

6~33行,是一个while循环,用于扫描所有的device_node;

14~15行,只要name不为空,管它三七二十一,直接以name为参数,去和“clock-names”匹配,获得一个index;

16~18行,以返回的index为参数,调用of_clk_get。这个index可能是invalid,不过无所谓,最糟糕就是不能获得clock指针。如果成功获取,则退出,或者继续;

19~22行,一个警告,如果name和index均合法,但是不能获得指针,则视为异常状况;

25~32行,尝试”clock-ranges“熟悉,比较冷门,不介绍它。

再看一下of_clk_get接口。

   1: struct clk *of_clk_get(struct device_node *np, int index)
   2: {
   3:         struct of_phandle_args clkspec;
   4:         struct clk *clk;
   5:         int rc;
   6:  
   7:         if (index < 0)
   8:                 return ERR_PTR(-EINVAL);
   9:  
  10:         rc = of_parse_phandle_with_args(np, "clocks", "#clock-cells", index,
  11:                                         &clkspec);
  12:         if (rc)
  13:                 return ERR_PTR(rc);
  14:  
  15:         clk = of_clk_get_from_provider(&clkspec);
  16:         of_node_put(clkspec.np);
  17:         return clk;
  18: }

10~13行,通过of_parse_phandle_with_args接口,将index转换为struct of_phandle_args类型的参数句柄;

15行,调用of_clk_get_from_provider,获取clock指针。

of_clk_get_from_provider的实现位于drivers/clk/clk.c,通过便利of_clk_providers链表,并调用每一个provider的get回调函数,获取clock指针。如下:

   1: struct clk *of_clk_get_from_provider(struct of_phandle_args *clkspec)
   2: {
   3:         struct of_clk_provider *provider;
   4:         struct clk *clk = ERR_PTR(-ENOENT);
   5:  
   6:         /* Check if we have such a provider in our array */
   7:         mutex_lock(&of_clk_lock);
   8:         list_for_each_entry(provider, &of_clk_providers, link) {
   9:                 if (provider->node == clkspec->np)
  10:                         clk = provider->get(clkspec, provider->data);
  11:                 if (!IS_ERR(clk))
  12:                         break;
  13:         }
  14:         mutex_unlock(&of_clk_lock);
  15:  
  16:         return clk;
  17: }

 

注3:分析到这里之后,consumer侧的获取流程已经很清晰,再结合“Linux common clock framework(2)_clock provider”中所介绍的of_clk_add_provider接口,整个流程都融汇贯通了。篇幅所限,有关of_clk_add_provider接口的实现,本文就不再分析了,感兴趣的读者可以自行阅读kernel代码。

3)clk_get_sys

clk_get_sys接口是在调用者没有提供struct device指针或者通过of_clk_get_xxx获取clock失败时,获取clock指针的另一种手段。基于kernel大力推行device tree的现状,蜗蜗不建议使用这种过时的手段,就不分析了。

4.2 clk_prepare/clk_unprepare

prepare和unprepare的的代码位于drivers/clk/clk.c中,分别由内部接口__clk_prepare和__clk_unprepare实现具体动作,如下:

   1: int __clk_prepare(struct clk *clk)
   2: {
   3:         int ret = 0;
   4:  
   5:         if (!clk)
   6:                 return 0;
   7:  
   8:         if (clk->prepare_count == 0) {
   9:                 ret = __clk_prepare(clk->parent);
  10:                 if (ret)
  11:                         return ret;
  12:  
  13:                 if (clk->ops->prepare) {
  14:                         ret = clk->ops->prepare(clk->hw);
  15:                         if (ret) {
  16:                                 __clk_unprepare(clk->parent);
  17:                                 return ret;
  18:                         }
  19:                 }
  20:         }
  21:  
  22:         clk->prepare_count++;
  23:  
  24:         return 0;
  25: }

prepare会维护一个prepare_count,用于记录prepare的次数。且在prepare_count为零时:

递归prepare自己的parent(有的话);

调用clk ops中的prepare回调函数(有的话)。

unprepare类似,不再分析。

4.3 clk_enable/clk_disable

enable/disable和prepare/unprepare的实现逻辑基本一致,需要注意的是,enable/disable时如果prepare_count为0,则会报错并返回。

4.4 clock rate有关的实现

clock rate有关的实现包括get、set和round三类,让我们依次说明。

1)clk_get_rate负责获取某个clock的当前rate,代码如下:

   1: /**
   2:  * clk_get_rate - return the rate of clk
   3:  * @clk: the clk whose rate is being returned
   4:  *
   5:  * Simply returns the cached rate of the clk, unless CLK_GET_RATE_NOCACHE flag
   6:  * is set, which means a recalc_rate will be issued.
   7:  * If clk is NULL then returns 0.
   8:  */
   9: unsigned long clk_get_rate(struct clk *clk)
  10: {
  11:         unsigned long rate;
  12:  
  13:         clk_prepare_lock();
  14:  
  15:         if (clk && (clk->flags & CLK_GET_RATE_NOCACHE))
  16:                 __clk_recalc_rates(clk, 0);
  17:  
  18:         rate = __clk_get_rate(clk);
  19:         clk_prepare_unlock();
  20:  
  21:         return rate;
  22: }
  23: EXPORT_SYMBOL_GPL(clk_get_rate);

a)如果该clock设置了CLK_GET_RATE_NOCACHE标志,获取rate前需要先调用__clk_recalc_rates接口,根据当前硬件的实际情况,重新计算rate。 
__clk_recalc_rates的逻辑是:如果提供了recalc_rate ops,以parent clock的rate为参数,调用该ops,否则,直接获取parent的clock值;然后,递归recalc所有child clock。

b)调用__clk_get_rate返回实际的rate值。

2)clk_round_rate,返回该clock支持的,和输入rate最接近的rate值(不做任何改动),实际是由内部函数__clk_round_rate实现,代码如下:

   1: unsigned long __clk_round_rate(struct clk *clk, unsigned long rate)
   2: {
   3:         unsigned long parent_rate = 0;
   4:  
   5:         if (!clk)
   6:                 return 0;
   7:  
   8:         if (!clk->ops->round_rate) {
   9:                 if (clk->flags & CLK_SET_RATE_PARENT)
  10:                         return __clk_round_rate(clk->parent, rate);
  11:                 else
  12:                         return clk->rate;
  13:         }
  14:  
  15:         if (clk->parent)
  16:                 parent_rate = clk->parent->rate;
  17:  
  18:         return clk->ops->round_rate(clk->hw, rate, &parent_rate);
  19: }

a)18行,如果该clock提供了round_rate ops,直接调用该ops。

需要说明的是,round_rate ops接受两个参数,一个是需要round的rate,另一个时parent rate(以指针的形式提供)。它的意义是,对有些clock来说,如果需要得到一个比较接近的值,需要同时round parent clock,因此会在该指针中返回round后的parent clock。

b)9~10行,如果clock没有提供round_rate ops,且设置了CLK_SET_RATE_PARENT标志,则递归round parent clock,背后的思考是,直接使用parent clock所能提供的最接近的rate。

c)11~12,最后一种情况,直接返回原值,意味着无法round。

3)clk_set_rate

set rate的逻辑比较复杂,代码如下:

   1: int clk_set_rate(struct clk *clk, unsigned long rate)
   2: {
   3:         struct clk *top, *fail_clk;
   4:         int ret = 0;
   5:  
   6:         /* prevent racing with updates to the clock topology */
   7:         clk_prepare_lock();
   8:  
   9:         /* bail early if nothing to do */
  10:         if (rate == clk->rate)
  11:                 goto out;
  12:  
  13:         if ((clk->flags & CLK_SET_RATE_GATE) && clk->prepare_count) {
  14:                 ret = -EBUSY;
  15:                 goto out;
  16:         }
  17:  
  18:         /* calculate new rates and get the topmost changed clock */
  19:         top = clk_calc_new_rates(clk, rate);
  20:         if (!top) {
  21:                 ret = -EINVAL;
  22:                 goto out;
  23:         }
  24:  
  25:         /* notify that we are about to change rates */
  26:         fail_clk = clk_propagate_rate_change(top, PRE_RATE_CHANGE);
  27:         if (fail_clk) {
  28:                 pr_warn("%s: failed to set %s rate\n", __func__,
  29:                                 fail_clk->name);
  30:                 clk_propagate_rate_change(top, ABORT_RATE_CHANGE);
  31:                 ret = -EBUSY;
  32:                 goto out;
  33:         }
  34:  
  35:         /* change the rates */
  36:         clk_change_rate(top);
  37:  
  38: out:
  39:         clk_prepare_unlock();
  40:  
  41:         return ret;
  42: }

a)9~16,进行一些合法性判断。

b)19~23行,调用clk_calc_new_rates接口,将需要设置的rate缓存在new_rate字段。

同时,获取设置该rate的话,需要修改到的最顶层的clock。背后的逻辑是:如果该clock的rate改变,有可能需要通过改动parent clock的rate来实现,依次递归。

c)25~23,发送rate将要改变的通知。如果有clock不能接受改动,即set rate失败,再发送rate更改停止的通知。

d)调用clk_change_rate,从最top的clock开始,依次设置新的rate。

注4:clock rate set有2种场景,一是只需修改自身的配置,即可达到rate set的目的。第二种是需要同时修改parent的rate(可向上递归)才能达成目的。看似简单的逻辑,里面却包含非常复杂的系统设计的知识。大家在使用clock framework,知道有这回事即可,并尽可能的不要使用第二种场景,以保持系统的简洁性。

4.5 clock parent有关的实现

parent操作包括get parent和set parent两类。 
get parent的逻辑非常简单,直接从clk->parent指针中获取即可。 
set parent稍微复杂,需要执行reparent和recalc_rates动作,具体不再描述了。

 

原创文章,转发请注明出处。蜗窝科技www.wowotech.net

posted on 2017-03-25 12:03  Red_Point  阅读(423)  评论(0编辑  收藏  举报

导航