diff options
author | Thierry Reding <thierry.reding@avionic-design.de> | 2012-08-31 02:29:24 -0400 |
---|---|---|
committer | Thierry Reding <thierry.reding@avionic-design.de> | 2012-10-05 14:56:41 -0400 |
commit | 79c11b6fa0b225ac165e79e821d50e70f563645f (patch) | |
tree | 05a7b6a2a87f05780b2a12a2e821c44336d73e75 /arch/unicore32/kernel | |
parent | 5384e27317016bd30aa7a7a7513f76ce7caa3b09 (diff) |
pwm: Move PUV3 PWM driver to PWM framework
This commit moves the driver to drivers/pwm and converts it to the new
PWM framework.
Signed-off-by: Thierry Reding <thierry.reding@avionic-design.de>
Tested-by: Qin Rui <qinrui@mprc.pku.edu.cn>
Acked-by: Guan Xuetao <gxt@mprc.pku.edu.cn>
Diffstat (limited to 'arch/unicore32/kernel')
-rw-r--r-- | arch/unicore32/kernel/Makefile | 1 | ||||
-rw-r--r-- | arch/unicore32/kernel/pwm.c | 219 |
2 files changed, 0 insertions, 220 deletions
diff --git a/arch/unicore32/kernel/Makefile b/arch/unicore32/kernel/Makefile index 324010156958..fa497e0efe5a 100644 --- a/arch/unicore32/kernel/Makefile +++ b/arch/unicore32/kernel/Makefile | |||
@@ -16,7 +16,6 @@ obj-$(CONFIG_UNICORE_FPU_F64) += fpu-ucf64.o | |||
16 | obj-$(CONFIG_ARCH_PUV3) += clock.o irq.o time.o | 16 | obj-$(CONFIG_ARCH_PUV3) += clock.o irq.o time.o |
17 | 17 | ||
18 | obj-$(CONFIG_PUV3_GPIO) += gpio.o | 18 | obj-$(CONFIG_PUV3_GPIO) += gpio.o |
19 | obj-$(CONFIG_PUV3_PWM) += pwm.o | ||
20 | obj-$(CONFIG_PUV3_PM) += pm.o sleep.o | 19 | obj-$(CONFIG_PUV3_PM) += pm.o sleep.o |
21 | obj-$(CONFIG_HIBERNATION) += hibernate.o hibernate_asm.o | 20 | obj-$(CONFIG_HIBERNATION) += hibernate.o hibernate_asm.o |
22 | 21 | ||
diff --git a/arch/unicore32/kernel/pwm.c b/arch/unicore32/kernel/pwm.c deleted file mode 100644 index 724e8603120b..000000000000 --- a/arch/unicore32/kernel/pwm.c +++ /dev/null | |||
@@ -1,219 +0,0 @@ | |||
1 | /* | ||
2 | * linux/arch/unicore32/kernel/pwm.c | ||
3 | * | ||
4 | * Code specific to PKUnity SoC and UniCore ISA | ||
5 | * | ||
6 | * Maintained by GUAN Xue-tao <gxt@mprc.pku.edu.cn> | ||
7 | * Copyright (C) 2001-2010 Guan Xuetao | ||
8 | * | ||
9 | * This program is free software; you can redistribute it and/or modify | ||
10 | * it under the terms of the GNU General Public License version 2 as | ||
11 | * published by the Free Software Foundation. | ||
12 | */ | ||
13 | |||
14 | #include <linux/module.h> | ||
15 | #include <linux/kernel.h> | ||
16 | #include <linux/platform_device.h> | ||
17 | #include <linux/slab.h> | ||
18 | #include <linux/err.h> | ||
19 | #include <linux/clk.h> | ||
20 | #include <linux/io.h> | ||
21 | #include <linux/pwm.h> | ||
22 | |||
23 | #include <asm/div64.h> | ||
24 | #include <mach/hardware.h> | ||
25 | |||
26 | struct pwm_device { | ||
27 | struct list_head node; | ||
28 | struct platform_device *pdev; | ||
29 | |||
30 | void __iomem *base; | ||
31 | |||
32 | const char *label; | ||
33 | struct clk *clk; | ||
34 | int clk_enabled; | ||
35 | |||
36 | unsigned int use_count; | ||
37 | unsigned int pwm_id; | ||
38 | }; | ||
39 | |||
40 | /* | ||
41 | * period_ns = 10^9 * (PRESCALE + 1) * (PV + 1) / PWM_CLK_RATE | ||
42 | * duty_ns = 10^9 * (PRESCALE + 1) * DC / PWM_CLK_RATE | ||
43 | */ | ||
44 | int pwm_config(struct pwm_device *pwm, int duty_ns, int period_ns) | ||
45 | { | ||
46 | unsigned long long c; | ||
47 | unsigned long period_cycles, prescale, pv, dc; | ||
48 | |||
49 | if (pwm == NULL || period_ns == 0 || duty_ns > period_ns) | ||
50 | return -EINVAL; | ||
51 | |||
52 | c = clk_get_rate(pwm->clk); | ||
53 | c = c * period_ns; | ||
54 | do_div(c, 1000000000); | ||
55 | period_cycles = c; | ||
56 | |||
57 | if (period_cycles < 1) | ||
58 | period_cycles = 1; | ||
59 | prescale = (period_cycles - 1) / 1024; | ||
60 | pv = period_cycles / (prescale + 1) - 1; | ||
61 | |||
62 | if (prescale > 63) | ||
63 | return -EINVAL; | ||
64 | |||
65 | if (duty_ns == period_ns) | ||
66 | dc = OST_PWMDCCR_FDCYCLE; | ||
67 | else | ||
68 | dc = (pv + 1) * duty_ns / period_ns; | ||
69 | |||
70 | /* NOTE: the clock to PWM has to be enabled first | ||
71 | * before writing to the registers | ||
72 | */ | ||
73 | clk_enable(pwm->clk); | ||
74 | |||
75 | writel(prescale, pwm->base + OST_PWM_PWCR); | ||
76 | writel(pv - dc, pwm->base + OST_PWM_DCCR); | ||
77 | writel(pv, pwm->base + OST_PWM_PCR); | ||
78 | |||
79 | clk_disable(pwm->clk); | ||
80 | |||
81 | return 0; | ||
82 | } | ||
83 | EXPORT_SYMBOL(pwm_config); | ||
84 | |||
85 | int pwm_enable(struct pwm_device *pwm) | ||
86 | { | ||
87 | int rc = 0; | ||
88 | |||
89 | if (!pwm->clk_enabled) { | ||
90 | rc = clk_enable(pwm->clk); | ||
91 | if (!rc) | ||
92 | pwm->clk_enabled = 1; | ||
93 | } | ||
94 | return rc; | ||
95 | } | ||
96 | EXPORT_SYMBOL(pwm_enable); | ||
97 | |||
98 | void pwm_disable(struct pwm_device *pwm) | ||
99 | { | ||
100 | if (pwm->clk_enabled) { | ||
101 | clk_disable(pwm->clk); | ||
102 | pwm->clk_enabled = 0; | ||
103 | } | ||
104 | } | ||
105 | EXPORT_SYMBOL(pwm_disable); | ||
106 | |||
107 | static DEFINE_MUTEX(pwm_lock); | ||
108 | static LIST_HEAD(pwm_list); | ||
109 | |||
110 | struct pwm_device *pwm_request(int pwm_id, const char *label) | ||
111 | { | ||
112 | struct pwm_device *pwm; | ||
113 | int found = 0; | ||
114 | |||
115 | mutex_lock(&pwm_lock); | ||
116 | |||
117 | list_for_each_entry(pwm, &pwm_list, node) { | ||
118 | if (pwm->pwm_id == pwm_id) { | ||
119 | found = 1; | ||
120 | break; | ||
121 | } | ||
122 | } | ||
123 | |||
124 | if (found) { | ||
125 | if (pwm->use_count == 0) { | ||
126 | pwm->use_count++; | ||
127 | pwm->label = label; | ||
128 | } else | ||
129 | pwm = ERR_PTR(-EBUSY); | ||
130 | } else | ||
131 | pwm = ERR_PTR(-ENOENT); | ||
132 | |||
133 | mutex_unlock(&pwm_lock); | ||
134 | return pwm; | ||
135 | } | ||
136 | EXPORT_SYMBOL(pwm_request); | ||
137 | |||
138 | void pwm_free(struct pwm_device *pwm) | ||
139 | { | ||
140 | mutex_lock(&pwm_lock); | ||
141 | |||
142 | if (pwm->use_count) { | ||
143 | pwm->use_count--; | ||
144 | pwm->label = NULL; | ||
145 | } else | ||
146 | pr_warning("PWM device already freed\n"); | ||
147 | |||
148 | mutex_unlock(&pwm_lock); | ||
149 | } | ||
150 | EXPORT_SYMBOL(pwm_free); | ||
151 | |||
152 | static inline void __add_pwm(struct pwm_device *pwm) | ||
153 | { | ||
154 | mutex_lock(&pwm_lock); | ||
155 | list_add_tail(&pwm->node, &pwm_list); | ||
156 | mutex_unlock(&pwm_lock); | ||
157 | } | ||
158 | |||
159 | static int __devinit pwm_probe(struct platform_device *pdev) | ||
160 | { | ||
161 | struct pwm_device *pwm; | ||
162 | struct resource *r; | ||
163 | |||
164 | pwm = devm_kzalloc(&pdev->dev, sizeof(struct pwm_device), GFP_KERNEL); | ||
165 | if (pwm == NULL) { | ||
166 | dev_err(&pdev->dev, "failed to allocate memory\n"); | ||
167 | return -ENOMEM; | ||
168 | } | ||
169 | |||
170 | pwm->clk = devm_clk_get(&pdev->dev, "OST_CLK"); | ||
171 | if (IS_ERR(pwm->clk)) | ||
172 | return PTR_ERR(pwm->clk); | ||
173 | |||
174 | pwm->clk_enabled = 0; | ||
175 | |||
176 | pwm->use_count = 0; | ||
177 | pwm->pwm_id = pdev->id; | ||
178 | pwm->pdev = pdev; | ||
179 | |||
180 | r = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||
181 | if (r == NULL) { | ||
182 | dev_err(&pdev->dev, "no memory resource defined\n"); | ||
183 | return -ENODEV; | ||
184 | } | ||
185 | |||
186 | pwm->base = devm_request_and_ioremap(&pdev->dev, r); | ||
187 | if (pwm->base == NULL) | ||
188 | return -EADDRNOTAVAIL; | ||
189 | |||
190 | __add_pwm(pwm); | ||
191 | platform_set_drvdata(pdev, pwm); | ||
192 | return 0; | ||
193 | } | ||
194 | |||
195 | static int __devexit pwm_remove(struct platform_device *pdev) | ||
196 | { | ||
197 | struct pwm_device *pwm; | ||
198 | |||
199 | pwm = platform_get_drvdata(pdev); | ||
200 | if (pwm == NULL) | ||
201 | return -ENODEV; | ||
202 | |||
203 | mutex_lock(&pwm_lock); | ||
204 | list_del(&pwm->node); | ||
205 | mutex_unlock(&pwm_lock); | ||
206 | |||
207 | return 0; | ||
208 | } | ||
209 | |||
210 | static struct platform_driver puv3_pwm_driver = { | ||
211 | .driver = { | ||
212 | .name = "PKUnity-v3-PWM", | ||
213 | }, | ||
214 | .probe = pwm_probe, | ||
215 | .remove = __devexit_p(pwm_remove), | ||
216 | }; | ||
217 | module_platform_driver(puv3_pwm_driver); | ||
218 | |||
219 | MODULE_LICENSE("GPL v2"); | ||