2005-04-16 22:20:36 +00:00
|
|
|
/*======================================================================
|
|
|
|
|
|
|
|
drivers/mtd/afs.c: ARM Flash Layout/Partitioning
|
2005-11-07 11:15:26 +00:00
|
|
|
|
2010-08-08 19:58:20 +00:00
|
|
|
Copyright © 2000 ARM Limited
|
2005-11-07 11:15:26 +00:00
|
|
|
|
2005-04-16 22:20:36 +00:00
|
|
|
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.
|
2005-11-07 11:15:26 +00:00
|
|
|
|
2005-04-16 22:20:36 +00:00
|
|
|
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.
|
2005-11-07 11:15:26 +00:00
|
|
|
|
2005-04-16 22:20:36 +00:00
|
|
|
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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
2005-11-07 11:15:26 +00:00
|
|
|
|
|
|
|
This is access code for flashes using ARM's flash partitioning
|
2005-04-16 22:20:36 +00:00
|
|
|
standards.
|
|
|
|
|
|
|
|
======================================================================*/
|
|
|
|
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/types.h>
|
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/slab.h>
|
|
|
|
#include <linux/string.h>
|
|
|
|
#include <linux/init.h>
|
|
|
|
|
|
|
|
#include <linux/mtd/mtd.h>
|
|
|
|
#include <linux/mtd/map.h>
|
|
|
|
#include <linux/mtd/partitions.h>
|
|
|
|
|
2015-10-15 13:08:46 +00:00
|
|
|
#define AFSV1_FOOTER_MAGIC 0xA0FFFF9F
|
|
|
|
|
2015-10-15 13:08:44 +00:00
|
|
|
struct footer_v1 {
|
2005-04-16 22:20:36 +00:00
|
|
|
u32 image_info_base; /* Address of first word of ImageFooter */
|
|
|
|
u32 image_start; /* Start of area reserved by this footer */
|
|
|
|
u32 signature; /* 'Magic' number proves it's a footer */
|
|
|
|
u32 type; /* Area type: ARM Image, SIB, customer */
|
|
|
|
u32 checksum; /* Just this structure */
|
|
|
|
};
|
|
|
|
|
2015-10-15 13:08:44 +00:00
|
|
|
struct image_info_v1 {
|
2005-04-16 22:20:36 +00:00
|
|
|
u32 bootFlags; /* Boot flags, compression etc. */
|
|
|
|
u32 imageNumber; /* Unique number, selects for boot etc. */
|
|
|
|
u32 loadAddress; /* Address program should be loaded to */
|
|
|
|
u32 length; /* Actual size of image */
|
|
|
|
u32 address; /* Image is executed from here */
|
|
|
|
char name[16]; /* Null terminated */
|
|
|
|
u32 headerBase; /* Flash Address of any stripped header */
|
|
|
|
u32 header_length; /* Length of header in memory */
|
|
|
|
u32 headerType; /* AIF, RLF, s-record etc. */
|
|
|
|
u32 checksum; /* Image checksum (inc. this struct) */
|
|
|
|
};
|
|
|
|
|
|
|
|
static u32 word_sum(void *words, int num)
|
|
|
|
{
|
|
|
|
u32 *p = words;
|
|
|
|
u32 sum = 0;
|
|
|
|
|
|
|
|
while (num--)
|
|
|
|
sum += *p++;
|
|
|
|
|
|
|
|
return sum;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
2015-10-15 13:08:44 +00:00
|
|
|
afs_read_footer_v1(struct mtd_info *mtd, u_int *img_start, u_int *iis_start,
|
|
|
|
u_int off, u_int mask)
|
2005-04-16 22:20:36 +00:00
|
|
|
{
|
2015-10-15 13:08:44 +00:00
|
|
|
struct footer_v1 fs;
|
2005-04-16 22:20:36 +00:00
|
|
|
u_int ptr = off + mtd->erasesize - sizeof(fs);
|
|
|
|
size_t sz;
|
|
|
|
int ret;
|
|
|
|
|
2011-12-23 15:30:16 +00:00
|
|
|
ret = mtd_read(mtd, ptr, sizeof(fs), &sz, (u_char *)&fs);
|
2005-04-16 22:20:36 +00:00
|
|
|
if (ret >= 0 && sz != sizeof(fs))
|
|
|
|
ret = -EINVAL;
|
|
|
|
|
|
|
|
if (ret < 0) {
|
|
|
|
printk(KERN_ERR "AFS: mtd read failed at 0x%x: %d\n",
|
|
|
|
ptr, ret);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Does it contain the magic number?
|
|
|
|
*/
|
2015-10-15 13:08:46 +00:00
|
|
|
if (fs.signature != AFSV1_FOOTER_MAGIC)
|
2015-10-15 13:08:47 +00:00
|
|
|
return 0;
|
2005-04-16 22:20:36 +00:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Check the checksum.
|
|
|
|
*/
|
|
|
|
if (word_sum(&fs, sizeof(fs) / sizeof(u32)) != 0xffffffff)
|
2015-10-15 13:08:47 +00:00
|
|
|
return 0;
|
2005-04-16 22:20:36 +00:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Don't touch the SIB.
|
|
|
|
*/
|
|
|
|
if (fs.type == 2)
|
2015-10-15 13:08:47 +00:00
|
|
|
return 0;
|
2005-04-16 22:20:36 +00:00
|
|
|
|
|
|
|
*iis_start = fs.image_info_base & mask;
|
|
|
|
*img_start = fs.image_start & mask;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Check the image info base. This can not
|
|
|
|
* be located after the footer structure.
|
|
|
|
*/
|
|
|
|
if (*iis_start >= ptr)
|
2015-10-15 13:08:47 +00:00
|
|
|
return 0;
|
2005-04-16 22:20:36 +00:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Check the start of this image. The image
|
|
|
|
* data can not be located after this block.
|
|
|
|
*/
|
|
|
|
if (*img_start > off)
|
2015-10-15 13:08:47 +00:00
|
|
|
return 0;
|
2005-04-16 22:20:36 +00:00
|
|
|
|
2015-10-15 13:08:47 +00:00
|
|
|
return 1;
|
2005-04-16 22:20:36 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
2015-10-15 13:08:44 +00:00
|
|
|
afs_read_iis_v1(struct mtd_info *mtd, struct image_info_v1 *iis, u_int ptr)
|
2005-04-16 22:20:36 +00:00
|
|
|
{
|
|
|
|
size_t sz;
|
|
|
|
int ret, i;
|
|
|
|
|
|
|
|
memset(iis, 0, sizeof(*iis));
|
2011-12-23 15:30:16 +00:00
|
|
|
ret = mtd_read(mtd, ptr, sizeof(*iis), &sz, (u_char *)iis);
|
2005-04-16 22:20:36 +00:00
|
|
|
if (ret < 0)
|
|
|
|
goto failed;
|
|
|
|
|
|
|
|
if (sz != sizeof(*iis)) {
|
|
|
|
ret = -EINVAL;
|
|
|
|
goto failed;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = 0;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Validate the name - it must be NUL terminated.
|
|
|
|
*/
|
|
|
|
for (i = 0; i < sizeof(iis->name); i++)
|
|
|
|
if (iis->name[i] == '\0')
|
|
|
|
break;
|
|
|
|
|
|
|
|
if (i < sizeof(iis->name))
|
|
|
|
ret = 1;
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
failed:
|
|
|
|
printk(KERN_ERR "AFS: mtd read failed at 0x%x: %d\n",
|
|
|
|
ptr, ret);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2005-11-07 11:15:26 +00:00
|
|
|
static int parse_afs_partitions(struct mtd_info *mtd,
|
2011-06-10 14:18:28 +00:00
|
|
|
struct mtd_partition **pparts,
|
|
|
|
struct mtd_part_parser_data *data)
|
2005-04-16 22:20:36 +00:00
|
|
|
{
|
|
|
|
struct mtd_partition *parts;
|
|
|
|
u_int mask, off, idx, sz;
|
|
|
|
int ret = 0;
|
|
|
|
char *str;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* This is the address mask; we use this to mask off out of
|
|
|
|
* range address bits.
|
|
|
|
*/
|
|
|
|
mask = mtd->size - 1;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* First, calculate the size of the array we need for the
|
|
|
|
* partition information. We include in this the size of
|
|
|
|
* the strings.
|
|
|
|
*/
|
|
|
|
for (idx = off = sz = 0; off < mtd->size; off += mtd->erasesize) {
|
2015-10-15 13:08:44 +00:00
|
|
|
struct image_info_v1 iis;
|
2005-04-16 22:20:36 +00:00
|
|
|
u_int iis_ptr, img_ptr;
|
|
|
|
|
2015-10-15 13:08:44 +00:00
|
|
|
ret = afs_read_footer_v1(mtd, &img_ptr, &iis_ptr, off, mask);
|
2005-04-16 22:20:36 +00:00
|
|
|
if (ret < 0)
|
|
|
|
break;
|
2015-10-15 13:08:47 +00:00
|
|
|
if (ret) {
|
|
|
|
ret = afs_read_iis_v1(mtd, &iis, iis_ptr);
|
|
|
|
if (ret < 0)
|
|
|
|
break;
|
|
|
|
if (ret == 0)
|
|
|
|
continue;
|
|
|
|
|
|
|
|
sz += sizeof(struct mtd_partition);
|
|
|
|
sz += strlen(iis.name) + 1;
|
|
|
|
idx += 1;
|
|
|
|
}
|
2005-04-16 22:20:36 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
if (!sz)
|
|
|
|
return ret;
|
|
|
|
|
2006-11-15 19:10:29 +00:00
|
|
|
parts = kzalloc(sz, GFP_KERNEL);
|
2005-04-16 22:20:36 +00:00
|
|
|
if (!parts)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
str = (char *)(parts + idx);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Identify the partitions
|
|
|
|
*/
|
|
|
|
for (idx = off = 0; off < mtd->size; off += mtd->erasesize) {
|
2015-10-15 13:08:44 +00:00
|
|
|
struct image_info_v1 iis;
|
2005-06-30 22:01:09 +00:00
|
|
|
u_int iis_ptr, img_ptr;
|
2005-04-16 22:20:36 +00:00
|
|
|
|
|
|
|
/* Read the footer. */
|
2015-10-15 13:08:44 +00:00
|
|
|
ret = afs_read_footer_v1(mtd, &img_ptr, &iis_ptr, off, mask);
|
2005-04-16 22:20:36 +00:00
|
|
|
if (ret < 0)
|
|
|
|
break;
|
|
|
|
if (ret == 0)
|
|
|
|
continue;
|
|
|
|
|
|
|
|
/* Read the image info block */
|
2015-10-15 13:08:44 +00:00
|
|
|
ret = afs_read_iis_v1(mtd, &iis, iis_ptr);
|
2005-04-16 22:20:36 +00:00
|
|
|
if (ret < 0)
|
|
|
|
break;
|
|
|
|
if (ret == 0)
|
|
|
|
continue;
|
|
|
|
|
|
|
|
strcpy(str, iis.name);
|
|
|
|
|
|
|
|
parts[idx].name = str;
|
2005-06-30 22:01:09 +00:00
|
|
|
parts[idx].size = (iis.length + mtd->erasesize - 1) & ~(mtd->erasesize - 1);
|
2005-04-16 22:20:36 +00:00
|
|
|
parts[idx].offset = img_ptr;
|
|
|
|
parts[idx].mask_flags = 0;
|
|
|
|
|
2009-07-18 13:10:44 +00:00
|
|
|
printk(" mtd%d: at 0x%08x, %5lluKiB, %8u, %s\n",
|
2005-04-16 22:20:36 +00:00
|
|
|
idx, img_ptr, parts[idx].size / 1024,
|
|
|
|
iis.imageNumber, str);
|
|
|
|
|
|
|
|
idx += 1;
|
|
|
|
str = str + strlen(iis.name) + 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!idx) {
|
|
|
|
kfree(parts);
|
|
|
|
parts = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
*pparts = parts;
|
|
|
|
return idx ? idx : ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static struct mtd_part_parser afs_parser = {
|
|
|
|
.parse_fn = parse_afs_partitions,
|
|
|
|
.name = "afs",
|
|
|
|
};
|
2015-11-12 03:13:30 +00:00
|
|
|
module_mtd_part_parser(afs_parser);
|
2005-04-16 22:20:36 +00:00
|
|
|
|
|
|
|
MODULE_AUTHOR("ARM Ltd");
|
|
|
|
MODULE_DESCRIPTION("ARM Firmware Suite partition parser");
|
|
|
|
MODULE_LICENSE("GPL");
|