linux/drivers/net/wireless/rsi/rsi_91x_sdio.c
<<
>>
Prefs
   1/**
   2 * Copyright (c) 2014 Redpine Signals Inc.
   3 *
   4 * Permission to use, copy, modify, and/or distribute this software for any
   5 * purpose with or without fee is hereby granted, provided that the above
   6 * copyright notice and this permission notice appear in all copies.
   7 *
   8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
   9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  11 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15 *
  16 */
  17
  18#include <linux/module.h>
  19#include "rsi_sdio.h"
  20#include "rsi_common.h"
  21
  22/**
  23 * rsi_sdio_set_cmd52_arg() - This function prepares cmd 52 read/write arg.
  24 * @rw: Read/write
  25 * @func: function number
  26 * @raw: indicates whether to perform read after write
  27 * @address: address to which to read/write
  28 * @writedata: data to write
  29 *
  30 * Return: argument
  31 */
  32static u32 rsi_sdio_set_cmd52_arg(bool rw,
  33                                  u8 func,
  34                                  u8 raw,
  35                                  u32 address,
  36                                  u8 writedata)
  37{
  38        return ((rw & 1) << 31) | ((func & 0x7) << 28) |
  39                ((raw & 1) << 27) | (1 << 26) |
  40                ((address & 0x1FFFF) << 9) | (1 << 8) |
  41                (writedata & 0xFF);
  42}
  43
  44/**
  45 * rsi_cmd52writebyte() - This function issues cmd52 byte write onto the card.
  46 * @card: Pointer to the mmc_card.
  47 * @address: Address to write.
  48 * @byte: Data to write.
  49 *
  50 * Return: Write status.
  51 */
  52static int rsi_cmd52writebyte(struct mmc_card *card,
  53                              u32 address,
  54                              u8 byte)
  55{
  56        struct mmc_command io_cmd;
  57        u32 arg;
  58
  59        memset(&io_cmd, 0, sizeof(io_cmd));
  60        arg = rsi_sdio_set_cmd52_arg(1, 0, 0, address, byte);
  61        io_cmd.opcode = SD_IO_RW_DIRECT;
  62        io_cmd.arg = arg;
  63        io_cmd.flags = MMC_RSP_R5 | MMC_CMD_AC;
  64
  65        return mmc_wait_for_cmd(card->host, &io_cmd, 0);
  66}
  67
  68/**
  69 * rsi_cmd52readbyte() - This function issues cmd52 byte read onto the card.
  70 * @card: Pointer to the mmc_card.
  71 * @address: Address to read from.
  72 * @byte: Variable to store read value.
  73 *
  74 * Return: Read status.
  75 */
  76static int rsi_cmd52readbyte(struct mmc_card *card,
  77                             u32 address,
  78                             u8 *byte)
  79{
  80        struct mmc_command io_cmd;
  81        u32 arg;
  82        int err;
  83
  84        memset(&io_cmd, 0, sizeof(io_cmd));
  85        arg = rsi_sdio_set_cmd52_arg(0, 0, 0, address, 0);
  86        io_cmd.opcode = SD_IO_RW_DIRECT;
  87        io_cmd.arg = arg;
  88        io_cmd.flags = MMC_RSP_R5 | MMC_CMD_AC;
  89
  90        err = mmc_wait_for_cmd(card->host, &io_cmd, 0);
  91        if ((!err) && (byte))
  92                *byte =  io_cmd.resp[0] & 0xFF;
  93        return err;
  94}
  95
  96/**
  97 * rsi_issue_sdiocommand() - This function issues sdio commands.
  98 * @func: Pointer to the sdio_func structure.
  99 * @opcode: Opcode value.
 100 * @arg: Arguments to pass.
 101 * @flags: Flags which are set.
 102 * @resp: Pointer to store response.
 103 *
 104 * Return: err: command status as 0 or -1.
 105 */
 106static int rsi_issue_sdiocommand(struct sdio_func *func,
 107                                 u32 opcode,
 108                                 u32 arg,
 109                                 u32 flags,
 110                                 u32 *resp)
 111{
 112        struct mmc_command cmd;
 113        struct mmc_host *host;
 114        int err;
 115
 116        host = func->card->host;
 117
 118        memset(&cmd, 0, sizeof(struct mmc_command));
 119        cmd.opcode = opcode;
 120        cmd.arg = arg;
 121        cmd.flags = flags;
 122        err = mmc_wait_for_cmd(host, &cmd, 3);
 123
 124        if ((!err) && (resp))
 125                *resp = cmd.resp[0];
 126
 127        return err;
 128}
 129
 130/**
 131 * rsi_handle_interrupt() - This function is called upon the occurence
 132 *                          of an interrupt.
 133 * @function: Pointer to the sdio_func structure.
 134 *
 135 * Return: None.
 136 */
 137static void rsi_handle_interrupt(struct sdio_func *function)
 138{
 139        struct rsi_hw *adapter = sdio_get_drvdata(function);
 140
 141        sdio_release_host(function);
 142        rsi_interrupt_handler(adapter);
 143        sdio_claim_host(function);
 144}
 145
 146/**
 147 * rsi_reset_card() - This function resets and re-initializes the card.
 148 * @pfunction: Pointer to the sdio_func structure.
 149 *
 150 * Return: None.
 151 */
 152static void rsi_reset_card(struct sdio_func *pfunction)
 153{
 154        int ret = 0;
 155        int err;
 156        struct mmc_card *card = pfunction->card;
 157        struct mmc_host *host = card->host;
 158        s32 bit = (fls(host->ocr_avail) - 1);
 159        u8 cmd52_resp;
 160        u32 clock, resp, i;
 161        u16 rca;
 162
 163        /* Reset 9110 chip */
 164        ret = rsi_cmd52writebyte(pfunction->card,
 165                                 SDIO_CCCR_ABORT,
 166                                 (1 << 3));
 167
 168        /* Card will not send any response as it is getting reset immediately
 169         * Hence expect a timeout status from host controller
 170         */
 171        if (ret != -ETIMEDOUT)
 172                rsi_dbg(ERR_ZONE, "%s: Reset failed : %d\n", __func__, ret);
 173
 174        /* Wait for few milli seconds to get rid of residue charges if any */
 175        msleep(20);
 176
 177        /* Initialize the SDIO card */
 178        host->ios.vdd = bit;
 179        host->ios.chip_select = MMC_CS_DONTCARE;
 180        host->ios.bus_mode = MMC_BUSMODE_OPENDRAIN;
 181        host->ios.power_mode = MMC_POWER_UP;
 182        host->ios.bus_width = MMC_BUS_WIDTH_1;
 183        host->ios.timing = MMC_TIMING_LEGACY;
 184        host->ops->set_ios(host, &host->ios);
 185
 186        /*
 187         * This delay should be sufficient to allow the power supply
 188         * to reach the minimum voltage.
 189         */
 190        msleep(20);
 191
 192        host->ios.clock = host->f_min;
 193        host->ios.power_mode = MMC_POWER_ON;
 194        host->ops->set_ios(host, &host->ios);
 195
 196        /*
 197         * This delay must be at least 74 clock sizes, or 1 ms, or the
 198         * time required to reach a stable voltage.
 199         */
 200        msleep(20);
 201
 202        /* Issue CMD0. Goto idle state */
 203        host->ios.chip_select = MMC_CS_HIGH;
 204        host->ops->set_ios(host, &host->ios);
 205        msleep(20);
 206        err = rsi_issue_sdiocommand(pfunction,
 207                                    MMC_GO_IDLE_STATE,
 208                                    0,
 209                                    (MMC_RSP_NONE | MMC_CMD_BC),
 210                                    NULL);
 211        host->ios.chip_select = MMC_CS_DONTCARE;
 212        host->ops->set_ios(host, &host->ios);
 213        msleep(20);
 214        host->use_spi_crc = 0;
 215
 216        if (err)
 217                rsi_dbg(ERR_ZONE, "%s: CMD0 failed : %d\n", __func__, err);
 218
 219        if (!host->ocr_avail) {
 220                /* Issue CMD5, arg = 0 */
 221                err = rsi_issue_sdiocommand(pfunction,
 222                                            SD_IO_SEND_OP_COND,
 223                                            0,
 224                                            (MMC_RSP_R4 | MMC_CMD_BCR),
 225                                            &resp);
 226                if (err)
 227                        rsi_dbg(ERR_ZONE, "%s: CMD5 failed : %d\n",
 228                                __func__, err);
 229                host->ocr_avail = resp;
 230        }
 231
 232        /* Issue CMD5, arg = ocr. Wait till card is ready  */
 233        for (i = 0; i < 100; i++) {
 234                err = rsi_issue_sdiocommand(pfunction,
 235                                            SD_IO_SEND_OP_COND,
 236                                            host->ocr_avail,
 237                                            (MMC_RSP_R4 | MMC_CMD_BCR),
 238                                            &resp);
 239                if (err) {
 240                        rsi_dbg(ERR_ZONE, "%s: CMD5 failed : %d\n",
 241                                __func__, err);
 242                        break;
 243                }
 244
 245                if (resp & MMC_CARD_BUSY)
 246                        break;
 247                msleep(20);
 248        }
 249
 250        if ((i == 100) || (err)) {
 251                rsi_dbg(ERR_ZONE, "%s: card in not ready : %d %d\n",
 252                        __func__, i, err);
 253                return;
 254        }
 255
 256        /* Issue CMD3, get RCA */
 257        err = rsi_issue_sdiocommand(pfunction,
 258                                    SD_SEND_RELATIVE_ADDR,
 259                                    0,
 260                                    (MMC_RSP_R6 | MMC_CMD_BCR),
 261                                    &resp);
 262        if (err) {
 263                rsi_dbg(ERR_ZONE, "%s: CMD3 failed : %d\n", __func__, err);
 264                return;
 265        }
 266        rca = resp >> 16;
 267        host->ios.bus_mode = MMC_BUSMODE_PUSHPULL;
 268        host->ops->set_ios(host, &host->ios);
 269
 270        /* Issue CMD7, select card  */
 271        err = rsi_issue_sdiocommand(pfunction,
 272                                    MMC_SELECT_CARD,
 273                                    (rca << 16),
 274                                    (MMC_RSP_R1 | MMC_CMD_AC),
 275                                    NULL);
 276        if (err) {
 277                rsi_dbg(ERR_ZONE, "%s: CMD7 failed : %d\n", __func__, err);
 278                return;
 279        }
 280
 281        /* Enable high speed */
 282        if (card->host->caps & MMC_CAP_SD_HIGHSPEED) {
 283                rsi_dbg(ERR_ZONE, "%s: Set high speed mode\n", __func__);
 284                err = rsi_cmd52readbyte(card, SDIO_CCCR_SPEED, &cmd52_resp);
 285                if (err) {
 286                        rsi_dbg(ERR_ZONE, "%s: CCCR speed reg read failed: %d\n",
 287                                __func__, err);
 288                } else {
 289                        err = rsi_cmd52writebyte(card,
 290                                                 SDIO_CCCR_SPEED,
 291                                                 (cmd52_resp | SDIO_SPEED_EHS));
 292                        if (err) {
 293                                rsi_dbg(ERR_ZONE,
 294                                        "%s: CCR speed regwrite failed %d\n",
 295                                        __func__, err);
 296                                return;
 297                        }
 298                        host->ios.timing = MMC_TIMING_SD_HS;
 299                        host->ops->set_ios(host, &host->ios);
 300                }
 301        }
 302
 303        /* Set clock */
 304        if (mmc_card_hs(card))
 305                clock = 50000000;
 306        else
 307                clock = card->cis.max_dtr;
 308
 309        if (clock > host->f_max)
 310                clock = host->f_max;
 311
 312        host->ios.clock = clock;
 313        host->ops->set_ios(host, &host->ios);
 314
 315        if (card->host->caps & MMC_CAP_4_BIT_DATA) {
 316                /* CMD52: Set bus width & disable card detect resistor */
 317                err = rsi_cmd52writebyte(card,
 318                                         SDIO_CCCR_IF,
 319                                         (SDIO_BUS_CD_DISABLE |
 320                                          SDIO_BUS_WIDTH_4BIT));
 321                if (err) {
 322                        rsi_dbg(ERR_ZONE, "%s: Set bus mode failed : %d\n",
 323                                __func__, err);
 324                        return;
 325                }
 326                host->ios.bus_width = MMC_BUS_WIDTH_4;
 327                host->ops->set_ios(host, &host->ios);
 328        }
 329}
 330
 331/**
 332 * rsi_setclock() - This function sets the clock frequency.
 333 * @adapter: Pointer to the adapter structure.
 334 * @freq: Clock frequency.
 335 *
 336 * Return: None.
 337 */
 338static void rsi_setclock(struct rsi_hw *adapter, u32 freq)
 339{
 340        struct rsi_91x_sdiodev *dev =
 341                (struct rsi_91x_sdiodev *)adapter->rsi_dev;
 342        struct mmc_host *host = dev->pfunction->card->host;
 343        u32 clock;
 344
 345        clock = freq * 1000;
 346        if (clock > host->f_max)
 347                clock = host->f_max;
 348        host->ios.clock = clock;
 349        host->ops->set_ios(host, &host->ios);
 350}
 351
 352/**
 353 * rsi_setblocklength() - This function sets the host block length.
 354 * @adapter: Pointer to the adapter structure.
 355 * @length: Block length to be set.
 356 *
 357 * Return: status: 0 on success, -1 on failure.
 358 */
 359static int rsi_setblocklength(struct rsi_hw *adapter, u32 length)
 360{
 361        struct rsi_91x_sdiodev *dev =
 362                (struct rsi_91x_sdiodev *)adapter->rsi_dev;
 363        int status;
 364        rsi_dbg(INIT_ZONE, "%s: Setting the block length\n", __func__);
 365
 366        status = sdio_set_block_size(dev->pfunction, length);
 367        dev->pfunction->max_blksize = 256;
 368
 369        rsi_dbg(INFO_ZONE,
 370                "%s: Operational blk length is %d\n", __func__, length);
 371        return status;
 372}
 373
 374/**
 375 * rsi_setupcard() - This function queries and sets the card's features.
 376 * @adapter: Pointer to the adapter structure.
 377 *
 378 * Return: status: 0 on success, -1 on failure.
 379 */
 380static int rsi_setupcard(struct rsi_hw *adapter)
 381{
 382        struct rsi_91x_sdiodev *dev =
 383                (struct rsi_91x_sdiodev *)adapter->rsi_dev;
 384        int status = 0;
 385
 386        rsi_setclock(adapter, 50000);
 387
 388        dev->tx_blk_size = 256;
 389        status = rsi_setblocklength(adapter, dev->tx_blk_size);
 390        if (status)
 391                rsi_dbg(ERR_ZONE,
 392                        "%s: Unable to set block length\n", __func__);
 393        return status;
 394}
 395
 396/**
 397 * rsi_sdio_read_register() - This function reads one byte of information
 398 *                            from a register.
 399 * @adapter: Pointer to the adapter structure.
 400 * @addr: Address of the register.
 401 * @data: Pointer to the data that stores the data read.
 402 *
 403 * Return: 0 on success, -1 on failure.
 404 */
 405int rsi_sdio_read_register(struct rsi_hw *adapter,
 406                           u32 addr,
 407                           u8 *data)
 408{
 409        struct rsi_91x_sdiodev *dev =
 410                (struct rsi_91x_sdiodev *)adapter->rsi_dev;
 411        u8 fun_num = 0;
 412        int status;
 413
 414        sdio_claim_host(dev->pfunction);
 415
 416        if (fun_num == 0)
 417                *data = sdio_f0_readb(dev->pfunction, addr, &status);
 418        else
 419                *data = sdio_readb(dev->pfunction, addr, &status);
 420
 421        sdio_release_host(dev->pfunction);
 422
 423        return status;
 424}
 425
 426/**
 427 * rsi_sdio_write_register() - This function writes one byte of information
 428 *                             into a register.
 429 * @adapter: Pointer to the adapter structure.
 430 * @function: Function Number.
 431 * @addr: Address of the register.
 432 * @data: Pointer to the data tha has to be written.
 433 *
 434 * Return: 0 on success, -1 on failure.
 435 */
 436int rsi_sdio_write_register(struct rsi_hw *adapter,
 437                            u8 function,
 438                            u32 addr,
 439                            u8 *data)
 440{
 441        struct rsi_91x_sdiodev *dev =
 442                (struct rsi_91x_sdiodev *)adapter->rsi_dev;
 443        int status = 0;
 444
 445        sdio_claim_host(dev->pfunction);
 446
 447        if (function == 0)
 448                sdio_f0_writeb(dev->pfunction, *data, addr, &status);
 449        else
 450                sdio_writeb(dev->pfunction, *data, addr, &status);
 451
 452        sdio_release_host(dev->pfunction);
 453
 454        return status;
 455}
 456
 457/**
 458 * rsi_sdio_ack_intr() - This function acks the interrupt received.
 459 * @adapter: Pointer to the adapter structure.
 460 * @int_bit: Interrupt bit to write into register.
 461 *
 462 * Return: None.
 463 */
 464void rsi_sdio_ack_intr(struct rsi_hw *adapter, u8 int_bit)
 465{
 466        int status;
 467        status = rsi_sdio_write_register(adapter,
 468                                         1,
 469                                         (SDIO_FUN1_INTR_CLR_REG |
 470                                          RSI_SD_REQUEST_MASTER),
 471                                         &int_bit);
 472        if (status)
 473                rsi_dbg(ERR_ZONE, "%s: unable to send ack\n", __func__);
 474}
 475
 476
 477
 478/**
 479 * rsi_sdio_read_register_multiple() - This function read multiple bytes of
 480 *                                     information from the SD card.
 481 * @adapter: Pointer to the adapter structure.
 482 * @addr: Address of the register.
 483 * @count: Number of multiple bytes to be read.
 484 * @data: Pointer to the read data.
 485 *
 486 * Return: 0 on success, -1 on failure.
 487 */
 488static int rsi_sdio_read_register_multiple(struct rsi_hw *adapter,
 489                                           u32 addr,
 490                                           u32 count,
 491                                           u8 *data)
 492{
 493        struct rsi_91x_sdiodev *dev =
 494                (struct rsi_91x_sdiodev *)adapter->rsi_dev;
 495        u32 status;
 496
 497        sdio_claim_host(dev->pfunction);
 498
 499        status =  sdio_readsb(dev->pfunction, data, addr, count);
 500
 501        sdio_release_host(dev->pfunction);
 502
 503        if (status != 0)
 504                rsi_dbg(ERR_ZONE, "%s: Synch Cmd53 read failed\n", __func__);
 505        return status;
 506}
 507
 508/**
 509 * rsi_sdio_write_register_multiple() - This function writes multiple bytes of
 510 *                                      information to the SD card.
 511 * @adapter: Pointer to the adapter structure.
 512 * @addr: Address of the register.
 513 * @data: Pointer to the data that has to be written.
 514 * @count: Number of multiple bytes to be written.
 515 *
 516 * Return: 0 on success, -1 on failure.
 517 */
 518int rsi_sdio_write_register_multiple(struct rsi_hw *adapter,
 519                                     u32 addr,
 520                                     u8 *data,
 521                                     u32 count)
 522{
 523        struct rsi_91x_sdiodev *dev =
 524                (struct rsi_91x_sdiodev *)adapter->rsi_dev;
 525        int status;
 526
 527        if (dev->write_fail > 1) {
 528                rsi_dbg(ERR_ZONE, "%s: Stopping card writes\n", __func__);
 529                return 0;
 530        } else if (dev->write_fail == 1) {
 531                /**
 532                 * Assuming it is a CRC failure, we want to allow another
 533                 *  card write
 534                 */
 535                rsi_dbg(ERR_ZONE, "%s: Continue card writes\n", __func__);
 536                dev->write_fail++;
 537        }
 538
 539        sdio_claim_host(dev->pfunction);
 540
 541        status = sdio_writesb(dev->pfunction, addr, data, count);
 542
 543        sdio_release_host(dev->pfunction);
 544
 545        if (status) {
 546                rsi_dbg(ERR_ZONE, "%s: Synch Cmd53 write failed %d\n",
 547                        __func__, status);
 548                dev->write_fail = 2;
 549        } else {
 550                memcpy(dev->prev_desc, data, FRAME_DESC_SZ);
 551        }
 552        return status;
 553}
 554
 555/**
 556 * rsi_sdio_host_intf_write_pkt() - This function writes the packet to device.
 557 * @adapter: Pointer to the adapter structure.
 558 * @pkt: Pointer to the data to be written on to the device.
 559 * @len: length of the data to be written on to the device.
 560 *
 561 * Return: 0 on success, -1 on failure.
 562 */
 563static int rsi_sdio_host_intf_write_pkt(struct rsi_hw *adapter,
 564                                        u8 *pkt,
 565                                        u32 len)
 566{
 567        struct rsi_91x_sdiodev *dev =
 568                (struct rsi_91x_sdiodev *)adapter->rsi_dev;
 569        u32 block_size = dev->tx_blk_size;
 570        u32 num_blocks, address, length;
 571        u32 queueno;
 572        int status;
 573
 574        queueno = ((pkt[1] >> 4) & 0xf);
 575
 576        num_blocks = len / block_size;
 577
 578        if (len % block_size)
 579                num_blocks++;
 580
 581        address = (num_blocks * block_size | (queueno << 12));
 582        length  = num_blocks * block_size;
 583
 584        status = rsi_sdio_write_register_multiple(adapter,
 585                                                  address,
 586                                                  (u8 *)pkt,
 587                                                  length);
 588        if (status)
 589                rsi_dbg(ERR_ZONE, "%s: Unable to write onto the card: %d\n",
 590                        __func__, status);
 591        rsi_dbg(DATA_TX_ZONE, "%s: Successfully written onto card\n", __func__);
 592        return status;
 593}
 594
 595/**
 596 * rsi_sdio_host_intf_read_pkt() - This function reads the packet
 597                                   from the device.
 598 * @adapter: Pointer to the adapter data structure.
 599 * @pkt: Pointer to the packet data to be read from the the device.
 600 * @length: Length of the data to be read from the device.
 601 *
 602 * Return: 0 on success, -1 on failure.
 603 */
 604int rsi_sdio_host_intf_read_pkt(struct rsi_hw *adapter,
 605                                u8 *pkt,
 606                                u32 length)
 607{
 608        int status = -EINVAL;
 609
 610        if (!length) {
 611                rsi_dbg(ERR_ZONE, "%s: Pkt size is zero\n", __func__);
 612                return status;
 613        }
 614
 615        status = rsi_sdio_read_register_multiple(adapter,
 616                                                 length,
 617                                                 length, /*num of bytes*/
 618                                                 (u8 *)pkt);
 619
 620        if (status)
 621                rsi_dbg(ERR_ZONE, "%s: Failed to read frame: %d\n", __func__,
 622                        status);
 623        return status;
 624}
 625
 626/**
 627 * rsi_init_sdio_interface() - This function does init specific to SDIO.
 628 *
 629 * @adapter: Pointer to the adapter data structure.
 630 * @pkt: Pointer to the packet data to be read from the the device.
 631 *
 632 * Return: 0 on success, -1 on failure.
 633 */
 634
 635static int rsi_init_sdio_interface(struct rsi_hw *adapter,
 636                                   struct sdio_func *pfunction)
 637{
 638        struct rsi_91x_sdiodev *rsi_91x_dev;
 639        int status = -ENOMEM;
 640
 641        rsi_91x_dev = kzalloc(sizeof(*rsi_91x_dev), GFP_KERNEL);
 642        if (!rsi_91x_dev)
 643                return status;
 644
 645        adapter->rsi_dev = rsi_91x_dev;
 646
 647        sdio_claim_host(pfunction);
 648
 649        pfunction->enable_timeout = 100;
 650        status = sdio_enable_func(pfunction);
 651        if (status) {
 652                rsi_dbg(ERR_ZONE, "%s: Failed to enable interface\n", __func__);
 653                sdio_release_host(pfunction);
 654                return status;
 655        }
 656
 657        rsi_dbg(INIT_ZONE, "%s: Enabled the interface\n", __func__);
 658
 659        rsi_91x_dev->pfunction = pfunction;
 660        adapter->device = &pfunction->dev;
 661
 662        sdio_set_drvdata(pfunction, adapter);
 663
 664        status = rsi_setupcard(adapter);
 665        if (status) {
 666                rsi_dbg(ERR_ZONE, "%s: Failed to setup card\n", __func__);
 667                goto fail;
 668        }
 669
 670        rsi_dbg(INIT_ZONE, "%s: Setup card succesfully\n", __func__);
 671
 672        status = rsi_init_sdio_slave_regs(adapter);
 673        if (status) {
 674                rsi_dbg(ERR_ZONE, "%s: Failed to init slave regs\n", __func__);
 675                goto fail;
 676        }
 677        sdio_release_host(pfunction);
 678
 679        adapter->host_intf_write_pkt = rsi_sdio_host_intf_write_pkt;
 680        adapter->host_intf_read_pkt = rsi_sdio_host_intf_read_pkt;
 681        adapter->determine_event_timeout = rsi_sdio_determine_event_timeout;
 682        adapter->check_hw_queue_status = rsi_sdio_read_buffer_status_register;
 683
 684#ifdef CONFIG_RSI_DEBUGFS
 685        adapter->num_debugfs_entries = MAX_DEBUGFS_ENTRIES;
 686#endif
 687        return status;
 688fail:
 689        sdio_disable_func(pfunction);
 690        sdio_release_host(pfunction);
 691        return status;
 692}
 693
 694/**
 695 * rsi_probe() - This function is called by kernel when the driver provided
 696 *               Vendor and device IDs are matched. All the initialization
 697 *               work is done here.
 698 * @pfunction: Pointer to the sdio_func structure.
 699 * @id: Pointer to sdio_device_id structure.
 700 *
 701 * Return: 0 on success, 1 on failure.
 702 */
 703static int rsi_probe(struct sdio_func *pfunction,
 704                     const struct sdio_device_id *id)
 705{
 706        struct rsi_hw *adapter;
 707
 708        rsi_dbg(INIT_ZONE, "%s: Init function called\n", __func__);
 709
 710        adapter = rsi_91x_init();
 711        if (!adapter) {
 712                rsi_dbg(ERR_ZONE, "%s: Failed to init os intf ops\n",
 713                        __func__);
 714                return 1;
 715        }
 716
 717        if (rsi_init_sdio_interface(adapter, pfunction)) {
 718                rsi_dbg(ERR_ZONE, "%s: Failed to init sdio interface\n",
 719                        __func__);
 720                goto fail;
 721        }
 722
 723        if (rsi_sdio_device_init(adapter->priv)) {
 724                rsi_dbg(ERR_ZONE, "%s: Failed in device init\n", __func__);
 725                sdio_claim_host(pfunction);
 726                sdio_disable_func(pfunction);
 727                sdio_release_host(pfunction);
 728                goto fail;
 729        }
 730
 731        sdio_claim_host(pfunction);
 732        if (sdio_claim_irq(pfunction, rsi_handle_interrupt)) {
 733                rsi_dbg(ERR_ZONE, "%s: Failed to request IRQ\n", __func__);
 734                sdio_release_host(pfunction);
 735                goto fail;
 736        }
 737
 738        sdio_release_host(pfunction);
 739        rsi_dbg(INIT_ZONE, "%s: Registered Interrupt handler\n", __func__);
 740
 741        return 0;
 742fail:
 743        rsi_91x_deinit(adapter);
 744        rsi_dbg(ERR_ZONE, "%s: Failed in probe...Exiting\n", __func__);
 745        return 1;
 746}
 747
 748/**
 749 * rsi_disconnect() - This function performs the reverse of the probe function.
 750 * @pfunction: Pointer to the sdio_func structure.
 751 *
 752 * Return: void.
 753 */
 754static void rsi_disconnect(struct sdio_func *pfunction)
 755{
 756        struct rsi_hw *adapter = sdio_get_drvdata(pfunction);
 757        struct rsi_91x_sdiodev *dev;
 758
 759        if (!adapter)
 760                return;
 761
 762        dev = (struct rsi_91x_sdiodev *)adapter->rsi_dev;
 763
 764        dev->write_fail = 2;
 765        rsi_mac80211_detach(adapter);
 766
 767        sdio_claim_host(pfunction);
 768        sdio_release_irq(pfunction);
 769        sdio_disable_func(pfunction);
 770        rsi_91x_deinit(adapter);
 771        /* Resetting to take care of the case, where-in driver is re-loaded */
 772        rsi_reset_card(pfunction);
 773        sdio_release_host(pfunction);
 774}
 775
 776#ifdef CONFIG_PM
 777static int rsi_suspend(struct device *dev)
 778{
 779        /* Not yet implemented */
 780        return -ENOSYS;
 781}
 782
 783static int rsi_resume(struct device *dev)
 784{
 785        /* Not yet implemented */
 786        return -ENOSYS;
 787}
 788
 789static const struct dev_pm_ops rsi_pm_ops = {
 790        .suspend = rsi_suspend,
 791        .resume = rsi_resume,
 792};
 793#endif
 794
 795static const struct sdio_device_id rsi_dev_table[] =  {
 796        { SDIO_DEVICE(0x303, 0x100) },
 797        { SDIO_DEVICE(0x041B, 0x0301) },
 798        { SDIO_DEVICE(0x041B, 0x0201) },
 799        { SDIO_DEVICE(0x041B, 0x9330) },
 800        { /* Blank */},
 801};
 802
 803static struct sdio_driver rsi_driver = {
 804        .name       = "RSI-SDIO WLAN",
 805        .probe      = rsi_probe,
 806        .remove     = rsi_disconnect,
 807        .id_table   = rsi_dev_table,
 808#ifdef CONFIG_PM
 809        .drv = {
 810                .pm = &rsi_pm_ops,
 811        }
 812#endif
 813};
 814
 815/**
 816 * rsi_module_init() - This function registers the sdio module.
 817 * @void: Void.
 818 *
 819 * Return: 0 on success.
 820 */
 821static int rsi_module_init(void)
 822{
 823        int ret;
 824
 825        ret = sdio_register_driver(&rsi_driver);
 826        rsi_dbg(INIT_ZONE, "%s: Registering driver\n", __func__);
 827        return ret;
 828}
 829
 830/**
 831 * rsi_module_exit() - This function unregisters the sdio module.
 832 * @void: Void.
 833 *
 834 * Return: None.
 835 */
 836static void rsi_module_exit(void)
 837{
 838        sdio_unregister_driver(&rsi_driver);
 839        rsi_dbg(INFO_ZONE, "%s: Unregistering driver\n", __func__);
 840}
 841
 842module_init(rsi_module_init);
 843module_exit(rsi_module_exit);
 844
 845MODULE_AUTHOR("Redpine Signals Inc");
 846MODULE_DESCRIPTION("Common SDIO layer for RSI drivers");
 847MODULE_SUPPORTED_DEVICE("RSI-91x");
 848MODULE_DEVICE_TABLE(sdio, rsi_dev_table);
 849MODULE_FIRMWARE(FIRMWARE_RSI9113);
 850MODULE_VERSION("0.1");
 851MODULE_LICENSE("Dual BSD/GPL");
 852