adm8668: revert changeset 34554
The conversion was not 100% correct and leads to u-boot failing to verify the CRC, revert that change for now. Signed-off-by: Florian Fainelli <florian@openwrt.org> SVN-Revision: 42170
This commit is contained in:
parent
21fde478d9
commit
4147bca9ac
4 changed files with 205 additions and 164 deletions
|
@ -67,8 +67,7 @@ CONFIG_MIPS=y
|
||||||
CONFIG_MIPS_L1_CACHE_SHIFT=5
|
CONFIG_MIPS_L1_CACHE_SHIFT=5
|
||||||
# CONFIG_MIPS_MACHINE is not set
|
# CONFIG_MIPS_MACHINE is not set
|
||||||
CONFIG_MIPS_MT_DISABLED=y
|
CONFIG_MIPS_MT_DISABLED=y
|
||||||
CONFIG_MTD_ADM8668_PARTS=y
|
CONFIG_MTD_ADM8668_NOR=y
|
||||||
CONFIG_MTD_PHYSMAP=y
|
|
||||||
CONFIG_NEED_DMA_MAP_STATE=y
|
CONFIG_NEED_DMA_MAP_STATE=y
|
||||||
CONFIG_NEED_PER_CPU_KM=y
|
CONFIG_NEED_PER_CPU_KM=y
|
||||||
CONFIG_NET_TULIP=y
|
CONFIG_NET_TULIP=y
|
||||||
|
|
|
@ -1,6 +1,4 @@
|
||||||
/*
|
/*
|
||||||
* Infineon/ADMTek 8668 (WildPass) platform devices support
|
|
||||||
*
|
|
||||||
* Copyright (C) 2010 Scott Nicholas <neutronscott@scottn.us>
|
* Copyright (C) 2010 Scott Nicholas <neutronscott@scottn.us>
|
||||||
* Copyright (C) 2012 Florian Fainelli <florian@openwrt.org>
|
* Copyright (C) 2012 Florian Fainelli <florian@openwrt.org>
|
||||||
*
|
*
|
||||||
|
@ -15,7 +13,6 @@
|
||||||
#include <linux/platform_data/tulip.h>
|
#include <linux/platform_data/tulip.h>
|
||||||
#include <linux/usb/ehci_pdriver.h>
|
#include <linux/usb/ehci_pdriver.h>
|
||||||
#include <linux/mtd/physmap.h>
|
#include <linux/mtd/physmap.h>
|
||||||
#include <linux/mtd/partitions.h>
|
|
||||||
#include <linux/pci.h>
|
#include <linux/pci.h>
|
||||||
#include <linux/slab.h>
|
#include <linux/slab.h>
|
||||||
#include <linux/ioport.h>
|
#include <linux/ioport.h>
|
||||||
|
@ -108,29 +105,6 @@ static struct platform_device adm8668_eth1_device = {
|
||||||
.dev.platform_data = ð1_pdata,
|
.dev.platform_data = ð1_pdata,
|
||||||
};
|
};
|
||||||
|
|
||||||
static const char *nor_probe_types[] = { "adm8668part", NULL };
|
|
||||||
|
|
||||||
static struct physmap_flash_data nor_flash_data = {
|
|
||||||
.width = 2,
|
|
||||||
.part_probe_types = nor_probe_types,
|
|
||||||
};
|
|
||||||
|
|
||||||
static struct resource nor_resources[] = {
|
|
||||||
{
|
|
||||||
.start = ADM8668_SMEM1_BASE,
|
|
||||||
.end = ADM8668_SMEM1_BASE + 0x800000 - 1,
|
|
||||||
.flags = IORESOURCE_MEM,
|
|
||||||
},
|
|
||||||
};
|
|
||||||
|
|
||||||
static struct platform_device adm8668_nor_device = {
|
|
||||||
.name = "physmap-flash",
|
|
||||||
.id = -1,
|
|
||||||
.resource = nor_resources,
|
|
||||||
.num_resources = ARRAY_SIZE(nor_resources),
|
|
||||||
.dev.platform_data = &nor_flash_data,
|
|
||||||
};
|
|
||||||
|
|
||||||
static struct resource usb_resources[] = {
|
static struct resource usb_resources[] = {
|
||||||
{
|
{
|
||||||
.start = ADM8668_USB_BASE,
|
.start = ADM8668_USB_BASE,
|
||||||
|
@ -161,7 +135,6 @@ static struct platform_device adm8668_usb_device = {
|
||||||
static struct platform_device *adm8668_devs[] = {
|
static struct platform_device *adm8668_devs[] = {
|
||||||
&adm8668_eth0_device,
|
&adm8668_eth0_device,
|
||||||
&adm8668_eth1_device,
|
&adm8668_eth1_device,
|
||||||
&adm8668_nor_device,
|
|
||||||
&adm8668_usb_device,
|
&adm8668_usb_device,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
|
@ -1,30 +1,30 @@
|
||||||
/*
|
/*
|
||||||
* Infineon/ADMTek ADM8668 (WildPass) partition parser support
|
* Copyright (C) 2010 Scott Nicholas <neutronscott@scottn.us>
|
||||||
|
* Copyright (C) 2006 Felix Fietkau <nbd@openwrt.org>
|
||||||
|
* Copyright (C) 2005 Waldemar Brodkorb <wbx@openwrt.org>
|
||||||
|
* Copyright (C) 2004 Florian Schirmer (jolt@tuxbox.org)
|
||||||
*
|
*
|
||||||
* Copyright (C) 2010 Scott Nicholas <neutronscott@scottn.us>
|
* original functions for finding root filesystem from Mike Baker
|
||||||
* Copyright (C) 2012 Florian Fainelli <florian@openwrt.org>
|
|
||||||
*
|
*
|
||||||
* original functions for finding root filesystem from Mike Baker
|
* This program is free software; you can redistribute it and/or modify it
|
||||||
|
* under the terms of the GNU General Public License as published by the
|
||||||
|
* Free Software Foundation; either version 2 of the License, or (at your
|
||||||
|
* option) any later version.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify it
|
* THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
|
||||||
* under the terms of the GNU General Public License as published by the
|
* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
||||||
* Free Software Foundation; either version 2 of the License, or (at your
|
* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
|
||||||
* option) any later version.
|
* NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||||||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
|
||||||
|
* USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
|
||||||
|
* ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||||||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
*
|
*
|
||||||
* THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
|
* You should have received a copy of the GNU General Public License along
|
||||||
* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
* with this program; if not, write to the Free Software Foundation, Inc.,
|
||||||
* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
|
* 675 Mass Ave, Cambridge, MA 02139, USA.
|
||||||
* NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
||||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
|
||||||
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
|
|
||||||
* USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
|
|
||||||
* ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
||||||
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
|
||||||
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
||||||
*
|
|
||||||
* You should have received a copy of the GNU General Public License along
|
|
||||||
* with this program; if not, write to the Free Software Foundation, Inc.,
|
|
||||||
* 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
||||||
*
|
*
|
||||||
*
|
*
|
||||||
* Copyright 2004, Broadcom Corporation
|
* Copyright 2004, Broadcom Corporation
|
||||||
|
@ -34,6 +34,9 @@
|
||||||
* KIND, EXPRESS OR IMPLIED, BY STATUTE, COMMUNICATION OR OTHERWISE. BROADCOM
|
* KIND, EXPRESS OR IMPLIED, BY STATUTE, COMMUNICATION OR OTHERWISE. BROADCOM
|
||||||
* SPECIFICALLY DISCLAIMS ANY IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS
|
* SPECIFICALLY DISCLAIMS ANY IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS
|
||||||
* FOR A SPECIFIC PURPOSE OR NONINFRINGEMENT CONCERNING THIS SOFTWARE.
|
* FOR A SPECIFIC PURPOSE OR NONINFRINGEMENT CONCERNING THIS SOFTWARE.
|
||||||
|
*
|
||||||
|
* Flash mapping for adm8668 boards
|
||||||
|
*
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <linux/module.h>
|
#include <linux/module.h>
|
||||||
|
@ -42,13 +45,16 @@
|
||||||
#include <linux/sched.h>
|
#include <linux/sched.h>
|
||||||
#include <linux/wait.h>
|
#include <linux/wait.h>
|
||||||
#include <linux/mtd/mtd.h>
|
#include <linux/mtd/mtd.h>
|
||||||
#include <linux/mtd/partitions.h>
|
#include <linux/mtd/map.h>
|
||||||
#include <linux/vmalloc.h>
|
|
||||||
#include <linux/slab.h>
|
#include <linux/slab.h>
|
||||||
|
#include <linux/mtd/partitions.h>
|
||||||
#include <linux/crc32.h>
|
#include <linux/crc32.h>
|
||||||
#include <linux/magic.h>
|
#include <linux/magic.h>
|
||||||
|
#include <asm/io.h>
|
||||||
|
|
||||||
#define PFX "adm8668-part: "
|
#define WINDOW_ADDR 0x10000000
|
||||||
|
#define WINDOW_SIZE 0x800000
|
||||||
|
#define BANKWIDTH 2
|
||||||
|
|
||||||
/* first a little bit about the headers i need.. */
|
/* first a little bit about the headers i need.. */
|
||||||
|
|
||||||
|
@ -75,122 +81,176 @@ struct uboot_header {
|
||||||
char ih_name[32]; /* image name */
|
char ih_name[32]; /* image name */
|
||||||
};
|
};
|
||||||
|
|
||||||
|
/************************************************/
|
||||||
|
|
||||||
|
static struct mtd_info *adm8668_mtd;
|
||||||
|
|
||||||
|
struct map_info adm8668_map = {
|
||||||
|
name: "adm8668-nor",
|
||||||
|
size: WINDOW_SIZE,
|
||||||
|
phys: WINDOW_ADDR,
|
||||||
|
bankwidth: BANKWIDTH,
|
||||||
|
};
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Copied from mtdblock.c
|
||||||
|
*
|
||||||
|
* Cache stuff...
|
||||||
|
*
|
||||||
|
* Since typical flash erasable sectors are much larger than what Linux's
|
||||||
|
* buffer cache can handle, we must implement read-modify-write on flash
|
||||||
|
* sectors for each block write requests. To avoid over-erasing flash sectors
|
||||||
|
* and to speed things up, we locally cache a whole flash sector while it is
|
||||||
|
* being written to until a different sector is required.
|
||||||
|
*/
|
||||||
|
|
||||||
|
static void erase_callback(struct erase_info *done)
|
||||||
|
{
|
||||||
|
wait_queue_head_t *wait_q = (wait_queue_head_t *)done->priv;
|
||||||
|
wake_up(wait_q);
|
||||||
|
}
|
||||||
|
|
||||||
|
static int erase_write (struct mtd_info *mtd, unsigned long pos,
|
||||||
|
int len, const char *buf)
|
||||||
|
{
|
||||||
|
struct erase_info erase;
|
||||||
|
DECLARE_WAITQUEUE(wait, current);
|
||||||
|
wait_queue_head_t wait_q;
|
||||||
|
size_t retlen;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* First, let's erase the flash block.
|
||||||
|
*/
|
||||||
|
|
||||||
|
init_waitqueue_head(&wait_q);
|
||||||
|
erase.mtd = mtd;
|
||||||
|
erase.callback = erase_callback;
|
||||||
|
erase.addr = pos;
|
||||||
|
erase.len = len;
|
||||||
|
erase.priv = (u_long)&wait_q;
|
||||||
|
|
||||||
|
set_current_state(TASK_INTERRUPTIBLE);
|
||||||
|
add_wait_queue(&wait_q, &wait);
|
||||||
|
|
||||||
|
ret = mtd->erase(mtd, &erase);
|
||||||
|
if (ret) {
|
||||||
|
set_current_state(TASK_RUNNING);
|
||||||
|
remove_wait_queue(&wait_q, &wait);
|
||||||
|
printk (KERN_WARNING "erase of region [0x%lx, 0x%x] "
|
||||||
|
"on \"%s\" failed\n",
|
||||||
|
pos, len, mtd->name);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
schedule(); /* Wait for erase to finish. */
|
||||||
|
remove_wait_queue(&wait_q, &wait);
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Next, write data to flash.
|
||||||
|
*/
|
||||||
|
|
||||||
|
ret = mtd->write (mtd, pos, len, &retlen, buf);
|
||||||
|
if (ret)
|
||||||
|
return ret;
|
||||||
|
if (retlen != len)
|
||||||
|
return -EIO;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* decent defaults in case... shrug */
|
||||||
|
static struct mtd_partition adm8668_parts[] = {
|
||||||
|
{ name: "linux", offset: 0x40000, size: WINDOW_SIZE-0x40000, },
|
||||||
|
{ name: "rootfs", offset: 0xe0000, size: 0x140000, },
|
||||||
|
{ name: "uboot_env", offset: 0x20000, size: 0x20000, },
|
||||||
|
{ name: NULL, },
|
||||||
|
};
|
||||||
|
|
||||||
/* in case i wanna change stuff later, and to clarify the math section... */
|
/* in case i wanna change stuff later, and to clarify the math section... */
|
||||||
#define PART_LINUX 0
|
#define PART_LINUX 0
|
||||||
#define PART_ROOTFS 1
|
#define PART_ROOTFS 1
|
||||||
#define PART_UBOOT_ENV 2
|
|
||||||
#define NR_PARTS 3
|
#define NR_PARTS 3
|
||||||
|
|
||||||
static int adm8668_parse_partitions(struct mtd_info *master,
|
static int __init
|
||||||
struct mtd_partition **pparts,
|
init_mtd_partitions(struct mtd_info *mtd, size_t size)
|
||||||
struct mtd_part_parser_data *data)
|
|
||||||
{
|
{
|
||||||
int ret;
|
|
||||||
struct uboot_header uhdr;
|
struct uboot_header uhdr;
|
||||||
int off, blocksize;
|
int off, blocksize;
|
||||||
size_t len, linux_len;
|
size_t len, linux_len;
|
||||||
struct squashfs_super_block shdr;
|
struct squashfs_super_block shdr;
|
||||||
struct erase_info erase_info;
|
|
||||||
struct mtd_partition *adm8668_parts;
|
|
||||||
|
|
||||||
memset(&erase_info, 0, sizeof(erase_info));
|
|
||||||
|
|
||||||
blocksize = master->erasesize;
|
|
||||||
|
|
||||||
|
blocksize = mtd->erasesize;
|
||||||
if (blocksize < 0x10000)
|
if (blocksize < 0x10000)
|
||||||
blocksize = 0x10000;
|
blocksize = 0x10000;
|
||||||
|
|
||||||
adm8668_parts = kzalloc(sizeof(*adm8668_parts) * NR_PARTS, GFP_KERNEL);
|
|
||||||
if (!adm8668_parts)
|
|
||||||
return -ENOMEM;
|
|
||||||
|
|
||||||
adm8668_parts[PART_LINUX].name = kstrdup("linux", GFP_KERNEL);
|
|
||||||
adm8668_parts[PART_LINUX].offset = 0x40000;
|
|
||||||
adm8668_parts[PART_LINUX].size = master->size - 0x40000;
|
|
||||||
adm8668_parts[PART_ROOTFS].name = kstrdup("rootfs", GFP_KERNEL);
|
|
||||||
adm8668_parts[PART_ROOTFS].offset = 0xe0000;
|
|
||||||
adm8668_parts[PART_ROOTFS].size = 0x140000;
|
|
||||||
adm8668_parts[PART_UBOOT_ENV].name = kstrdup("uboot_env", GFP_KERNEL);
|
|
||||||
adm8668_parts[PART_UBOOT_ENV].offset = 0x20000;
|
|
||||||
adm8668_parts[PART_UBOOT_ENV].size = 0x20000;
|
|
||||||
|
|
||||||
/* now find squashfs */
|
/* now find squashfs */
|
||||||
memset(&shdr, 0xe5, sizeof(shdr));
|
memset(&shdr, 0xe5, sizeof(shdr));
|
||||||
|
for (off = adm8668_parts[PART_LINUX].offset; off < size; off += blocksize) {
|
||||||
for (off = 0x40000; off < master->size; off += blocksize) {
|
|
||||||
/*
|
/*
|
||||||
* Read into buffer
|
* Read into buffer
|
||||||
*/
|
*/
|
||||||
if (mtd_read(master, off, sizeof(shdr), &len, (char *)&shdr) ||
|
if (mtd->read(mtd, off, sizeof(shdr), &len, (char *)&shdr) ||
|
||||||
len != sizeof(shdr))
|
len != sizeof(shdr))
|
||||||
continue;
|
continue;
|
||||||
|
|
||||||
if (shdr.s_magic == SQUASHFS_MAGIC) {
|
if (shdr.s_magic == SQUASHFS_MAGIC) {
|
||||||
uint32_t fs_size = (uint32_t)shdr.bytes_used;
|
uint32_t fs_size = (uint32_t)shdr.bytes_used;
|
||||||
|
|
||||||
pr_info(PFX "filesystem type: squashfs, size=%dkB\n",
|
printk(KERN_INFO "%s: Filesystem type: squashfs, size=%dkB\n",
|
||||||
fs_size >> 10);
|
mtd->name, fs_size>>10);
|
||||||
|
|
||||||
/*
|
/* Update rootfs based on the superblock info, and
|
||||||
* Update rootfs based on the superblock info, and
|
* stretch to end of MTD. rootfs_split will split it */
|
||||||
* stretch to end of MTD. rootfs_split will split it
|
|
||||||
*/
|
|
||||||
adm8668_parts[PART_ROOTFS].offset = off;
|
adm8668_parts[PART_ROOTFS].offset = off;
|
||||||
adm8668_parts[PART_ROOTFS].size = master->size -
|
adm8668_parts[PART_ROOTFS].size = mtd->size -
|
||||||
adm8668_parts[PART_ROOTFS].offset;
|
adm8668_parts[PART_ROOTFS].offset;
|
||||||
|
|
||||||
/*
|
/* kernel ends where rootfs starts
|
||||||
* kernel ends where rootfs starts
|
* but we'll keep it full-length for upgrades */
|
||||||
* but we'll keep it full-length for upgrades
|
linux_len = adm8668_parts[PART_LINUX+1].offset -
|
||||||
*/
|
|
||||||
linux_len = adm8668_parts[PART_LINUX + 1].offset -
|
|
||||||
adm8668_parts[PART_LINUX].offset;
|
adm8668_parts[PART_LINUX].offset;
|
||||||
|
#if 1
|
||||||
adm8668_parts[PART_LINUX].size = master->size -
|
adm8668_parts[PART_LINUX].size = mtd->size -
|
||||||
adm8668_parts[PART_LINUX].offset;
|
adm8668_parts[PART_LINUX].offset;
|
||||||
|
#else
|
||||||
|
adm8668_parts[PART_LINUX].size = linux_len;
|
||||||
|
#endif
|
||||||
goto found;
|
goto found;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
pr_err(PFX "could't find root filesystem\n");
|
printk(KERN_NOTICE
|
||||||
|
"%s: Couldn't find root filesystem\n",
|
||||||
|
mtd->name);
|
||||||
return NR_PARTS;
|
return NR_PARTS;
|
||||||
|
|
||||||
found:
|
found:
|
||||||
if (mtd_read(master, adm8668_parts[PART_LINUX].offset, sizeof(uhdr), &len, (char *)&uhdr) ||
|
if (mtd->read(mtd, adm8668_parts[PART_LINUX].offset, sizeof(uhdr), &len, (char *)&uhdr) ||
|
||||||
len != sizeof(uhdr)) {
|
len != sizeof(uhdr))
|
||||||
pr_err(PFX "failed to read u-boot header\n");
|
|
||||||
return NR_PARTS;
|
return NR_PARTS;
|
||||||
}
|
|
||||||
|
|
||||||
if (uhdr.ih_magic != IH_MAGIC) {
|
/* that's odd. how'd ya boot it then */
|
||||||
pr_info(PFX "invalid u-boot magic detected?!?!\n");
|
if (uhdr.ih_magic != IH_MAGIC)
|
||||||
return NR_PARTS;
|
return NR_PARTS;
|
||||||
}
|
|
||||||
|
|
||||||
if (be32_to_cpu(uhdr.ih_size) != (linux_len - sizeof(uhdr))) {
|
if (be32_to_cpu(uhdr.ih_size) != (linux_len - sizeof(uhdr))) {
|
||||||
u32 data;
|
unsigned char *block, *data;
|
||||||
size_t data_len = 0;
|
|
||||||
unsigned char *block;
|
|
||||||
unsigned int offset;
|
unsigned int offset;
|
||||||
|
|
||||||
offset = adm8668_parts[PART_LINUX].offset +
|
offset = adm8668_parts[PART_LINUX].offset +
|
||||||
sizeof(struct uboot_header);
|
sizeof(struct uboot_header);
|
||||||
|
data = (unsigned char *)(WINDOW_ADDR | 0xA0000000 | offset);
|
||||||
|
|
||||||
pr_info(PFX "Updating U-boot image:\n");
|
printk(KERN_NOTICE "Updating U-boot image:\n");
|
||||||
pr_info(PFX " old: [size: %8d crc32: 0x%08x]\n",
|
printk(KERN_NOTICE " old: [size: %8d crc32: 0x%08x]\n",
|
||||||
be32_to_cpu(uhdr.ih_size), be32_to_cpu(uhdr.ih_dcrc));
|
be32_to_cpu(uhdr.ih_size), be32_to_cpu(uhdr.ih_dcrc));
|
||||||
|
|
||||||
if (mtd_read(master, offset, sizeof(data), &data_len, (char *)&data)) {
|
|
||||||
pr_err(PFX "failed to read data\n");
|
|
||||||
goto out;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Update the data length & crc32 */
|
/* Update the data length & crc32 */
|
||||||
uhdr.ih_size = cpu_to_be32(linux_len - sizeof(uhdr));
|
uhdr.ih_size = cpu_to_be32(linux_len - sizeof(uhdr));
|
||||||
uhdr.ih_dcrc = crc32_le(~0, (char *)&data, linux_len - sizeof(uhdr)) ^ (~0);
|
uhdr.ih_dcrc = crc32_le(~0, data, linux_len - sizeof(uhdr)) ^ (~0);
|
||||||
uhdr.ih_dcrc = cpu_to_be32(uhdr.ih_dcrc);
|
uhdr.ih_dcrc = cpu_to_be32(uhdr.ih_dcrc);
|
||||||
|
|
||||||
pr_info(PFX " new: [size: %8d crc32: 0x%08x]\n",
|
printk(KERN_NOTICE " new: [size: %8d crc32: 0x%08x]\n",
|
||||||
be32_to_cpu(uhdr.ih_size), be32_to_cpu(uhdr.ih_dcrc));
|
be32_to_cpu(uhdr.ih_size), be32_to_cpu(uhdr.ih_dcrc));
|
||||||
|
|
||||||
/* update header's crc... */
|
/* update header's crc... */
|
||||||
|
@ -200,66 +260,75 @@ found:
|
||||||
uhdr.ih_hcrc = cpu_to_be32(uhdr.ih_hcrc);
|
uhdr.ih_hcrc = cpu_to_be32(uhdr.ih_hcrc);
|
||||||
|
|
||||||
/* read first eraseblock from the image */
|
/* read first eraseblock from the image */
|
||||||
block = vmalloc(master->erasesize);
|
block = kmalloc(mtd->erasesize, GFP_KERNEL);
|
||||||
if (!block)
|
if (mtd->read(mtd, adm8668_parts[PART_LINUX].offset, mtd->erasesize, &len, block) || len != mtd->erasesize) {
|
||||||
return -ENOMEM;
|
printk("Error copying first eraseblock\n");
|
||||||
|
|
||||||
if (mtd_read(master, adm8668_parts[PART_LINUX].offset, master->erasesize, &len, block)
|
|
||||||
|| len != master->erasesize) {
|
|
||||||
pr_err(PFX "error copying first eraseblock\n");
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Write updated header to the flash */
|
/* Write updated header to the flash */
|
||||||
memcpy(block, &uhdr, sizeof(uhdr));
|
memcpy(block, &uhdr, sizeof(uhdr));
|
||||||
if (master->unlock)
|
if (mtd->unlock)
|
||||||
master->unlock(master, off, master->erasesize);
|
mtd->unlock(mtd, off, mtd->erasesize);
|
||||||
|
erase_write(mtd, adm8668_parts[PART_LINUX].offset, mtd->erasesize, block);
|
||||||
erase_info.mtd = master;
|
if (mtd->sync)
|
||||||
erase_info.addr = (uint64_t)adm8668_parts[PART_LINUX].offset;
|
mtd->sync(mtd);
|
||||||
erase_info.len = master->erasesize;
|
kfree(block);
|
||||||
ret = mtd_erase(master, &erase_info);
|
printk(KERN_NOTICE "Done\n");
|
||||||
if (!ret) {
|
|
||||||
if (mtd_write(master, adm8668_parts[PART_LINUX].offset, master->erasesize,
|
|
||||||
&len, block))
|
|
||||||
pr_err(PFX "write failed");
|
|
||||||
} else
|
|
||||||
pr_err(PFX "erase failed");
|
|
||||||
|
|
||||||
mtd_sync(master);
|
|
||||||
out:
|
|
||||||
if (block)
|
|
||||||
vfree(block);
|
|
||||||
pr_info(PFX "done\n");
|
|
||||||
}
|
}
|
||||||
|
|
||||||
*pparts = adm8668_parts;
|
|
||||||
|
|
||||||
return NR_PARTS;
|
return NR_PARTS;
|
||||||
}
|
}
|
||||||
|
|
||||||
static struct mtd_part_parser adm8668_parser = {
|
int __init init_adm8668_map(void)
|
||||||
.owner = THIS_MODULE,
|
|
||||||
.parse_fn = adm8668_parse_partitions,
|
|
||||||
.name = "adm8668part",
|
|
||||||
};
|
|
||||||
|
|
||||||
static int __init adm8668_parser_init(void)
|
|
||||||
{
|
{
|
||||||
register_mtd_parser(&adm8668_parser);
|
int nr_parts, ret;
|
||||||
|
|
||||||
|
adm8668_map.virt = ioremap(WINDOW_ADDR, WINDOW_SIZE);
|
||||||
|
|
||||||
|
if (!adm8668_map.virt) {
|
||||||
|
printk(KERN_ERR "Failed to ioremap\n");
|
||||||
|
return -EIO;
|
||||||
|
}
|
||||||
|
|
||||||
|
simple_map_init(&adm8668_map);
|
||||||
|
if (!(adm8668_mtd = do_map_probe("cfi_probe", &adm8668_map))) {
|
||||||
|
printk(KERN_ERR "cfi_probe failed\n");
|
||||||
|
iounmap((void *)adm8668_map.virt);
|
||||||
|
return -ENXIO;
|
||||||
|
}
|
||||||
|
|
||||||
|
adm8668_mtd->owner = THIS_MODULE;
|
||||||
|
|
||||||
|
nr_parts = init_mtd_partitions(adm8668_mtd, adm8668_mtd->size);
|
||||||
|
ret = mtd_device_register(adm8668_mtd, adm8668_parts, nr_parts);
|
||||||
|
if (ret) {
|
||||||
|
printk(KERN_ERR "Flash: mtd_device_register failed\n");
|
||||||
|
goto fail;
|
||||||
|
}
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
|
fail:
|
||||||
|
if (adm8668_mtd)
|
||||||
|
map_destroy(adm8668_mtd);
|
||||||
|
if (adm8668_map.virt)
|
||||||
|
iounmap((void *) adm8668_map.virt);
|
||||||
|
adm8668_map.virt = 0;
|
||||||
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void __exit adm8668_parser_exit(void)
|
void __exit cleanup_adm8668_map(void)
|
||||||
{
|
{
|
||||||
deregister_mtd_parser(&adm8668_parser);
|
mtd_device_unregister(adm8668_mtd);
|
||||||
|
map_destroy(adm8668_mtd);
|
||||||
|
iounmap((void *) adm8668_map.virt);
|
||||||
|
adm8668_map.virt = 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
module_init(adm8668_parser_init);
|
module_init(init_adm8668_map);
|
||||||
module_exit(adm8668_parser_exit);
|
module_exit(cleanup_adm8668_map);
|
||||||
|
|
||||||
MODULE_LICENSE("GPL");
|
MODULE_LICENSE("GPL");
|
||||||
MODULE_AUTHOR("Scott Nicholas <neutronscott@scottn.us>");
|
MODULE_AUTHOR("Scott Nicholas <neutronscott@scottn.us>");
|
||||||
MODULE_AUTHOR("Florian Fainelli <florian@openwrt.org>");
|
MODULE_DESCRIPTION("MTD map driver for ADM8668 NOR Flash");
|
||||||
MODULE_DESCRIPTION("MTD partition parser for ADM8668");
|
|
||||||
|
|
|
@ -4,11 +4,11 @@
|
||||||
default "0x02000000"
|
default "0x02000000"
|
||||||
depends on MSP_FLASH_MAP_LIMIT_32M
|
depends on MSP_FLASH_MAP_LIMIT_32M
|
||||||
|
|
||||||
+config MTD_ADM8668_PARTS
|
+config MTD_ADM8668_NOR
|
||||||
+ tristate "ADM8668 partition parser"
|
+ tristate "ADM8668 NOR mapping"
|
||||||
+ depends on ADM8668
|
+ depends on ADM8668 && MTD_CFI
|
||||||
+ help
|
+ help
|
||||||
+ Partition parser for the Infineon/ADMTek ADM8668 (WildPass).
|
+ mapping driver for ADM8668 NOR
|
||||||
+
|
+
|
||||||
config MTD_SUN_UFLASH
|
config MTD_SUN_UFLASH
|
||||||
tristate "Sun Microsystems userflash support"
|
tristate "Sun Microsystems userflash support"
|
||||||
|
@ -19,7 +19,7 @@
|
||||||
endif
|
endif
|
||||||
|
|
||||||
# Chip mappings
|
# Chip mappings
|
||||||
+obj-$(CONFIG_MTD_ADM8668_PARTS) += adm8668.o
|
+obj-$(CONFIG_MTD_ADM8668_NOR) += adm8668.o
|
||||||
obj-$(CONFIG_MTD_CDB89712) += cdb89712.o
|
obj-$(CONFIG_MTD_CDB89712) += cdb89712.o
|
||||||
obj-$(CONFIG_MTD_CFI_FLAGADM) += cfi_flagadm.o
|
obj-$(CONFIG_MTD_CFI_FLAGADM) += cfi_flagadm.o
|
||||||
obj-$(CONFIG_MTD_DC21285) += dc21285.o
|
obj-$(CONFIG_MTD_DC21285) += dc21285.o
|
||||||
|
|
Loading…
Reference in a new issue