drivers/staging/gdm72xx/sdio_boot.c

   1 /*
   2  * Copyright (c) 2012 GCT Semiconductor, Inc. All rights reserved.
   3  *
   4  * This software is licensed under the terms of the GNU General Public
   5  * License version 2, as published by the Free Software Foundation, and
   6  * may be copied, distributed, and modified under those terms.
   7  *
   8  * This program is distributed in the hope that it will be useful,
   9  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  11  * GNU General Public License for more details.
  12  */
  13
  14 #include <linux/module.h>
  15 #include <linux/kernel.h>
  16 #include <linux/init.h>
  17 #include <linux/mm.h>
  18 #include <linux/uaccess.h>
  19 #include <linux/fs.h>
  20 #include <linux/sched.h>
  21 #include <linux/slab.h>
  22
  23 #include <linux/mmc/core.h>
  24 #include <linux/mmc/card.h>
  25 #include <linux/mmc/sdio_func.h>
  26
  27 #include <linux/firmware.h>
  28
  29 #include "gdm_sdio.h"
  30 #include "sdio_boot.h"
  31
  32 #define TYPE_A_HEADER_SIZE      4
  33 #define TYPE_A_LOOKAHEAD_SIZE   16
  34 #define YMEM0_SIZE              0x8000  /* 32kbytes */
  35 #define DOWNLOAD_SIZE           (YMEM0_SIZE - TYPE_A_HEADER_SIZE)
  36
  37 #define FW_DIR                  "gdm72xx/"
  38 #define FW_KRN                  "gdmskrn.bin"
  39 #define FW_RFS                  "gdmsrfs.bin"
  40
  41 static u8 *tx_buf;
  42
  43 static int ack_ready(struct sdio_func *func)
  44 {
  45         unsigned long start = jiffies;
  46         u8 val;
  47         int ret;
  48
  49         while ((jiffies - start) < HZ) {
  50                 val = sdio_readb(func, 0x13, &ret);
  51                 if (val & 0x01)
  52                         return 1;
  53                 schedule();
  54         }
  55
  56         return 0;
  57 }
  58
  59 static int download_image(struct sdio_func *func, const char *img_name)
  60 {
  61         int ret = 0, len, pno;
  62         u8 *buf = tx_buf;
  63         loff_t pos = 0;
  64         int img_len;
  65         const struct firmware *firm;
  66
  67         ret = request_firmware(&firm, img_name, &func->dev);
  68         if (ret < 0) {
  69                 dev_err(&func->dev,
  70                         "requesting firmware %s failed with error %d\n",
  71                         img_name, ret);
  72                 return ret;
  73         }
  74
  75         buf = kmalloc(DOWNLOAD_SIZE + TYPE_A_HEADER_SIZE, GFP_KERNEL);
  76         if (buf == NULL) {
  77                 dev_err(&func->dev, "Error: kmalloc\n");
  78                 return -ENOMEM;
  79         }
  80
  81         img_len = firm->size;
  82
  83         if (img_len <= 0) {
  84                 ret = -1;
  85                 goto out;
  86         }
  87
  88         pno = 0;
  89         while (img_len > 0) {
  90                 if (img_len > DOWNLOAD_SIZE) {
  91                         len = DOWNLOAD_SIZE;
  92                         buf[3] = 0;
  93                 } else {
  94                         len = img_len; /* the last packet */
  95                         buf[3] = 2;
  96                 }
  97
  98                 buf[0] = len & 0xff;
  99                 buf[1] = (len >> 8) & 0xff;
 100                 buf[2] = (len >> 16) & 0xff;
 101
 102                 memcpy(buf+TYPE_A_HEADER_SIZE, firm->data + pos, len);
 103                 ret = sdio_memcpy_toio(func, 0, buf, len + TYPE_A_HEADER_SIZE);
 104                 if (ret < 0) {
 105                         dev_err(&func->dev,
 106                                 "send image error: packet number = %d ret = %d\n",
 107                                 pno, ret);
 108                         goto out;
 109                 }
 110
 111                 if (buf[3] == 2)        /* The last packet */
 112                         break;
 113                 if (!ack_ready(func)) {
 114                         ret = -EIO;
 115                         dev_err(&func->dev, "Ack is not ready.\n");
 116                         goto out;
 117                 }
 118                 ret = sdio_memcpy_fromio(func, buf, 0, TYPE_A_LOOKAHEAD_SIZE);
 119                 if (ret < 0) {
 120                         dev_err(&func->dev,
 121                                 "receive ack error: packet number = %d ret = %d\n",
 122                                 pno, ret);
 123                         goto out;
 124                 }
 125                 sdio_writeb(func, 0x01, 0x13, &ret);
 126                 sdio_writeb(func, 0x00, 0x10, &ret);    /* PCRRT */
 127
 128                 img_len -= DOWNLOAD_SIZE;
 129                 pos += DOWNLOAD_SIZE;
 130                 pno++;
 131         }
 132
 133 out:
 134         kfree(buf);
 135         return ret;
 136 }
 137
 138 int sdio_boot(struct sdio_func *func)
 139 {
 140         int ret;
 141         const char *krn_name = FW_DIR FW_KRN;
 142         const char *rfs_name = FW_DIR FW_RFS;
 143
 144         tx_buf = kmalloc(YMEM0_SIZE, GFP_KERNEL);
 145         if (tx_buf == NULL) {
 146                 dev_err(&func->dev, "Error: kmalloc: %s %d\n",
 147                         __func__, __LINE__);
 148                 return -ENOMEM;
 149         }
 150
 151         ret = download_image(func, krn_name);
 152         if (ret)
 153                 goto restore_fs;
 154         dev_info(&func->dev, "GCT: Kernel download success.\n");
 155
 156         ret = download_image(func, rfs_name);
 157         if (ret)
 158                 goto restore_fs;
 159         dev_info(&func->dev, "GCT: Filesystem download success.\n");
 160
 161 restore_fs:
 162         kfree(tx_buf);
 163         return ret;
 164 }