/*
* This routine tries to find a RAM disk image to load, and returns the
* number of blocks to read for a non-compressed image, 0 if the image
* is a compressed image, and -1 if an image with the right magic
* numbers could not be found.
*
* We currently check for the following magic numbers:
* minix
* ext2
* romfs
* cramfs
* squashfs
* gzip
*/
static int __init
identify_ramdisk_image(int fd, int start_block, decompress_fn *decompressor)
{
const int size = 512;
struct minix_super_block *minixsb;
struct ext2_super_block *ext2sb;
struct romfs_super_block *romfsb;
struct cramfs_super *cramfsb;
struct squashfs_super_block *squashfsb;
int nblocks = -1;
unsigned char *buf;
const char *compress_name;
buf = kmalloc(size, GFP_KERNEL);
if (!buf)
return -1;
minixsb = (struct minix_super_block *) buf;
ext2sb = (struct ext2_super_block *) buf;
romfsb = (struct romfs_super_block *) buf;
cramfsb = (struct cramfs_super *) buf;
squashfsb = (struct squashfs_super_block *) buf;
memset(buf, 0xe5, size);
/*
* Read block 0 to test for compressed kernel
*/
sys_lseek(fd, start_block * BLOCK_SIZE, 0);
sys_read(fd, buf, size);
*decompressor = decompress_method(buf, size, &compress_name);
if (compress_name) {
printk(KERN_NOTICE "RAMDISK: %s image found at block %d\n",
compress_name, start_block);
if (!*decompressor)
printk(KERN_EMERG
"RAMDISK: %s decompressor not configured!\n",
compress_name);
nblocks = 0;
goto done;
}
/* romfs is at block zero too */
if (romfsb->word0 == ROMSB_WORD0 &&
romfsb->word1 == ROMSB_WORD1) {
printk(KERN_NOTICE
"RAMDISK: romfs filesystem found at block %d\n",
start_block);
nblocks = (ntohl(romfsb->size)+BLOCK_SIZE-1)>>BLOCK_SIZE_BITS;
goto done;
}
int his_modem_load_vxworks(char *part_name)
{
int ret = 0;
int offset = 0;
int skip_len = 0;
u32 image_total_length = 0;
void *image_load_addr = 0;
decompress_fn inflate_fn = NULL;
struct image_head head;
hi_trace(HI_INFO, ">>loading:%s.....\r\n", part_name);
ret = bsp_nand_read(part_name, (FSZ)0, &head, sizeof(struct image_head) , &skip_len);
if (NAND_OK != ret)
{
hi_trace(HI_ERR, "fail to read vxworks image head, error code 0x%x\r\n", ret);
return NAND_ERROR;
}
/*coverity[uninit_use_in_call] */
if (memcmp(head.image_name, CCORE_IMAGE_NAME, sizeof(CCORE_IMAGE_NAME)))
{
hi_trace(HI_ERR, "vxworks image error!!.\r\n");
return NAND_ERROR;
}
/*coverity[uninit_use] */
if (head.image_length + 2*IDIO_LEN + OEM_CA_LEN > PRODUCT_CFG_FLASH_CCORE_LEN)
{
hi_trace(HI_ERR, "loadsize is incorrect, 0x%x!\r\n",
head.image_length + 2*IDIO_LEN + OEM_CA_LEN);
return NAND_ERROR;
}
/*coverity[uninit_use_in_call] */
g_ccore_entry = (u32)ioremap_cached(head.load_addr, DDR_MCORE_SIZE - (MCORE_TEXT_START_ADDR - DDR_MCORE_ADDR));
if(!g_ccore_entry)
{
hi_trace(HI_ERR, "ioremap failed.\r\n");
return NAND_ERROR;
}
offset += sizeof(struct image_head) + skip_len;
image_total_length = (u32)head.image_length + 2*IDIO_LEN + OEM_CA_LEN;
/*coverity[uninit_use] */
if (head.is_compressed)
{
image_load_addr = (void*)g_ccore_entry - (MCORE_TEXT_START_ADDR - DDR_MCORE_ADDR)
+ DDR_MCORE_SIZE - image_total_length;
}
else
{
image_load_addr = (void*)g_ccore_entry;
}
ret = bsp_nand_read(part_name, offset, image_load_addr, image_total_length, &skip_len);
if(NAND_OK != ret)
{
hi_trace(HI_ERR, "fail to read vxworks image, error code 0x%x\r\n", ret);
goto exit;
}
ret = bsp_sec_check((u32)image_load_addr, head.image_length);
if (ret)
{
hi_trace(HI_ERR, "fail to check vxworks image, error code 0x%x\r\n", ret);
goto exit;
}
if (head.is_compressed)
{
hi_trace(HI_INFO, ">>start to decompress vxworks image ...\r\n");
inflate_fn = decompress_method((const unsigned char *)image_load_addr, 2, NULL);
if (inflate_fn)
{
ret = inflate_fn((unsigned char*)image_load_addr,
head.image_length, NULL, NULL, (unsigned char*)g_ccore_entry,
NULL, (void(*)(char*))printk);
if (ret)
{
hi_trace(HI_ERR, "fail to decompress vxworks image, error code 0x%x\r\n", ret);
goto exit;
}
}
else
{
hi_trace(HI_ERR, "fail to get decompress method\r\n");
goto exit;
}
}
/* flush cache */
__dma_single_cpu_to_dev_noverify((const void *)g_ccore_entry,
DDR_MCORE_SIZE - (MCORE_TEXT_START_ADDR - DDR_MCORE_ADDR),
CACHE_DMA_TO_DEVICE);
hi_trace(HI_INFO, ">>load vxworks ok, entey %#x, length %#x\r\n", head.load_addr, head.image_length);
exit:
iounmap((void volatile *)g_ccore_entry);
return ret;
}
