Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
clk-apmu.c
Go to the documentation of this file.
1 /*
2  * mmp AXI peripharal clock operation source file
3  *
4  * Copyright (C) 2012 Marvell
5  * Chao Xie <[email protected]>
6  *
7  * This file is licensed under the terms of the GNU General Public
8  * License version 2. This program is licensed "as is" without any
9  * warranty of any kind, whether express or implied.
10  */
11 
12 #include <linux/kernel.h>
13 #include <linux/clk.h>
14 #include <linux/io.h>
15 #include <linux/err.h>
16 #include <linux/delay.h>
17 #include <linux/slab.h>
18 
19 #include "clk.h"
20 
21 #define to_clk_apmu(clk) (container_of(clk, struct clk_apmu, clk))
22 struct clk_apmu {
23  struct clk_hw hw;
24  void __iomem *base;
28 };
29 
30 static int clk_apmu_enable(struct clk_hw *hw)
31 {
32  struct clk_apmu *apmu = to_clk_apmu(hw);
33  unsigned long data;
34  unsigned long flags = 0;
35 
36  if (apmu->lock)
37  spin_lock_irqsave(apmu->lock, flags);
38 
39  data = readl_relaxed(apmu->base) | apmu->enable_mask;
40  writel_relaxed(data, apmu->base);
41 
42  if (apmu->lock)
43  spin_unlock_irqrestore(apmu->lock, flags);
44 
45  return 0;
46 }
47 
48 static void clk_apmu_disable(struct clk_hw *hw)
49 {
50  struct clk_apmu *apmu = to_clk_apmu(hw);
51  unsigned long data;
52  unsigned long flags = 0;
53 
54  if (apmu->lock)
55  spin_lock_irqsave(apmu->lock, flags);
56 
57  data = readl_relaxed(apmu->base) & ~apmu->enable_mask;
58  writel_relaxed(data, apmu->base);
59 
60  if (apmu->lock)
61  spin_unlock_irqrestore(apmu->lock, flags);
62 }
63 
65  .enable = clk_apmu_enable,
66  .disable = clk_apmu_disable,
67 };
68 
69 struct clk *mmp_clk_register_apmu(const char *name, const char *parent_name,
70  void __iomem *base, u32 enable_mask, spinlock_t *lock)
71 {
72  struct clk_apmu *apmu;
73  struct clk *clk;
74  struct clk_init_data init;
75 
76  apmu = kzalloc(sizeof(*apmu), GFP_KERNEL);
77  if (!apmu)
78  return NULL;
79 
80  init.name = name;
81  init.ops = &clk_apmu_ops;
82  init.flags = CLK_SET_RATE_PARENT;
83  init.parent_names = (parent_name ? &parent_name : NULL);
84  init.num_parents = (parent_name ? 1 : 0);
85 
86  apmu->base = base;
87  apmu->enable_mask = enable_mask;
88  apmu->lock = lock;
89  apmu->hw.init = &init;
90 
91  clk = clk_register(NULL, &apmu->hw);
92 
93  if (IS_ERR(clk))
94  kfree(apmu);
95 
96  return clk;
97 }