1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include <linux/device.h>
16#include <linux/err.h>
17#include <linux/idr.h>
18#include <linux/pagemap.h>
19#include <linux/export.h>
20#include <linux/leds.h>
21#include <linux/slab.h>
22#include <linux/suspend.h>
23
24#include <linux/mmc/host.h>
25#include <linux/mmc/card.h>
26
27#include "core.h"
28#include "host.h"
29
30#define cls_dev_to_mmc_host(d) container_of(d, struct mmc_host, class_dev)
31
32static void mmc_host_classdev_release(struct device *dev)
33{
34 struct mmc_host *host = cls_dev_to_mmc_host(dev);
35 kfree(host);
36}
37
38static struct class mmc_host_class = {
39 .name = "mmc_host",
40 .dev_release = mmc_host_classdev_release,
41};
42
43int mmc_register_host_class(void)
44{
45 return class_register(&mmc_host_class);
46}
47
48void mmc_unregister_host_class(void)
49{
50 class_unregister(&mmc_host_class);
51}
52
53static DEFINE_IDR(mmc_host_idr);
54static DEFINE_SPINLOCK(mmc_host_lock);
55
56#ifdef CONFIG_MMC_CLKGATE
57
58
59
60
61
62
63
64
65static void mmc_host_clk_gate_delayed(struct mmc_host *host)
66{
67 unsigned long tick_ns;
68 unsigned long freq = host->ios.clock;
69 unsigned long flags;
70
71 if (!freq) {
72 pr_debug("%s: frequency set to 0 in disable function, "
73 "this means the clock is already disabled.\n",
74 mmc_hostname(host));
75 return;
76 }
77
78
79
80
81
82 spin_lock_irqsave(&host->clk_lock, flags);
83
84
85
86
87
88
89 if (!host->clk_requests) {
90 spin_unlock_irqrestore(&host->clk_lock, flags);
91 tick_ns = DIV_ROUND_UP(1000000000, freq);
92 ndelay(host->clk_delay * tick_ns);
93 } else {
94
95 spin_unlock_irqrestore(&host->clk_lock, flags);
96 return;
97 }
98 mutex_lock(&host->clk_gate_mutex);
99 spin_lock_irqsave(&host->clk_lock, flags);
100 if (!host->clk_requests) {
101 spin_unlock_irqrestore(&host->clk_lock, flags);
102
103 mmc_gate_clock(host);
104 spin_lock_irqsave(&host->clk_lock, flags);
105 pr_debug("%s: gated MCI clock\n", mmc_hostname(host));
106 }
107 spin_unlock_irqrestore(&host->clk_lock, flags);
108 mutex_unlock(&host->clk_gate_mutex);
109}
110
111
112
113
114static void mmc_host_clk_gate_work(struct work_struct *work)
115{
116 struct mmc_host *host = container_of(work, struct mmc_host,
117 clk_gate_work);
118
119 mmc_host_clk_gate_delayed(host);
120}
121
122
123
124
125
126
127
128
129
130void mmc_host_clk_hold(struct mmc_host *host)
131{
132 unsigned long flags;
133
134 mutex_lock(&host->clk_gate_mutex);
135 spin_lock_irqsave(&host->clk_lock, flags);
136 if (host->clk_gated) {
137 spin_unlock_irqrestore(&host->clk_lock, flags);
138 mmc_ungate_clock(host);
139 spin_lock_irqsave(&host->clk_lock, flags);
140 pr_debug("%s: ungated MCI clock\n", mmc_hostname(host));
141 }
142 host->clk_requests++;
143 spin_unlock_irqrestore(&host->clk_lock, flags);
144 mutex_unlock(&host->clk_gate_mutex);
145}
146
147
148
149
150
151static bool mmc_host_may_gate_card(struct mmc_card *card)
152{
153
154 if (!card)
155 return true;
156
157
158
159
160
161
162
163
164 return !(card->quirks & MMC_QUIRK_BROKEN_CLK_GATING);
165}
166
167
168
169
170
171
172
173
174
175void mmc_host_clk_release(struct mmc_host *host)
176{
177 unsigned long flags;
178
179 spin_lock_irqsave(&host->clk_lock, flags);
180 host->clk_requests--;
181 if (mmc_host_may_gate_card(host->card) &&
182 !host->clk_requests)
183 queue_work(system_nrt_wq, &host->clk_gate_work);
184 spin_unlock_irqrestore(&host->clk_lock, flags);
185}
186
187
188
189
190
191
192
193unsigned int mmc_host_clk_rate(struct mmc_host *host)
194{
195 unsigned long freq;
196 unsigned long flags;
197
198 spin_lock_irqsave(&host->clk_lock, flags);
199 if (host->clk_gated)
200 freq = host->clk_old;
201 else
202 freq = host->ios.clock;
203 spin_unlock_irqrestore(&host->clk_lock, flags);
204 return freq;
205}
206
207
208
209
210
211static inline void mmc_host_clk_init(struct mmc_host *host)
212{
213 host->clk_requests = 0;
214
215 host->clk_delay = 8;
216 host->clk_gated = false;
217 INIT_WORK(&host->clk_gate_work, mmc_host_clk_gate_work);
218 spin_lock_init(&host->clk_lock);
219 mutex_init(&host->clk_gate_mutex);
220}
221
222
223
224
225
226static inline void mmc_host_clk_exit(struct mmc_host *host)
227{
228
229
230
231
232 if (cancel_work_sync(&host->clk_gate_work))
233 mmc_host_clk_gate_delayed(host);
234 if (host->clk_gated)
235 mmc_host_clk_hold(host);
236
237 WARN_ON(host->clk_requests > 1);
238}
239
240#else
241
242static inline void mmc_host_clk_init(struct mmc_host *host)
243{
244}
245
246static inline void mmc_host_clk_exit(struct mmc_host *host)
247{
248}
249
250#endif
251
252
253
254
255
256
257
258
259struct mmc_host *mmc_alloc_host(int extra, struct device *dev)
260{
261 int err;
262 struct mmc_host *host;
263
264 if (!idr_pre_get(&mmc_host_idr, GFP_KERNEL))
265 return NULL;
266
267 host = kzalloc(sizeof(struct mmc_host) + extra, GFP_KERNEL);
268 if (!host)
269 return NULL;
270
271 spin_lock(&mmc_host_lock);
272 err = idr_get_new(&mmc_host_idr, host, &host->index);
273 spin_unlock(&mmc_host_lock);
274 if (err)
275 goto free;
276
277 dev_set_name(&host->class_dev, "mmc%d", host->index);
278
279 host->parent = dev;
280 host->class_dev.parent = dev;
281 host->class_dev.class = &mmc_host_class;
282 device_initialize(&host->class_dev);
283
284 mmc_host_clk_init(host);
285
286 spin_lock_init(&host->lock);
287 init_waitqueue_head(&host->wq);
288 INIT_DELAYED_WORK(&host->detect, mmc_rescan);
289 INIT_DELAYED_WORK_DEFERRABLE(&host->disable, mmc_host_deeper_disable);
290#ifdef CONFIG_PM
291 host->pm_notify.notifier_call = mmc_pm_notify;
292#endif
293
294
295
296
297
298 host->max_segs = 1;
299 host->max_seg_size = PAGE_CACHE_SIZE;
300
301 host->max_req_size = PAGE_CACHE_SIZE;
302 host->max_blk_size = 512;
303 host->max_blk_count = PAGE_CACHE_SIZE / 512;
304
305 return host;
306
307free:
308 kfree(host);
309 return NULL;
310}
311
312EXPORT_SYMBOL(mmc_alloc_host);
313
314
315
316
317
318
319
320
321
322int mmc_add_host(struct mmc_host *host)
323{
324 int err;
325
326 WARN_ON((host->caps & MMC_CAP_SDIO_IRQ) &&
327 !host->ops->enable_sdio_irq);
328
329 err = device_add(&host->class_dev);
330 if (err)
331 return err;
332
333 led_trigger_register_simple(dev_name(&host->class_dev), &host->led);
334
335#ifdef CONFIG_DEBUG_FS
336 mmc_add_host_debugfs(host);
337#endif
338
339 mmc_start_host(host);
340 register_pm_notifier(&host->pm_notify);
341
342 return 0;
343}
344
345EXPORT_SYMBOL(mmc_add_host);
346
347
348
349
350
351
352
353
354
355void mmc_remove_host(struct mmc_host *host)
356{
357 unregister_pm_notifier(&host->pm_notify);
358 mmc_stop_host(host);
359
360#ifdef CONFIG_DEBUG_FS
361 mmc_remove_host_debugfs(host);
362#endif
363
364 device_del(&host->class_dev);
365
366 led_trigger_unregister_simple(host->led);
367
368 mmc_host_clk_exit(host);
369}
370
371EXPORT_SYMBOL(mmc_remove_host);
372
373
374
375
376
377
378
379void mmc_free_host(struct mmc_host *host)
380{
381 spin_lock(&mmc_host_lock);
382 idr_remove(&mmc_host_idr, host->index);
383 spin_unlock(&mmc_host_lock);
384
385 put_device(&host->class_dev);
386}
387
388EXPORT_SYMBOL(mmc_free_host);
389