| /* | |
| * linux/drivers/mmc/core/host.c | |
| * | |
| * Copyright (C) 2003 Russell King, All Rights Reserved. | |
| * Copyright (C) 2007-2008 Pierre Ossman | |
| * Copyright (C) 2010 Linus Walleij | |
| * | |
| * This program is free software; you can redistribute it and/or modify | |
| * it under the terms of the GNU General Public License version 2 as | |
| * published by the Free Software Foundation. | |
| * | |
| * MMC host class device management | |
| */ | |
| #include <linux/device.h> | |
| #include <linux/err.h> | |
| #include <linux/idr.h> | |
| #include <linux/pagemap.h> | |
| #include <linux/export.h> | |
| #include <linux/leds.h> | |
| #include <linux/slab.h> | |
| #include <linux/suspend.h> | |
| #include <linux/mmc/host.h> | |
| #include <linux/mmc/card.h> | |
| #include "core.h" | |
| #include "host.h" | |
| #define cls_dev_to_mmc_host(d) container_of(d, struct mmc_host, class_dev) | |
| static void mmc_host_classdev_release(struct device *dev) | |
| { | |
| struct mmc_host *host = cls_dev_to_mmc_host(dev); | |
| kfree(host); | |
| } | |
| static struct class mmc_host_class = { | |
| .name = "mmc_host", | |
| .dev_release = mmc_host_classdev_release, | |
| }; | |
| int mmc_register_host_class(void) | |
| { | |
| return class_register(&mmc_host_class); | |
| } | |
| void mmc_unregister_host_class(void) | |
| { | |
| class_unregister(&mmc_host_class); | |
| } | |
| static DEFINE_IDR(mmc_host_idr); | |
| static DEFINE_SPINLOCK(mmc_host_lock); | |
| #ifdef CONFIG_MMC_CLKGATE | |
| /* | |
| * Enabling clock gating will make the core call out to the host | |
| * once up and once down when it performs a request or card operation | |
| * intermingled in any fashion. The driver will see this through | |
| * set_ios() operations with ios.clock field set to 0 to gate (disable) | |
| * the block clock, and to the old frequency to enable it again. | |
| */ | |
| static void mmc_host_clk_gate_delayed(struct mmc_host *host) | |
| { | |
| unsigned long tick_ns; | |
| unsigned long freq = host->ios.clock; | |
| unsigned long flags; | |
| if (!freq) { | |
| pr_debug("%s: frequency set to 0 in disable function, " | |
| "this means the clock is already disabled.\n", | |
| mmc_hostname(host)); | |
| return; | |
| } | |
| /* | |
| * New requests may have appeared while we were scheduling, | |
| * then there is no reason to delay the check before | |
| * clk_disable(). | |
| */ | |
| spin_lock_irqsave(&host->clk_lock, flags); | |
| /* | |
| * Delay n bus cycles (at least 8 from MMC spec) before attempting | |
| * to disable the MCI block clock. The reference count may have | |
| * gone up again after this delay due to rescheduling! | |
| */ | |
| if (!host->clk_requests) { | |
| spin_unlock_irqrestore(&host->clk_lock, flags); | |
| tick_ns = DIV_ROUND_UP(1000000000, freq); | |
| ndelay(host->clk_delay * tick_ns); | |
| } else { | |
| /* New users appeared while waiting for this work */ | |
| spin_unlock_irqrestore(&host->clk_lock, flags); | |
| return; | |
| } | |
| mutex_lock(&host->clk_gate_mutex); | |
| spin_lock_irqsave(&host->clk_lock, flags); | |
| if (!host->clk_requests) { | |
| spin_unlock_irqrestore(&host->clk_lock, flags); | |
| /* This will set host->ios.clock to 0 */ | |
| mmc_gate_clock(host); | |
| spin_lock_irqsave(&host->clk_lock, flags); | |
| pr_debug("%s: gated MCI clock\n", mmc_hostname(host)); | |
| } | |
| spin_unlock_irqrestore(&host->clk_lock, flags); | |
| mutex_unlock(&host->clk_gate_mutex); | |
| } | |
| /* | |
| * Internal work. Work to disable the clock at some later point. | |
| */ | |
| static void mmc_host_clk_gate_work(struct work_struct *work) | |
| { | |
| struct mmc_host *host = container_of(work, struct mmc_host, | |
| clk_gate_work); | |
| mmc_host_clk_gate_delayed(host); | |
| } | |
| /** | |
| * mmc_host_clk_hold - ungate hardware MCI clocks | |
| * @host: host to ungate. | |
| * | |
| * Makes sure the host ios.clock is restored to a non-zero value | |
| * past this call. Increase clock reference count and ungate clock | |
| * if we're the first user. | |
| */ | |
| void mmc_host_clk_hold(struct mmc_host *host) | |
| { | |
| unsigned long flags; | |
| mutex_lock(&host->clk_gate_mutex); | |
| spin_lock_irqsave(&host->clk_lock, flags); | |
| if (host->clk_gated) { | |
| spin_unlock_irqrestore(&host->clk_lock, flags); | |
| mmc_ungate_clock(host); | |
| spin_lock_irqsave(&host->clk_lock, flags); | |
| pr_debug("%s: ungated MCI clock\n", mmc_hostname(host)); | |
| } | |
| host->clk_requests++; | |
| spin_unlock_irqrestore(&host->clk_lock, flags); | |
| mutex_unlock(&host->clk_gate_mutex); | |
| } | |
| /** | |
| * mmc_host_may_gate_card - check if this card may be gated | |
| * @card: card to check. | |
| */ | |
| static bool mmc_host_may_gate_card(struct mmc_card *card) | |
| { | |
| /* If there is no card we may gate it */ | |
| if (!card) | |
| return true; | |
| /* | |
| * Don't gate SDIO cards! These need to be clocked at all times | |
| * since they may be independent systems generating interrupts | |
| * and other events. The clock requests counter from the core will | |
| * go down to zero since the core does not need it, but we will not | |
| * gate the clock, because there is somebody out there that may still | |
| * be using it. | |
| */ | |
| return !(card->quirks & MMC_QUIRK_BROKEN_CLK_GATING); | |
| } | |
| /** | |
| * mmc_host_clk_release - gate off hardware MCI clocks | |
| * @host: host to gate. | |
| * | |
| * Calls the host driver with ios.clock set to zero as often as possible | |
| * in order to gate off hardware MCI clocks. Decrease clock reference | |
| * count and schedule disabling of clock. | |
| */ | |
| void mmc_host_clk_release(struct mmc_host *host) | |
| { | |
| unsigned long flags; | |
| spin_lock_irqsave(&host->clk_lock, flags); | |
| host->clk_requests--; | |
| if (mmc_host_may_gate_card(host->card) && | |
| !host->clk_requests) | |
| queue_work(system_nrt_wq, &host->clk_gate_work); | |
| spin_unlock_irqrestore(&host->clk_lock, flags); | |
| } | |
| /** | |
| * mmc_host_clk_rate - get current clock frequency setting | |
| * @host: host to get the clock frequency for. | |
| * | |
| * Returns current clock frequency regardless of gating. | |
| */ | |
| unsigned int mmc_host_clk_rate(struct mmc_host *host) | |
| { | |
| unsigned long freq; | |
| unsigned long flags; | |
| spin_lock_irqsave(&host->clk_lock, flags); | |
| if (host->clk_gated) | |
| freq = host->clk_old; | |
| else | |
| freq = host->ios.clock; | |
| spin_unlock_irqrestore(&host->clk_lock, flags); | |
| return freq; | |
| } | |
| /** | |
| * mmc_host_clk_init - set up clock gating code | |
| * @host: host with potential clock to control | |
| */ | |
| static inline void mmc_host_clk_init(struct mmc_host *host) | |
| { | |
| host->clk_requests = 0; | |
| /* Hold MCI clock for 8 cycles by default */ | |
| host->clk_delay = 8; | |
| host->clk_gated = false; | |
| INIT_WORK(&host->clk_gate_work, mmc_host_clk_gate_work); | |
| spin_lock_init(&host->clk_lock); | |
| mutex_init(&host->clk_gate_mutex); | |
| } | |
| /** | |
| * mmc_host_clk_exit - shut down clock gating code | |
| * @host: host with potential clock to control | |
| */ | |
| static inline void mmc_host_clk_exit(struct mmc_host *host) | |
| { | |
| /* | |
| * Wait for any outstanding gate and then make sure we're | |
| * ungated before exiting. | |
| */ | |
| if (cancel_work_sync(&host->clk_gate_work)) | |
| mmc_host_clk_gate_delayed(host); | |
| if (host->clk_gated) | |
| mmc_host_clk_hold(host); | |
| /* There should be only one user now */ | |
| WARN_ON(host->clk_requests > 1); | |
| } | |
| #else | |
| static inline void mmc_host_clk_init(struct mmc_host *host) | |
| { | |
| } | |
| static inline void mmc_host_clk_exit(struct mmc_host *host) | |
| { | |
| } | |
| #endif | |
| /** | |
| * mmc_alloc_host - initialise the per-host structure. | |
| * @extra: sizeof private data structure | |
| * @dev: pointer to host device model structure | |
| * | |
| * Initialise the per-host structure. | |
| */ | |
| struct mmc_host *mmc_alloc_host(int extra, struct device *dev) | |
| { | |
| int err; | |
| struct mmc_host *host; | |
| if (!idr_pre_get(&mmc_host_idr, GFP_KERNEL)) | |
| return NULL; | |
| host = kzalloc(sizeof(struct mmc_host) + extra, GFP_KERNEL); | |
| if (!host) | |
| return NULL; | |
| spin_lock(&mmc_host_lock); | |
| err = idr_get_new(&mmc_host_idr, host, &host->index); | |
| spin_unlock(&mmc_host_lock); | |
| if (err) | |
| goto free; | |
| dev_set_name(&host->class_dev, "mmc%d", host->index); | |
| host->parent = dev; | |
| host->class_dev.parent = dev; | |
| host->class_dev.class = &mmc_host_class; | |
| device_initialize(&host->class_dev); | |
| mmc_host_clk_init(host); | |
| spin_lock_init(&host->lock); | |
| init_waitqueue_head(&host->wq); | |
| INIT_DELAYED_WORK(&host->detect, mmc_rescan); | |
| INIT_DELAYED_WORK_DEFERRABLE(&host->disable, mmc_host_deeper_disable); | |
| #ifdef CONFIG_PM | |
| host->pm_notify.notifier_call = mmc_pm_notify; | |
| #endif | |
| /* | |
| * By default, hosts do not support SGIO or large requests. | |
| * They have to set these according to their abilities. | |
| */ | |
| host->max_segs = 1; | |
| host->max_seg_size = PAGE_CACHE_SIZE; | |
| host->max_req_size = PAGE_CACHE_SIZE; | |
| host->max_blk_size = 512; | |
| host->max_blk_count = PAGE_CACHE_SIZE / 512; | |
| /* | |
| * Enable runtime power management by default. This flag was added due | |
| * to runtime power management causing disruption for some users, but | |
| * the power on/off code has been improved since then. | |
| * | |
| * We'll enable this flag by default as an experiment, and if no | |
| * problems are reported, we will follow up later and remove the flag | |
| * altogether. | |
| */ | |
| host->caps = MMC_CAP_POWER_OFF_CARD; | |
| return host; | |
| free: | |
| kfree(host); | |
| return NULL; | |
| } | |
| EXPORT_SYMBOL(mmc_alloc_host); | |
| /** | |
| * mmc_add_host - initialise host hardware | |
| * @host: mmc host | |
| * | |
| * Register the host with the driver model. The host must be | |
| * prepared to start servicing requests before this function | |
| * completes. | |
| */ | |
| int mmc_add_host(struct mmc_host *host) | |
| { | |
| int err; | |
| WARN_ON((host->caps & MMC_CAP_SDIO_IRQ) && | |
| !host->ops->enable_sdio_irq); | |
| err = device_add(&host->class_dev); | |
| if (err) | |
| return err; | |
| led_trigger_register_simple(dev_name(&host->class_dev), &host->led); | |
| #ifdef CONFIG_DEBUG_FS | |
| mmc_add_host_debugfs(host); | |
| #endif | |
| mmc_start_host(host); | |
| register_pm_notifier(&host->pm_notify); | |
| return 0; | |
| } | |
| EXPORT_SYMBOL(mmc_add_host); | |
| /** | |
| * mmc_remove_host - remove host hardware | |
| * @host: mmc host | |
| * | |
| * Unregister and remove all cards associated with this host, | |
| * and power down the MMC bus. No new requests will be issued | |
| * after this function has returned. | |
| */ | |
| void mmc_remove_host(struct mmc_host *host) | |
| { | |
| unregister_pm_notifier(&host->pm_notify); | |
| mmc_stop_host(host); | |
| #ifdef CONFIG_DEBUG_FS | |
| mmc_remove_host_debugfs(host); | |
| #endif | |
| device_del(&host->class_dev); | |
| led_trigger_unregister_simple(host->led); | |
| mmc_host_clk_exit(host); | |
| } | |
| EXPORT_SYMBOL(mmc_remove_host); | |
| /** | |
| * mmc_free_host - free the host structure | |
| * @host: mmc host | |
| * | |
| * Free the host once all references to it have been dropped. | |
| */ | |
| void mmc_free_host(struct mmc_host *host) | |
| { | |
| spin_lock(&mmc_host_lock); | |
| idr_remove(&mmc_host_idr, host->index); | |
| spin_unlock(&mmc_host_lock); | |
| put_device(&host->class_dev); | |
| } | |
| EXPORT_SYMBOL(mmc_free_host); |