2012-05-15 04:20:36 +00:00
|
|
|
/*
|
|
|
|
* Copyright (c) 2012 GCT Semiconductor, Inc. All rights reserved.
|
|
|
|
*
|
|
|
|
* 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/module.h>
|
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/init.h>
|
|
|
|
#include <linux/mm.h>
|
|
|
|
#include <linux/uaccess.h>
|
|
|
|
#include <linux/fs.h>
|
|
|
|
#include <linux/sched.h>
|
|
|
|
#include <linux/slab.h>
|
|
|
|
|
|
|
|
#include <linux/mmc/core.h>
|
|
|
|
#include <linux/mmc/card.h>
|
|
|
|
#include <linux/mmc/sdio_func.h>
|
|
|
|
|
|
|
|
#include "gdm_sdio.h"
|
|
|
|
|
|
|
|
#define TYPE_A_HEADER_SIZE 4
|
|
|
|
#define TYPE_A_LOOKAHEAD_SIZE 16
|
|
|
|
#define YMEM0_SIZE 0x8000 /* 32kbytes */
|
|
|
|
#define DOWNLOAD_SIZE (YMEM0_SIZE - TYPE_A_HEADER_SIZE)
|
|
|
|
|
|
|
|
#define KRN_PATH "/lib/firmware/gdm72xx/gdmskrn.bin"
|
|
|
|
#define RFS_PATH "/lib/firmware/gdm72xx/gdmsrfs.bin"
|
|
|
|
|
|
|
|
static u8 *tx_buf;
|
|
|
|
|
|
|
|
static int ack_ready(struct sdio_func *func)
|
|
|
|
{
|
|
|
|
unsigned long start = jiffies;
|
|
|
|
u8 val;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
while ((jiffies - start) < HZ) {
|
|
|
|
val = sdio_readb(func, 0x13, &ret);
|
|
|
|
if (val & 0x01)
|
|
|
|
return 1;
|
|
|
|
schedule();
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int download_image(struct sdio_func *func, char *img_name)
|
|
|
|
{
|
|
|
|
int ret = 0, len, size, pno;
|
|
|
|
struct file *filp = NULL;
|
|
|
|
struct inode *inode = NULL;
|
|
|
|
u8 *buf = tx_buf;
|
|
|
|
loff_t pos = 0;
|
|
|
|
|
|
|
|
filp = filp_open(img_name, O_RDONLY | O_LARGEFILE, 0);
|
|
|
|
if (IS_ERR(filp)) {
|
|
|
|
printk(KERN_ERR "Can't find %s.\n", img_name);
|
|
|
|
return -ENOENT;
|
|
|
|
}
|
|
|
|
|
2012-07-22 17:09:14 +00:00
|
|
|
inode = filp->f_dentry->d_inode;
|
|
|
|
if (!S_ISREG(inode->i_mode)) {
|
2012-05-15 04:20:36 +00:00
|
|
|
printk(KERN_ERR "Invalid file type: %s\n", img_name);
|
|
|
|
ret = -EINVAL;
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
|
|
|
size = i_size_read(inode->i_mapping->host);
|
|
|
|
if (size <= 0) {
|
|
|
|
printk(KERN_ERR "Unable to find file size: %s\n", img_name);
|
|
|
|
ret = size;
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
|
|
|
pno = 0;
|
|
|
|
while ((len = filp->f_op->read(filp, buf + TYPE_A_HEADER_SIZE,
|
|
|
|
DOWNLOAD_SIZE, &pos))) {
|
|
|
|
if (len < 0) {
|
|
|
|
ret = -1;
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
|
|
|
buf[0] = len & 0xff;
|
|
|
|
buf[1] = (len >> 8) & 0xff;
|
|
|
|
buf[2] = (len >> 16) & 0xff;
|
|
|
|
|
|
|
|
if (pos >= size) /* The last packet */
|
|
|
|
buf[3] = 2;
|
|
|
|
else
|
|
|
|
buf[3] = 0;
|
|
|
|
|
|
|
|
ret = sdio_memcpy_toio(func, 0, buf, len + TYPE_A_HEADER_SIZE);
|
|
|
|
if (ret < 0) {
|
|
|
|
printk(KERN_ERR "gdmwm: send image error: "
|
|
|
|
"packet number = %d ret = %d\n", pno, ret);
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
if (buf[3] == 2) /* The last packet */
|
|
|
|
break;
|
|
|
|
if (!ack_ready(func)) {
|
|
|
|
ret = -EIO;
|
|
|
|
printk(KERN_ERR "gdmwm: Ack is not ready.\n");
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
ret = sdio_memcpy_fromio(func, buf, 0, TYPE_A_LOOKAHEAD_SIZE);
|
|
|
|
if (ret < 0) {
|
|
|
|
printk(KERN_ERR "gdmwm: receive ack error: "
|
|
|
|
"packet number = %d ret = %d\n", pno, ret);
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
sdio_writeb(func, 0x01, 0x13, &ret);
|
|
|
|
sdio_writeb(func, 0x00, 0x10, &ret); /* PCRRT */
|
|
|
|
|
|
|
|
pno++;
|
|
|
|
}
|
|
|
|
out:
|
2012-07-22 17:09:14 +00:00
|
|
|
filp_close(filp, NULL);
|
2012-05-15 04:20:36 +00:00
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
int sdio_boot(struct sdio_func *func)
|
|
|
|
{
|
|
|
|
static mm_segment_t fs;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
tx_buf = kmalloc(YMEM0_SIZE, GFP_KERNEL);
|
|
|
|
if (tx_buf == NULL) {
|
|
|
|
printk(KERN_ERR "Error: kmalloc: %s %d\n", __func__, __LINE__);
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
fs = get_fs();
|
|
|
|
set_fs(get_ds());
|
|
|
|
|
|
|
|
ret = download_image(func, KRN_PATH);
|
|
|
|
if (ret)
|
|
|
|
goto restore_fs;
|
|
|
|
printk(KERN_INFO "GCT: Kernel download success.\n");
|
|
|
|
|
|
|
|
ret = download_image(func, RFS_PATH);
|
|
|
|
if (ret)
|
|
|
|
goto restore_fs;
|
|
|
|
printk(KERN_INFO "GCT: Filesystem download success.\n");
|
|
|
|
|
|
|
|
restore_fs:
|
|
|
|
set_fs(fs);
|
|
|
|
kfree(tx_buf);
|
|
|
|
return ret;
|
|
|
|
}
|