forked from luck/tmp_suning_uos_patched
0e74823429
Add a param to allow users of sdhci_pltfm to allocate private space in calls to sdhci_pltfm_init+sdhci_pltfm_register. This is implemented in the same way as sdhci does for its users. None of the users have been migrated yet and are passing in zero to retain their private allocation. - todo: migrate clients to using allocation this way - todo: remove priv variable once migration is complete Also removed unused variable in sdhci_pltfm_init fn Signed-off-by: Christian Daudt <csd@broadcom.com> Acked-by: Arnd Bergmann <arnd@arndb.de> Reviewed-by: Ulf Hansson <ulf.hansson@linaro.org> Signed-off-by: Chris Ball <cjb@laptop.org>
123 lines
2.7 KiB
C
123 lines
2.7 KiB
C
/*
|
|
* SDHCI support for CNS3xxx SoC
|
|
*
|
|
* Copyright 2008 Cavium Networks
|
|
* Copyright 2010 MontaVista Software, LLC.
|
|
*
|
|
* Authors: Scott Shu
|
|
* Anton Vorontsov <avorontsov@mvista.com>
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
#include <linux/delay.h>
|
|
#include <linux/device.h>
|
|
#include <linux/mmc/host.h>
|
|
#include <linux/module.h>
|
|
#include "sdhci-pltfm.h"
|
|
|
|
static unsigned int sdhci_cns3xxx_get_max_clk(struct sdhci_host *host)
|
|
{
|
|
return 150000000;
|
|
}
|
|
|
|
static void sdhci_cns3xxx_set_clock(struct sdhci_host *host, unsigned int clock)
|
|
{
|
|
struct device *dev = mmc_dev(host->mmc);
|
|
int div = 1;
|
|
u16 clk;
|
|
unsigned long timeout;
|
|
|
|
if (clock == host->clock)
|
|
return;
|
|
|
|
sdhci_writew(host, 0, SDHCI_CLOCK_CONTROL);
|
|
|
|
if (clock == 0)
|
|
goto out;
|
|
|
|
while (host->max_clk / div > clock) {
|
|
/*
|
|
* On CNS3xxx divider grows linearly up to 4, and then
|
|
* exponentially up to 256.
|
|
*/
|
|
if (div < 4)
|
|
div += 1;
|
|
else if (div < 256)
|
|
div *= 2;
|
|
else
|
|
break;
|
|
}
|
|
|
|
dev_dbg(dev, "desired SD clock: %d, actual: %d\n",
|
|
clock, host->max_clk / div);
|
|
|
|
/* Divide by 3 is special. */
|
|
if (div != 3)
|
|
div >>= 1;
|
|
|
|
clk = div << SDHCI_DIVIDER_SHIFT;
|
|
clk |= SDHCI_CLOCK_INT_EN;
|
|
sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
|
|
|
|
timeout = 20;
|
|
while (!((clk = sdhci_readw(host, SDHCI_CLOCK_CONTROL))
|
|
& SDHCI_CLOCK_INT_STABLE)) {
|
|
if (timeout == 0) {
|
|
dev_warn(dev, "clock is unstable");
|
|
break;
|
|
}
|
|
timeout--;
|
|
mdelay(1);
|
|
}
|
|
|
|
clk |= SDHCI_CLOCK_CARD_EN;
|
|
sdhci_writew(host, clk, SDHCI_CLOCK_CONTROL);
|
|
out:
|
|
host->clock = clock;
|
|
}
|
|
|
|
static const struct sdhci_ops sdhci_cns3xxx_ops = {
|
|
.get_max_clock = sdhci_cns3xxx_get_max_clk,
|
|
.set_clock = sdhci_cns3xxx_set_clock,
|
|
};
|
|
|
|
static const struct sdhci_pltfm_data sdhci_cns3xxx_pdata = {
|
|
.ops = &sdhci_cns3xxx_ops,
|
|
.quirks = SDHCI_QUIRK_BROKEN_DMA |
|
|
SDHCI_QUIRK_DATA_TIMEOUT_USES_SDCLK |
|
|
SDHCI_QUIRK_INVERTED_WRITE_PROTECT |
|
|
SDHCI_QUIRK_CAP_CLOCK_BASE_BROKEN |
|
|
SDHCI_QUIRK_BROKEN_TIMEOUT_VAL |
|
|
SDHCI_QUIRK_NONSTANDARD_CLOCK,
|
|
};
|
|
|
|
static int sdhci_cns3xxx_probe(struct platform_device *pdev)
|
|
{
|
|
return sdhci_pltfm_register(pdev, &sdhci_cns3xxx_pdata, 0);
|
|
}
|
|
|
|
static int sdhci_cns3xxx_remove(struct platform_device *pdev)
|
|
{
|
|
return sdhci_pltfm_unregister(pdev);
|
|
}
|
|
|
|
static struct platform_driver sdhci_cns3xxx_driver = {
|
|
.driver = {
|
|
.name = "sdhci-cns3xxx",
|
|
.owner = THIS_MODULE,
|
|
.pm = SDHCI_PLTFM_PMOPS,
|
|
},
|
|
.probe = sdhci_cns3xxx_probe,
|
|
.remove = sdhci_cns3xxx_remove,
|
|
};
|
|
|
|
module_platform_driver(sdhci_cns3xxx_driver);
|
|
|
|
MODULE_DESCRIPTION("SDHCI driver for CNS3xxx");
|
|
MODULE_AUTHOR("Scott Shu, "
|
|
"Anton Vorontsov <avorontsov@mvista.com>");
|
|
MODULE_LICENSE("GPL v2");
|