Re: [PATCH v2] mmc: add new au6601 driver

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



On 8 October 2014 08:58, Oleksij Rempel <linux@xxxxxxxxxxxxxxxx> wrote:
> Hi Ulf,
>
> providing proper changes for bounce buffer will take some time. I assume
> it will be probably long time project.
> Can you please review/ack(?) this driver, so i can sleep good at night :)

I will look into it after the merge window, sorry for taking so long.

I would also like to encourage other mmc people to help out reviewing
the driver.

Kind regards
Uffe

>
>
> Am 27.09.2014 um 09:11 schrieb Oleksij Rempel:
>> This driver is based on documentation which was based on my RE-work and
>> comparision with other MMC drivers.
>> It works in legacy mode and can provide 20MB/s R/W spead for most modern
>> SD cards, even if at least 40MB/s should be possible on this hardware.
>> It was not possible provide description for all register. But some of them
>> are important to make this hardware work in some unknown way.
>>
>> Biggest part of RE-work was done by emulating AU6601 in QEMU.
>>
>> Signed-off-by: Oleksij Rempel <linux@xxxxxxxxxxxxxxxx>
>> ---
>>  drivers/mmc/host/Kconfig  |    8 +
>>  drivers/mmc/host/Makefile |    1 +
>>  drivers/mmc/host/au6601.c | 1215 +++++++++++++++++++++++++++++++++++++++++++++
>>  3 files changed, 1224 insertions(+)
>>  create mode 100644 drivers/mmc/host/au6601.c
>>
>> diff --git a/drivers/mmc/host/Kconfig b/drivers/mmc/host/Kconfig
>> index 779368b..630a4ee 100644
>> --- a/drivers/mmc/host/Kconfig
>> +++ b/drivers/mmc/host/Kconfig
>> @@ -315,6 +315,14 @@ config MMC_WBSD
>>
>>         If unsure, say N.
>>
>> +config MMC_AU6601
>> +     tristate "Alcor Micro AU6601"
>> +     help
>> +       This selects the Alcor Micro Multimedia card interface.
>> +
>> +       If unsure, say N.
>> +
>> +
>>  config MMC_AU1X
>>       tristate "Alchemy AU1XX0 MMC Card Interface support"
>>       depends on MIPS_ALCHEMY
>> diff --git a/drivers/mmc/host/Makefile b/drivers/mmc/host/Makefile
>> index 61cbc24..b2aab60 100644
>> --- a/drivers/mmc/host/Makefile
>> +++ b/drivers/mmc/host/Makefile
>> @@ -18,6 +18,7 @@ obj-$(CONFIG_MMC_SDHCI_SIRF)        += sdhci-sirf.o
>>  obj-$(CONFIG_MMC_SDHCI_SPEAR)        += sdhci-spear.o
>>  obj-$(CONFIG_MMC_WBSD)               += wbsd.o
>>  obj-$(CONFIG_MMC_AU1X)               += au1xmmc.o
>> +obj-$(CONFIG_MMC_AU6601)     += au6601.o
>>  obj-$(CONFIG_MMC_OMAP)               += omap.o
>>  obj-$(CONFIG_MMC_OMAP_HS)    += omap_hsmmc.o
>>  obj-$(CONFIG_MMC_ATMELMCI)   += atmel-mci.o
>> diff --git a/drivers/mmc/host/au6601.c b/drivers/mmc/host/au6601.c
>> new file mode 100644
>> index 0000000..1b9b46d
>> --- /dev/null
>> +++ b/drivers/mmc/host/au6601.c
>> @@ -0,0 +1,1215 @@
>> +/*
>> + * Copyright (C) 2014 Oleksij Rempel.
>> + *
>> + * Authors: Oleksij Rempel <linux@xxxxxxxxxxxxxxxx>
>> + *
>> + * This software is licensed under the terms of the GNU General Public
>> + * License version 2, as published by the Free Software Foundation, and
>> + * may be copied, distributed, and modified under those terms.
>> + *
>> + * This program is distributed in the hope that it will be useful,
>> + * but WITHOUT ANY WARRANTY; without even the implied warranty of
>> + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
>> + * GNU General Public License for more details.
>> + *
>> + */
>> +
>> +
>> +#include <linux/delay.h>
>> +#include <linux/pci.h>
>> +#include <linux/module.h>
>> +#include <linux/io.h>
>> +#include <linux/pm.h>
>> +#include <linux/irq.h>
>> +#include <linux/interrupt.h>
>> +
>> +#include <linux/mmc/host.h>
>> +#include <linux/mmc/mmc.h>
>> +
>> +#define DRVNAME                      "au6601-pci"
>> +#define PCI_ID_ALCOR_MICRO   0x1aea
>> +#define PCI_ID_AU6601                0x6601
>> +
>> +#define MHZ_TO_HZ(freq)      ((freq) * 1000 * 1000)
>> +
>> +#define AU6601_MIN_CLOCK             (150 * 1000)
>> +#define AU6601_MAX_CLOCK             MHZ_TO_HZ(208)
>> +#define AU6601_MAX_SEGMENTS          512
>> +#define AU6601_MAX_BLOCK_LENGTH              512
>> +#define AU6601_MAX_DMA_BLOCKS                8
>> +#define AU6601_DMA_LOCAL_SEGMENTS    3
>> +#define AU6601_MAX_BLOCK_COUNT               65536
>> +
>> +/* SDMA phy address. Higer then 0x0800.0000? */
>> +#define AU6601_REG_SDMA_ADDR 0x00
>> + #define AU6601_SDMA_MASK    0xfffff000
>> +/* ADMA block count? AU6621 only. */
>> +#define REG_05       0x05
>> +/* PIO */
>> +#define AU6601_REG_BUFFER    0x08
>> +/* ADMA ctrl? AU6621 only. */
>> +#define REG_0C       0x0c
>> +/* ADMA phy address. AU6621 only. */
>> +#define REG_10       0x10
>> +/* CMD index */
>> +#define AU6601_REG_CMD_OPCODE        0x23
>> +/* CMD parametr */
>> +#define AU6601_REG_CMD_ARG   0x24
>> +/* CMD response 4x4 Bytes */
>> +#define AU6601_REG_CMD_RSP0  0x30
>> +#define AU6601_REG_CMD_RSP1  0x34
>> +#define AU6601_REG_CMD_RSP2  0x38
>> +#define AU6601_REG_CMD_RSP3  0x3C
>> +/* LED ctrl? */
>> +#define REG_51       0x51
>> +/* ??? */
>> +#define REG_52       0x52
>> +/* LED related? Always toggled BIT0 */
>> +#define REG_61       0x61
>> +/* Same as REG_61? */
>> +#define REG_63       0x63
>> +/* ??? */
>> +#define REG_69       0x69
>> +/* Block size for SDMA or PIO */
>> +#define AU6601_REG_BLOCK_SIZE        0x6c
>> +/* Some power related reg, used together with REG_7A */
>> +#define REG_70       0x70
>> +/* PLL ctrl */
>> +#define AU6601_REG_PLL_CTRL  0x72
>> +/* ??? */
>> +#define REG_74       0x74
>> +/* ??? */
>> +#define REG_75       0x75
>> +/* card slot state? */
>> +#define REG_76       0x76
>> +/* ??? */
>> +#define REG_77       0x77
>> +/* looks like soft reset? */
>> +#define AU6601_REG_SW_RESET  0x79
>> + #define AU6601_RESET_UNK    BIT(7)  /* unknown bit */
>> + #define AU6601_RESET_DATA   BIT(3)
>> + #define AU6601_RESET_CMD    BIT(0)
>> +/* see REG_70 */
>> +#define REG_7A       0x7a
>> +/* ??? Padding? Timeing? */
>> +#define REG_7B       0x7b
>> +/* ??? Padding? Timeing? */
>> +#define REG_7C       0x7c
>> +/* ??? Padding? Timeing? */
>> +#define REG_7D       0x7d
>> +/* read EEPROM? */
>> +#define REG_7F       0x7f
>> +
>> +#define AU6601_REG_CMD_CTRL  0x81
>> +#define AU6601_REG_BUS_CTRL  0x82
>> + #define AU6601_BUS_WIDTH_4BIT       BIT(5)
>> +#define REG_83       0x83
>> +
>> +#define AU6601_REG_BUS_STATUS        0x84
>> + #define AU6601_BUS_STAT_CMD BIT(15)
>> +/* BIT(4) - BIT(7) are permanently 1.
>> + * May be reseved or not attached DAT4-DAT7 */
>> + #define AU6601_BUS_STAT_DAT3                BIT(3)
>> + #define AU6601_BUS_STAT_DAT2                BIT(2)
>> + #define AU6601_BUS_STAT_DAT1                BIT(1)
>> + #define AU6601_BUS_STAT_DAT0                BIT(0)
>> + #define AU6601_BUS_STAT_DAT_MASK    0xf
>> +#define REG_85       0x85
>> +/* ??? */
>> +#define REG_86       0x86
>> +#define AU6601_REG_INT_STATUS        0x90 /* IRQ intmask */
>> +#define AU6601_REG_INT_ENABLE        0x94
>> +/* ??? */
>> +#define REG_A1       0xa1
>> +/* ??? */
>> +#define REG_A2       0xa2
>> +/* ??? */
>> +#define REG_A3       0xa3
>> +/* ??? */
>> +#define REG_B0       0xb0
>> +/* ??? */
>> +#define REG_B4       0xb4
>> +
>> + /* AU6601_REG_INT_STATUS is identical or almost identical with sdhci.h */
>> + /* OK - are tested and confirmed bits */
>> + #define  AU6601_INT_RESPONSE                0x00000001      /* ok */
>> + #define  AU6601_INT_DATA_END                0x00000002      /* fifo, ok */
>> + #define  AU6601_INT_BLK_GAP         0x00000004
>> + #define  AU6601_INT_DMA_END         0x00000008
>> + #define  AU6601_INT_SPACE_AVAIL     0x00000010      /* fifo, ok */
>> + #define  AU6601_INT_DATA_AVAIL              0x00000020      /* fifo, ok */
>> + #define  AU6601_INT_CARD_REMOVE     0x00000040
>> + #define  AU6601_INT_CARD_INSERT     0x00000080      /* 0x40 and 0x80 flip */
>> + #define  AU6601_INT_CARD_INT                0x00000100
>> + #define  AU6601_INT_ERROR           0x00008000      /* ok */
>> + #define  AU6601_INT_TIMEOUT         0x00010000      /* seems to be ok */
>> + #define  AU6601_INT_CRC             0x00020000      /* seems to be ok */
>> + #define  AU6601_INT_END_BIT         0x00040000
>> + #define  AU6601_INT_INDEX           0x00080000
>> + #define  AU6601_INT_DATA_TIMEOUT    0x00100000
>> + #define  AU6601_INT_DATA_CRC                0x00200000
>> + #define  AU6601_INT_DATA_END_BIT    0x00400000
>> + #define  AU6601_INT_BUS_POWER               0x00800000
>> + #define  AU6601_INT_ACMD12ERR               0x01000000
>> + #define  AU6601_INT_ADMA_ERROR              0x02000000
>> +
>> + #define  AU6601_INT_NORMAL_MASK     0x00007FFF
>> + #define  AU6601_INT_ERROR_MASK              0xFFFF8000
>> +
>> +/* magic 0xF0001 */
>> + #define  AU6601_INT_CMD_MASK        (AU6601_INT_RESPONSE | AU6601_INT_TIMEOUT | \
>> +             AU6601_INT_CRC | AU6601_INT_END_BIT | AU6601_INT_INDEX)
>> +/* magic 0x70003A */
>> + #define  AU6601_INT_DATA_MASK       (AU6601_INT_DATA_END | AU6601_INT_DMA_END | \
>> +             AU6601_INT_DATA_AVAIL | AU6601_INT_SPACE_AVAIL | \
>> +             AU6601_INT_DATA_TIMEOUT | AU6601_INT_DATA_CRC | \
>> +             AU6601_INT_DATA_END_BIT)
>> + #define AU6601_INT_ALL_MASK ((uint32_t)-1)
>> +
>> +bool disable_dma = 0;
>> +
>> +struct au6601_host {
>> +     struct pci_dev *pdev;
>> +     struct  device *dev;
>> +     void __iomem *iobase;
>> +     void __iomem *virt_base;
>> +     dma_addr_t phys_base;
>> +
>> +     struct mmc_host *mmc;
>> +     struct mmc_request *mrq;
>> +     struct mmc_command *cmd;
>> +     struct mmc_data *data;
>> +     unsigned int data_early:1;      /* Data finished before cmd */
>> +     unsigned int dma_on:1;
>> +     unsigned int trigger_dma_dac:1; /* Trigger Data after Command.
>> +                                      * In some cases data ragister
>> +                                      * should be triggered after
>> +                                      * command was done */
>> +
>> +     struct mutex cmd_mutex;
>> +
>> +     struct timer_list timer;
>> +
>> +     struct sg_mapping_iter sg_miter;        /* SG state for PIO */
>> +     unsigned int blocks;            /* remaining PIO blocks */
>> +     unsigned int requested_blocks;          /* count of requested */
>> +     int sg_count;      /* Mapped sg entries */
>> +};
>> +
>> +static void au6601_send_cmd(struct au6601_host *host,
>> +                         struct mmc_command *cmd);
>> +
>> +static void au6601_prepare_data(struct au6601_host *host,
>> +                             struct mmc_command *cmd);
>> +static void au6601_finish_data(struct au6601_host *host);
>> +static void au6601_request_complete(struct au6601_host *host);
>> +
>> +static const struct pci_device_id pci_ids[] = {
>> +     {
>> +             .vendor  = PCI_ID_ALCOR_MICRO,
>> +             .device  = PCI_ID_AU6601,
>> +             .subvendor      = PCI_ANY_ID,
>> +             .subdevice      = PCI_ANY_ID,
>> +     },
>> +     { /* end: all zeroes */ },
>> +};
>> +MODULE_DEVICE_TABLE(pci, pci_ids);
>> +
>> +static inline void au6601_rmw(void __iomem *reg, u32 clear, u32 set)
>> +{
>> +     u32 var;
>> +
>> +     var = ioread32(reg);
>> +     var &= ~clear;
>> +     var |= set;
>> +     iowrite32(var, reg);
>> +}
>> +
>> +static inline void au6601_mask_irqs(struct au6601_host *host)
>> +{
>> +     iowrite32(0, host->iobase + AU6601_REG_INT_ENABLE);
>> +}
>> +
>> +static inline void au6601_unmask_irqs(struct au6601_host *host)
>> +{
>> +     iowrite32(AU6601_INT_CMD_MASK | AU6601_INT_DATA_MASK |
>> +               AU6601_INT_CARD_INSERT | AU6601_INT_CARD_REMOVE |
>> +               AU6601_INT_CARD_INT | AU6601_INT_BUS_POWER,
>> +               host->iobase + AU6601_REG_INT_ENABLE);
>> +}
>> +
>> +static void au6601_clear_set_reg86(struct au6601_host *host, u32 clear, u32 set)
>> +{
>> +     au6601_rmw(host->iobase + REG_86, clear, set);
>> +}
>> +
>> +/*
>> + * check if one of data line is pulled down
>> + */
>> +static inline int au6601_card_busy(struct au6601_host *host)
>> +{
>> +     u8 status;
>> +
>> +     status = (ioread8(host->iobase + AU6601_REG_BUS_STATUS) &
>> +             AU6601_BUS_STAT_DAT_MASK);
>> +     /* If all data lines are up, then card is not busy */
>> +     if (status == (AU6601_BUS_STAT_DAT0 | AU6601_BUS_STAT_DAT1 |
>> +                    AU6601_BUS_STAT_DAT2 | AU6601_BUS_STAT_DAT3))
>> +             return 0;
>> +
>> +     return 1;
>> +}
>> +
>> +/* val = 0x1 abort command; 0x8 abort data? */
>> +static void au6601_reset(struct au6601_host *host, u8 val)
>> +{
>> +     int i;
>> +
>> +     iowrite8(val | AU6601_RESET_UNK, host->iobase + AU6601_REG_SW_RESET);
>> +     for (i = 0; i < 100; i++) {
>> +             if (!(ioread8(host->iobase + AU6601_REG_SW_RESET) & val))
>> +                     return;
>> +             udelay(50);
>> +     }
>> +     dev_err(host->dev, "%s: timeout\n", __func__);
>> +}
>> +
>> +/*
>> + * - 0x8     only Vcc is on
>> + * - 0x1     Vcc and other pins are on
>> + * - 0x1 | 0x8       like 0x1, but DAT2 is off
>> + */
>> +static void au6601_set_power(struct au6601_host *host,
>> +                          unsigned int value, unsigned int set)
>> +{
>> +     u8 tmp1, tmp2;
>> +
>> +     tmp1 = ioread8(host->iobase + REG_70);
>> +     tmp2 = ioread8(host->iobase + REG_7A);
>> +     if (set) {
>> +             iowrite8(tmp1 | value, host->iobase + REG_70);
>> +             iowrite8(tmp2 | value, host->iobase + REG_7A);
>> +     } else {
>> +             iowrite8(tmp2 & ~value, host->iobase + REG_7A);
>> +             iowrite8(tmp1 & ~value, host->iobase + REG_70);
>> +     }
>> +}
>> +
>> +static void au6601_trigger_data_transfer(struct au6601_host *host,
>> +             unsigned int dma)
>> +{
>> +     struct mmc_data *data = host->data;
>> +     u8 ctrl = 0;
>> +
>> +     if (data->flags & MMC_DATA_WRITE)
>> +             ctrl |= 0x80;
>> +
>> +     if (dma) {
>> +             iowrite32(host->phys_base, host->iobase + AU6601_REG_SDMA_ADDR);
>> +             ctrl |= 0x40;
>> +             host->dma_on = 1;
>> +
>> +             if (data->flags & MMC_DATA_WRITE)
>> +                     goto done;
>> +             /* prepare first DMA buffer for write operation */
>> +             if (host->blocks > AU6601_MAX_DMA_BLOCKS)
>> +                     host->requested_blocks = AU6601_MAX_DMA_BLOCKS;
>> +             else
>> +                     host->requested_blocks = host->blocks;
>> +
>> +     }
>> +
>> +done:
>> +     iowrite32(data->blksz * host->requested_blocks,
>> +             host->iobase + AU6601_REG_BLOCK_SIZE);
>> +     iowrite8(ctrl | 0x1, host->iobase + REG_83);
>> +}
>> +
>> +/*****************************************************************************\
>> + *                                                                        *
>> + * Core functions                                                         *
>> + *                                                                        *
>> +\*****************************************************************************/
>> +
>> +static void au6601_read_block(struct au6601_host *host)
>> +{
>> +     size_t blksize, len, chunk = 0;
>> +     void __iomem *virt_base = host->virt_base;
>> +     u8 *buf;
>> +
>> +     dev_dbg(host->dev, "PIO reading\n");
>> +
>> +     blksize = host->data->blksz * host->requested_blocks;
>> +
>> +     while (blksize) {
>> +             if (!sg_miter_next(&host->sg_miter))
>> +                     BUG();
>> +
>> +             len = min(host->sg_miter.length, blksize);
>> +
>> +             blksize -= len;
>> +             host->sg_miter.consumed = len;
>> +
>> +             buf = host->sg_miter.addr;
>> +
>> +             if (host->dma_on) {
>> +                     memcpy_fromio(buf, virt_base, len);
>> +                     virt_base += len;
>> +                     len = 0;
>> +             } else {
>> +                     while (len) {
>> +                             u32 scratch;
>> +
>> +                             if (chunk == 0) {
>> +                                     scratch = ioread32(host->iobase +
>> +                                                     AU6601_REG_BUFFER);
>> +                                     chunk = 4;
>> +                             }
>> +
>> +                             *buf = scratch & 0xFF;
>> +
>> +                             buf++;
>> +                             scratch >>= 8;
>> +                             chunk--;
>> +                             len--;
>> +                     }
>> +             }
>> +     }
>> +
>> +     sg_miter_stop(&host->sg_miter);
>> +}
>> +
>> +static void au6601_write_block(struct au6601_host *host)
>> +{
>> +     size_t blksize, len, chunk = 0;
>> +     void __iomem *virt_base = host->virt_base;
>> +     u32 scratch = 0;
>> +     u8 *buf;
>> +
>> +     dev_dbg(host->dev, "PIO writing\n");
>> +
>> +     blksize = host->data->blksz * host->requested_blocks;
>> +
>> +     while (blksize) {
>> +             if (!sg_miter_next(&host->sg_miter))
>> +                     BUG();
>> +
>> +             len = min(host->sg_miter.length, blksize);
>> +
>> +             blksize -= len;
>> +             host->sg_miter.consumed = len;
>> +
>> +             buf = host->sg_miter.addr;
>> +
>> +             if (host->dma_on) {
>> +                     memcpy_toio(virt_base, buf, len);
>> +                     virt_base += len;
>> +                     len = 0;
>> +             } else {
>> +                     while (len) {
>> +                             scratch |= (u32)*buf << (chunk * 8);
>> +
>> +                             buf++;
>> +                             chunk++;
>> +                             len--;
>> +
>> +                             if ((chunk == 4) || ((len == 0)
>> +                                             && (blksize == 0))) {
>> +                                     iowrite32(scratch, host->iobase +
>> +                                             AU6601_REG_BUFFER);
>> +                                     chunk = 0;
>> +                                     scratch = 0;
>> +                             }
>> +                     }
>> +             }
>> +     }
>> +
>> +     sg_miter_stop(&host->sg_miter);
>> +}
>> +
>> +static void au6601_transfer_data(struct au6601_host *host)
>> +{
>> +     if (host->blocks == 0)
>> +             return;
>> +
>> +     if (host->data->flags & MMC_DATA_READ)
>> +             au6601_read_block(host);
>> +     else
>> +             au6601_write_block(host);
>> +
>> +     host->blocks -= host->requested_blocks;
>> +     if (host->dma_on) {
>> +             host->dma_on = 0;
>> +             if (host->blocks || (!host->blocks &&
>> +                             (host->data->flags & MMC_DATA_WRITE)))
>> +                     au6601_trigger_data_transfer(host, 1);
>> +             else
>> +                     au6601_finish_data(host);
>> +     }
>> +
>> +     dev_dbg(host->dev, "PIO transfer complete.\n");
>> +}
>> +
>> +static void au6601_finish_command(struct au6601_host *host)
>> +{
>> +     struct mmc_command *cmd = host->cmd;
>> +
>> +     if (host->cmd->flags & MMC_RSP_PRESENT) {
>> +             cmd->resp[0] = ioread32be(host->iobase + AU6601_REG_CMD_RSP0);
>> +             if (host->cmd->flags & MMC_RSP_136) {
>> +                     cmd->resp[1] =
>> +                             ioread32be(host->iobase + AU6601_REG_CMD_RSP1);
>> +                     cmd->resp[2] =
>> +                             ioread32be(host->iobase + AU6601_REG_CMD_RSP2);
>> +                     cmd->resp[3] =
>> +                             ioread32be(host->iobase + AU6601_REG_CMD_RSP3);
>> +             }
>> +
>> +     }
>> +
>> +     host->cmd->error = 0;
>> +
>> +     /* Finished CMD23, now send actual command. */
>> +     if (host->cmd == host->mrq->sbc) {
>> +             host->cmd = NULL;
>> +             au6601_send_cmd(host, host->mrq->cmd);
>> +     } else {
>> +             /* Processed actual command. */
>> +             if (!host->data)
>> +                     au6601_request_complete(host);
>> +             else if (host->data_early)
>> +                     au6601_finish_data(host);
>> +             else if (host->trigger_dma_dac) {
>> +                     host->dma_on = 1;
>> +                     au6601_transfer_data(host);
>> +             }
>> +
>> +             host->cmd = NULL;
>> +     }
>> +}
>> +
>> +static void au6601_finish_data(struct au6601_host *host)
>> +{
>> +     struct mmc_data *data;
>> +
>> +     data = host->data;
>> +     host->data = NULL;
>> +     host->dma_on = 0;
>> +     host->trigger_dma_dac = 0;
>> +
>> +     /*
>> +      * The specification states that the block count register must
>> +      * be updated, but it does not specify at what point in the
>> +      * data flow. That makes the register entirely useless to read
>> +      * back so we have to assume that nothing made it to the card
>> +      * in the event of an error.
>> +      */
>> +     if (data->error)
>> +             data->bytes_xfered = 0;
>> +     else
>> +             data->bytes_xfered = data->blksz * data->blocks;
>> +
>> +     /*
>> +      * Need to send CMD12 if -
>> +      * a) open-ended multiblock transfer (no CMD23)
>> +      * b) error in multiblock transfer
>> +      */
>> +     if (data->stop &&
>> +         (data->error ||
>> +          !host->mrq->sbc)) {
>> +
>> +             /*
>> +              * The controller needs a reset of internal state machines
>> +              * upon error conditions.
>> +              */
>> +             if (data->error) {
>> +                     au6601_reset(host, AU6601_RESET_CMD);
>> +                     au6601_reset(host, AU6601_RESET_DATA);
>> +             }
>> +             au6601_send_cmd(host, data->stop);
>> +     } else
>> +             au6601_request_complete(host);
>> +}
>> +
>> +static void au6601_prepare_sg_miter(struct au6601_host *host)
>> +{
>> +     unsigned int flags = SG_MITER_ATOMIC;
>> +     struct mmc_data *data = host->data;
>> +
>> +     if (data->flags & MMC_DATA_READ)
>> +             flags |= SG_MITER_TO_SG;
>> +     else
>> +             flags |= SG_MITER_FROM_SG;
>> +     sg_miter_start(&host->sg_miter, data->sg, data->sg_len, flags);
>> +}
>> +
>> +static void au6601_prepare_data(struct au6601_host *host,
>> +                             struct mmc_command *cmd)
>> +{
>> +     unsigned int dma = 0;
>> +     struct mmc_data *data = cmd->data;
>> +
>> +     if (!data)
>> +             return;
>> +
>> +     /* Sanity checks */
>> +     BUG_ON(data->blksz * data->blocks > 524288);
>> +     BUG_ON(data->blksz > host->mmc->max_blk_size);
>> +     BUG_ON(data->blocks > AU6601_MAX_BLOCK_COUNT);
>> +
>> +     host->data = data;
>> +     host->data_early = 0;
>> +     host->data->bytes_xfered = 0;
>> +     host->requested_blocks = 1;
>> +
>> +     au6601_prepare_sg_miter(host);
>> +     host->blocks = data->blocks;
>> +
>> +     if (!disable_dma &&
>> +                     host->blocks > 1 &&
>> +                     data->blksz == host->mmc->max_blk_size) {
>> +             dma = 1;
>> +
>> +             if (data->flags & MMC_DATA_WRITE) {
>> +                     /* prepare first write buffer */
>> +                     /* Don't trigger data transfer now.
>> +                      * DMA may start it too eraly */
>> +                     host->trigger_dma_dac = 1;
>> +                     return;
>> +             }
>> +     }
>> +
>> +     au6601_trigger_data_transfer(host, dma);
>> +}
>> +
>> +static void au6601_send_cmd(struct au6601_host *host,
>> +                         struct mmc_command *cmd)
>> +{
>> +     u8 ctrl; /*some mysterious flags and control */
>> +     unsigned long timeout;
>> +
>> +     timeout = jiffies;
>> +     if (!cmd->data && cmd->busy_timeout > 9000)
>> +             timeout += DIV_ROUND_UP(cmd->busy_timeout, 1000) * HZ + HZ;
>> +     else
>> +             timeout += 10 * HZ;
>> +     mod_timer(&host->timer, timeout);
>> +
>> +     host->cmd = cmd;
>> +     au6601_prepare_data(host, cmd);
>> +
>> +     iowrite8(cmd->opcode | 0x40, host->iobase + AU6601_REG_CMD_OPCODE);
>> +     iowrite32be(cmd->arg, host->iobase + AU6601_REG_CMD_ARG);
>> +
>> +     switch (mmc_resp_type(cmd)) {
>> +     case MMC_RSP_NONE:
>> +             ctrl = 0;
>> +             break;
>> +     case MMC_RSP_R1:
>> +             ctrl = 0x40;
>> +             break;
>> +     case MMC_RSP_R1B:
>> +             ctrl = 0x40 | 0x10;
>> +             break;
>> +     case MMC_RSP_R2:
>> +             ctrl = 0xc0;
>> +             break;
>> +     case MMC_RSP_PRESENT | MMC_RSP_OPCODE:
>> +     case MMC_RSP_R3:
>> +             ctrl = 0x80;
>> +             break;
>> +     default:
>> +             dev_err(host->dev, "%s: cmd->flag (0x%02x) is not valid\n",
>> +                     mmc_hostname(host->mmc), mmc_resp_type(cmd));
>> +             break;
>> +     }
>> +
>> +     iowrite8(ctrl | 0x20, host->iobase + AU6601_REG_CMD_CTRL);
>> +}
>> +
>> +/*****************************************************************************\
>> + *                                                                        *
>> + * Interrupt handling                                                             *
>> + *                                                                        *
>> +\*****************************************************************************/
>> +
>> +static void au6601_cmd_irq(struct au6601_host *host, u32 intmask)
>> +{
>> +     if (!host->cmd) {
>> +             dev_err(host->dev,
>> +                     "Got command interrupt 0x%08x even though no command operation was in progress.\n",
>> +                     intmask);
>> +             return;
>> +     }
>> +
>> +     if (intmask & AU6601_INT_TIMEOUT)
>> +             host->cmd->error = -ETIMEDOUT;
>> +     else if (intmask & (AU6601_INT_CRC | AU6601_INT_END_BIT |
>> +                     AU6601_INT_INDEX))
>> +             host->cmd->error = -EILSEQ;
>> +
>> +     if (host->cmd->error) {
>> +             au6601_request_complete(host);
>> +             return;
>> +     }
>> +
>> +     /*
>> +      * The host can send and interrupt when the busy state has
>> +      * ended, allowing us to wait without wasting CPU cycles.
>> +      * Unfortunately this is overloaded on the "data complete"
>> +      * interrupt, so we need to take some care when handling
>> +      * it.
>> +      *
>> +      * Note: The 1.0 specification is a bit ambiguous about this
>> +      *       feature so there might be some problems with older
>> +      *       controllers.
>> +      */
>> +     if (host->cmd->flags & MMC_RSP_BUSY) {
>> +             if (host->cmd->data)
>> +                     dev_warn(host->dev,
>> +                              "Cannot wait for busy signal when also doing a data transfer");
>> +     }
>> +
>> +     if (intmask & AU6601_INT_RESPONSE)
>> +             au6601_finish_command(host);
>> +}
>> +
>> +static void au6601_data_irq(struct au6601_host *host, u32 intmask)
>> +{
>> +     if (!host->data) {
>> +             /* FIXME: Ist is same for AU6601
>> +              * The "data complete" interrupt is also used to
>> +              * indicate that a busy state has ended. See comment
>> +              * above in au6601_cmd_irq().
>> +              */
>> +             if (host->cmd && (host->cmd->flags & MMC_RSP_BUSY)) {
>> +                     if (intmask & AU6601_INT_DATA_END) {
>> +                             au6601_finish_command(host);
>> +                             return;
>> +                     }
>> +             }
>> +
>> +             dev_err(host->dev,
>> +                     "Got data interrupt 0x%08x even though no data operation was in progress.\n",
>> +                     (unsigned)intmask);
>> +
>> +             if (intmask & AU6601_INT_ERROR_MASK) {
>> +                     host->cmd->error = -ETIMEDOUT;
>> +                     au6601_request_complete(host);
>> +             }
>> +             return;
>> +     }
>> +
>> +     if (intmask & AU6601_INT_DATA_TIMEOUT)
>> +             host->data->error = -ETIMEDOUT;
>> +     else if (intmask & AU6601_INT_DATA_END_BIT)
>> +             host->data->error = -EILSEQ;
>> +     else if (intmask & AU6601_INT_DATA_CRC)
>> +             host->data->error = -EILSEQ;
>> +
>> +     if (host->data->error)
>> +             au6601_finish_data(host);
>> +     else {
>> +             if (intmask & (AU6601_INT_DATA_AVAIL | AU6601_INT_SPACE_AVAIL))
>> +                     au6601_transfer_data(host);
>> +
>> +             if (intmask & AU6601_INT_DATA_END) {
>> +                     if (host->cmd) {
>> +                             /*
>> +                              * Data managed to finish before the
>> +                              * command completed. Make sure we do
>> +                              * things in the proper order.
>> +                              */
>> +                             host->data_early = 1;
>> +                     } else if (host->blocks && !host->dma_on) {
>> +                             /*
>> +                              * Probably we do multi block operation.
>> +                              * Prepare PIO for next block.
>> +                              */
>> +                             au6601_trigger_data_transfer(host, 0);
>> +                     } else if (host->blocks && host->dma_on) {
>> +                             au6601_transfer_data(host);
>> +                     } else {
>> +                             if (host->dma_on)
>> +                                     au6601_transfer_data(host);
>> +                             au6601_finish_data(host);
>> +                     }
>> +             }
>> +     }
>> +}
>> +
>> +static irqreturn_t au6601_irq(int irq, void *d)
>> +{
>> +     struct au6601_host *host = d;
>> +     irqreturn_t ret = IRQ_HANDLED;
>> +     u32 intmask;
>> +
>> +     mutex_lock(&host->cmd_mutex);
>> +
>> +     intmask = ioread32(host->iobase + AU6601_REG_INT_STATUS);
>> +     iowrite32(intmask, host->iobase + AU6601_REG_INT_STATUS);
>> +
>> +     /* some thing bad */
>> +     if (unlikely(!intmask || intmask == AU6601_INT_ALL_MASK)) {
>> +             ret = IRQ_NONE;
>> +             goto exit;
>> +     }
>> +
>> +     if (intmask & AU6601_INT_CMD_MASK) {
>> +             dev_dbg(host->dev, "CMD IRQ %x\n", intmask);
>> +
>> +             au6601_cmd_irq(host, intmask & AU6601_INT_CMD_MASK);
>> +             intmask &= ~AU6601_INT_CMD_MASK;
>> +     }
>> +
>> +     if (intmask & AU6601_INT_DATA_MASK) {
>> +             dev_dbg(host->dev, "DATA IRQ %x\n", intmask);
>> +             au6601_data_irq(host, intmask & AU6601_INT_DATA_MASK);
>> +             intmask &= ~AU6601_INT_DATA_MASK;
>> +     }
>> +
>> +     if (intmask & (AU6601_INT_CARD_INSERT | AU6601_INT_CARD_REMOVE)) {
>> +             /* this check can be remove */
>> +             if (intmask & AU6601_INT_CARD_REMOVE)
>> +                     dev_dbg(host->dev, "card removed\n");
>> +             else
>> +                     dev_dbg(host->dev, "card inserted\n");
>> +
>> +             intmask &= ~(AU6601_INT_CARD_INSERT | AU6601_INT_CARD_REMOVE);
>> +             mmc_detect_change(host->mmc, msecs_to_jiffies(200));
>> +     }
>> +
>> +     if (intmask & 0x100) {
>> +             dev_warn(host->dev,
>> +                      "0x100 (card INT?) got unknown IRQ with %x\n",
>> +                      intmask);
>> +             intmask &= ~0x100;
>> +     }
>> +
>> +     if (intmask & 0xFFFF7FFF) {
>> +             dev_warn(host->dev, "0xFFFF7FFF got unhandled IRQ with %x\n",
>> +                      intmask);
>> +     }
>> +
>> +exit:
>> +     mutex_unlock(&host->cmd_mutex);
>> +     return ret;
>> +}
>> +
>> +static void au6601_sdc_request(struct mmc_host *mmc, struct mmc_request *mrq)
>> +{
>> +     struct au6601_host *host;
>> +
>> +     host = mmc_priv(mmc);
>> +     mutex_lock(&host->cmd_mutex);
>> +
>> +     host->mrq = mrq;
>> +
>> +     /* check if card is present then send command and data */
>> +     if (ioread8(host->iobase + REG_76) & 0x1)
>> +             au6601_send_cmd(host, mrq->cmd);
>> +     else {
>> +             mrq->cmd->error = -ENOMEDIUM;
>> +             au6601_request_complete(host);
>> +     }
>> +
>> +     mutex_unlock(&host->cmd_mutex);
>> +}
>> +
>> +static void au6601_set_clock(struct au6601_host *host, unsigned int clock)
>> +{
>> +     unsigned int div = 0, mult = 0, ctrl = 0x1;
>> +
>> +     /* FIXME: mesuered and calculated values are different.
>> +      * the clock is unstable in some mult/div combinations.
>> +      */
>> +     if (clock >= MHZ_TO_HZ(208)) {
>> +             mult = 0xb0;    /* 30 * ? / 2 = ?MHz */
>> +             div = 2;
>> +     } else if (clock >= MHZ_TO_HZ(194)) {
>> +             mult = 0x30;    /* 30 * 14 / 2 = 210MHz */
>> +             div = 2;
>> +     } else if (clock >= MHZ_TO_HZ(130)) {
>> +             mult = 0x30;    /* 30 * 14 / 3 = 140MHz */
>> +             div = 3;
>> +     } else if (clock >= MHZ_TO_HZ(100)) {
>> +             mult = 0x30;    /* 30 * 14 / 4 = 105MHz */
>> +             div = 4;
>> +     } else if (clock >= MHZ_TO_HZ(80)) {
>> +             mult = 0x30;    /* 30 * 14 / 5 = 84MHz */
>> +             div = 5;
>> +     } else if (clock >= MHZ_TO_HZ(60)) {
>> +             mult = 0x30;    /* 30 * 14 / 7 = 60MHz */
>> +             div = 7;
>> +     } else if (clock >= MHZ_TO_HZ(50)) {
>> +             mult = 0x10;    /* 30 * 2 / 1 = 60MHz */
>> +             div = 1;
>> +     } else if (clock >= MHZ_TO_HZ(40)) {
>> +             mult = 0x30;    /* 30 * 14 / 10 = 42MHz */
>> +             div = 10;
>> +     } else if (clock >= MHZ_TO_HZ(25)) {
>> +             mult = 0x10;    /* 30 * 2 / 2 = 30MHz */
>> +             div = 2;
>> +     } else if (clock >= MHZ_TO_HZ(20)) {
>> +             mult = 0x20;    /* 30 * 4 / 7 = 17MHz */
>> +             div = 7;
>> +     } else if (clock >= MHZ_TO_HZ(10)) {
>> +             mult = 0x10;    /* 30 * 2 / 5 = 12MHz */
>> +             div = 5;
>> +     } else if (clock >= MHZ_TO_HZ(5)) {
>> +             mult = 0x10;    /* 30 * 2 / 10 = 6MHz */
>> +             div = 10;
>> +     } else if (clock >= MHZ_TO_HZ(1)) {
>> +             mult = 0x0;     /* 30 / 16 = 1,8 MHz */
>> +             div = 16;
>> +     } else if (clock == 0) {
>> +             ctrl = 0;
>> +     } else {
>> +             mult = 0x0;     /* reversed 150 * 200 = 30MHz */
>> +             div = 200;      /* 150 KHZ mesured */
>> +     }
>> +     dev_dbg(host->dev, "set freq %d, %x, %x\n", clock, div, mult);
>> +     iowrite16((div - 1) << 8 | mult | ctrl,
>> +               host->iobase + AU6601_REG_PLL_CTRL);
>> +}
>> +
>> +static void au6601_sdc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
>> +{
>> +     struct au6601_host *host;
>> +
>> +     host = mmc_priv(mmc);
>> +     mutex_lock(&host->cmd_mutex);
>> +
>> +     iowrite8(0, host->iobase + REG_85);
>> +     iowrite8(0x31, host->iobase + REG_7B);
>> +     iowrite8(0x33, host->iobase + REG_7C);
>> +     iowrite8(1, host->iobase + REG_75);
>> +     iowrite8(0, host->iobase + REG_85);
>> +
>> +     if (ios->bus_width == MMC_BUS_WIDTH_1) {
>> +             iowrite8(0x0,
>> +                      host->iobase + AU6601_REG_BUS_CTRL);
>> +             au6601_clear_set_reg86(host, 0xc0, 0);
>> +     } else if (ios->bus_width == MMC_BUS_WIDTH_4) {
>> +             iowrite8(AU6601_BUS_WIDTH_4BIT,
>> +                      host->iobase + AU6601_REG_BUS_CTRL);
>> +             au6601_clear_set_reg86(host, 0, 0xc0);
>> +     } else
>> +             dev_err(host->dev, "Unknown BUS mode\n");
>> +
>> +     au6601_set_clock(host, ios->clock);
>> +
>> +     switch (ios->power_mode) {
>> +     case MMC_POWER_OFF:
>> +             au6601_set_power(host, 0x1 | 0x8, 0);
>> +             break;
>> +     case MMC_POWER_UP:
>> +             au6601_set_power(host, 0x8, 1);
>> +             break;
>> +     case MMC_POWER_ON:
>> +             au6601_set_power(host, 0x1, 1);
>> +             au6601_set_power(host, 0x8, 0);
>> +             break;
>> +     default:
>> +             dev_err(host->dev, "Unknown power parametr\n");
>> +     }
>> +
>> +     iowrite8(0x80, host->iobase + REG_83);
>> +     iowrite8(0x7d, host->iobase + REG_69);
>> +     ioread8(host->iobase + REG_74);
>> +     mutex_unlock(&host->cmd_mutex);
>> +}
>> +
>> +static int au6601_ops_card_busy(struct mmc_host *mmc)
>> +{
>> +     struct au6601_host *host = mmc_priv(mmc);
>> +
>> +     return au6601_card_busy(host);
>> +}
>> +
>> +static const struct mmc_host_ops au6601_sdc_ops = {
>> +     .request        = au6601_sdc_request,
>> +     .set_ios        = au6601_sdc_set_ios,
>> +
>> +     .card_busy      = au6601_ops_card_busy,
>> +};
>> +
>> +static void au6601_request_complete(struct au6601_host *host)
>> +{
>> +     struct mmc_request *mrq;
>> +
>> +     /*
>> +      * If this tasklet gets rescheduled while running, it will
>> +      * be run again afterwards but without any active request.
>> +      */
>> +     if (!host->mrq)
>> +             return;
>> +
>> +     del_timer(&host->timer);
>> +
>> +     mrq = host->mrq;
>> +
>> +     /*
>> +      * The controller needs a reset of internal state machines
>> +      * upon error conditions.
>> +      */
>> +     if ((mrq->cmd && mrq->cmd->error) ||
>> +              (mrq->data && (mrq->data->error ||
>> +               (mrq->data->stop && mrq->data->stop->error)))) {
>> +
>> +             au6601_reset(host, AU6601_RESET_CMD);
>> +             au6601_reset(host, AU6601_RESET_DATA);
>> +     }
>> +
>> +     host->mrq = NULL;
>> +     host->cmd = NULL;
>> +     host->data = NULL;
>> +     host->dma_on = 0;
>> +     host->trigger_dma_dac = 0;
>> +
>> +     mmc_request_done(host->mmc, mrq);
>> +}
>> +
>> +static void au6601_timeout_timer(unsigned long data)
>> +{
>> +     struct au6601_host *host;
>> +
>> +     host = (struct au6601_host *)data;
>> +
>> +     mutex_lock(&host->cmd_mutex);
>> +
>> +     if (host->mrq) {
>> +             dev_err(host->dev,
>> +                     "Timeout waiting for hardware interrupt.\n");
>> +
>> +             if (host->data) {
>> +                     host->data->error = -ETIMEDOUT;
>> +                     au6601_finish_data(host);
>> +             } else {
>> +                     if (host->cmd)
>> +                             host->cmd->error = -ETIMEDOUT;
>> +                     else
>> +                             host->mrq->cmd->error = -ETIMEDOUT;
>> +
>> +                     au6601_request_complete(host);
>> +             }
>> +     }
>> +
>> +     mmiowb();
>> +     mutex_unlock(&host->cmd_mutex);
>> +}
>> +
>> +
>> +
>> +static void au6601_init_mmc(struct au6601_host *host)
>> +{
>> +     struct mmc_host *mmc = host->mmc;
>> +
>> +     mmc->f_min = AU6601_MIN_CLOCK;
>> +     mmc->f_max = AU6601_MAX_CLOCK;
>> +     mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34;
>> +     mmc->caps = MMC_CAP_4_BIT_DATA | MMC_CAP_SD_HIGHSPEED | MMC_CAP_WAIT_WHILE_BUSY;
>> +     mmc->ops = &au6601_sdc_ops;
>> +
>> +     /* Hardware cannot do scatter lists? */
>> +     mmc->max_segs = AU6601_MAX_SEGMENTS;
>> +
>> +     mmc->max_blk_size = AU6601_MAX_BLOCK_LENGTH;
>> +     mmc->max_blk_count = AU6601_MAX_BLOCK_COUNT;
>> +
>> +     mmc->max_seg_size = AU6601_MAX_BLOCK_LENGTH * AU6601_MAX_DMA_BLOCKS;
>> +     mmc->max_req_size = mmc->max_seg_size * mmc->max_segs;
>> +}
>> +
>> +static void au6601_hw_init(struct au6601_host *host)
>> +{
>> +
>> +     iowrite8(0, host->iobase + REG_74);
>> +
>> +     iowrite8(0, host->iobase + REG_76);
>> +     /* disable DlinkMode? disabled by default. */
>> +     iowrite8(0x80, host->iobase + REG_76);
>> +
>> +     au6601_reset(host, AU6601_RESET_CMD);
>> +
>> +     iowrite8(0x0, host->iobase + REG_05);
>> +     iowrite8(0x1, host->iobase + REG_75);
>> +
>> +     au6601_unmask_irqs(host);
>> +
>> +     iowrite32(0x0, host->iobase + AU6601_REG_BUS_CTRL);
>> +
>> +     au6601_reset(host, AU6601_RESET_DATA);
>> +
>> +     iowrite8(0x0, host->iobase + REG_05);
>> +     iowrite8(0x0, host->iobase + REG_85);
>> +     iowrite8(0x8, host->iobase + REG_75);
>> +     iowrite32(0x3d00fa, host->iobase + REG_B4);
>> +
>> +     au6601_set_power(host, 0x1, 0);
>> +     au6601_set_power(host, 0x8, 0);
>> +
>> +     host->dma_on = 0;
>> +}
>> +
>> +static int __init au6601_dma_alloc(struct au6601_host *host)
>> +{
>> +     int ret;
>> +
>> +     ret = pci_set_dma_mask(host->pdev, AU6601_SDMA_MASK);
>> +     if (ret) {
>> +             dev_err(host->dev, "Failed to set DMA mask\n");
>> +             return ret;
>> +     }
>> +
>> +     host->virt_base = dmam_alloc_coherent(host->dev,
>> +             AU6601_MAX_BLOCK_LENGTH * AU6601_MAX_DMA_BLOCKS * AU6601_DMA_LOCAL_SEGMENTS,
>> +             &host->phys_base, GFP_KERNEL);
>> +
>> +     if (!host->virt_base) {
>> +             dev_err(host->dev, "Failed to alloc DMA\n");
>> +             return -ENOMEM;
>> +     }
>> +
>> +     return 0;
>> +}
>> +
>> +static int __init au6601_pci_probe(struct pci_dev *pdev,
>> +                        const struct pci_device_id *ent)
>> +{
>> +     struct mmc_host *mmc;
>> +     struct au6601_host *host;
>> +     int ret, bar = 0;
>> +
>> +     dev_info(&pdev->dev, "AU6601 controller found [%04x:%04x] (rev %x)\n",
>> +              (int)pdev->vendor, (int)pdev->device, (int)pdev->revision);
>> +
>> +     if (!(pci_resource_flags(pdev, bar) & IORESOURCE_MEM)) {
>> +             dev_err(&pdev->dev, "BAR %d is not iomem. Aborting.\n", bar);
>> +             return -ENODEV;
>> +     }
>> +
>> +
>> +     ret = pcim_enable_device(pdev);
>> +     if (ret)
>> +             return ret;
>> +
>> +     /* FIXME: create managed version of mmc_alloc_host and use it */
>> +     mmc = mmc_alloc_host(sizeof(struct au6601_host *), &pdev->dev);
>> +     if (!mmc) {
>> +             dev_err(&pdev->dev, "Can't allocate MMC\n");
>> +             return -ENOMEM;
>> +     }
>> +
>> +     host = mmc_priv(mmc);
>> +     host->mmc = mmc;
>> +     host->pdev = pdev;
>> +     host->dev = &pdev->dev;
>> +
>> +     ret = pci_request_region(pdev, bar, DRVNAME);
>> +     if (ret) {
>> +             dev_err(&pdev->dev, "Cannot request region\n");
>> +             return -ENOMEM;
>> +     }
>> +
>> +     host->iobase = pcim_iomap(pdev, bar, 0);
>> +     if (!host->iobase)
>> +             return -ENOMEM;
>> +
>> +     ret = devm_request_threaded_irq(&pdev->dev, pdev->irq, NULL, au6601_irq,
>> +                     IRQF_ONESHOT, "au6601 host",
>> +                     host);
>> +
>> +     if (ret) {
>> +             dev_err(&pdev->dev, "Failed to get irq for data line\n");
>> +             return -ENOMEM;
>> +     }
>> +
>> +     ret = au6601_dma_alloc(host);
>> +     if (ret)
>> +             return ret;
>> +
>> +     pci_set_master(pdev);
>> +     pci_set_drvdata(pdev, host);
>> +
>> +     mutex_init(&host->cmd_mutex);
>> +     /*
>> +      * Init tasklets.
>> +      */
>> +     setup_timer(&host->timer, au6601_timeout_timer, (unsigned long)host);
>> +
>> +     au6601_init_mmc(host);
>> +     au6601_hw_init(host);
>> +
>> +     mmc_add_host(mmc);
>> +     return 0;
>> +}
>> +
>> +static void au6601_hw_uninit(struct au6601_host *host)
>> +{
>> +     iowrite8(0x0, host->iobase + REG_76);
>> +     au6601_mask_irqs(host);
>> +
>> +     au6601_set_power(host, 0x1, 0);
>> +
>> +     iowrite8(0x0, host->iobase + REG_85);
>> +     iowrite8(0x0, host->iobase + REG_B4);
>> +
>> +     au6601_set_power(host, 0x8, 0);
>> +}
>> +
>> +static void __exit au6601_pci_remove(struct pci_dev *pdev)
>> +{
>> +     struct au6601_host *host;
>> +
>> +     host = pci_get_drvdata(pdev);
>> +
>> +     au6601_hw_uninit(host);
>> +
>> +     del_timer_sync(&host->timer);
>> +
>> +     mmc_remove_host(host->mmc);
>> +     mmc_free_host(host->mmc);
>> +}
>> +
>> +#ifdef CONFIG_PM_SLEEP
>> +static int au6601_suspend(struct device *dev)
>> +{
>> +     struct pci_dev *pdev = to_pci_dev(dev);
>> +     struct au6601_host *host = pci_get_drvdata(pdev);
>> +
>> +     au6601_hw_uninit(host);
>> +     return 0;
>> +}
>> +
>> +static int au6601_resume(struct device *dev)
>> +{
>> +
>> +     struct pci_dev *pdev = to_pci_dev(dev);
>> +     struct au6601_host *host = pci_get_drvdata(pdev);
>> +
>> +     au6601_hw_init(host);
>> +     return 0;
>> +}
>> +#endif /* CONFIG_PM_SLEEP */
>> +
>> +static SIMPLE_DEV_PM_OPS(au6601_pm_ops, au6601_suspend, au6601_resume);
>> +
>> +static struct pci_driver au6601_driver = {
>> +     .name   =        DRVNAME,
>> +     .id_table =     pci_ids,
>> +     .probe  =       au6601_pci_probe,
>> +     .remove =       au6601_pci_remove,
>> +     .driver =       {
>> +             .pm     = &au6601_pm_ops
>> +     },
>> +};
>> +
>> +module_pci_driver(au6601_driver);
>> +
>> +module_param(disable_dma, bool, S_IRUGO);
>> +MODULE_PARM_DESC(disable_dma, "Disable DMA");
>> +
>> +MODULE_AUTHOR("Oleksij Rempel <linux@xxxxxxxxxxxxxxxx>");
>> +MODULE_DESCRIPTION("PCI driver for Alcor Micro AU6601 Secure Digital Host Controller Interface");
>> +MODULE_LICENSE("GPL");
>>
>
>
> --
> Regards,
> Oleksij
>
--
To unsubscribe from this list: send the line "unsubscribe linux-mmc" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at  http://vger.kernel.org/majordomo-info.html




[Index of Archives]     [Linux USB Devel]     [Linux Media]     [Video for Linux]     [Linux Audio Users]     [Yosemite News]     [Linux Kernel]     [Linux SCSI]

  Powered by Linux