/*====================================================================== drivers/mtd/afs.c: ARM Flash Layout/Partitioning Copyright © 2000 ARM Limited 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 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. 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 This is access code for flashes using ARM's flash partitioning standards. ======================================================================*/ #include #include #include #include #include #include #include #include #include #define AFSV1_FOOTER_MAGIC 0xA0FFFF9F struct footer_v1 { 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 */ }; struct image_info_v1 { 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 bool afs_is_v1(struct mtd_info *mtd, u_int off) { /* The magic is 12 bytes from the end of the erase block */ u_int ptr = off + mtd->erasesize - 12; u32 magic; size_t sz; int ret; ret = mtd_read(mtd, ptr, 4, &sz, (u_char *)&magic); if (ret < 0) { printk(KERN_ERR "AFS: mtd read failed at 0x%x: %d\n", ptr, ret); return false; } if (ret >= 0 && sz != 4) return false; return (magic == AFSV1_FOOTER_MAGIC); } static int afs_read_iis_v1(struct mtd_info *mtd, struct image_info_v1 *iis, u_int ptr) { size_t sz; int ret, i; memset(iis, 0, sizeof(*iis)); ret = mtd_read(mtd, ptr, sizeof(*iis), &sz, (u_char *)iis); 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; } static int afs_parse_v1_partition(struct mtd_info *mtd, u_int off, struct mtd_partition *part) { struct footer_v1 fs; struct image_info_v1 iis; u_int mask; /* * Static checks cannot see that we bail out if we have an error * reading the footer. */ u_int uninitialized_var(iis_ptr); u_int uninitialized_var(img_ptr); u_int ptr; size_t sz; int ret; /* * This is the address mask; we use this to mask off out of * range address bits. */ mask = mtd->size - 1; ptr = off + mtd->erasesize - sizeof(fs); ret = mtd_read(mtd, ptr, sizeof(fs), &sz, (u_char *)&fs); 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; } /* * Check the checksum. */ if (word_sum(&fs, sizeof(fs) / sizeof(u32)) != 0xffffffff) return -EINVAL; /* * Hide the SIB (System Information Block) */ if (fs.type == 2) return 0; iis_ptr = fs.image_info_base & mask; img_ptr = fs.image_start & mask; /* * Check the image info base. This can not * be located after the footer structure. */ if (iis_ptr >= ptr) return 0; /* * Check the start of this image. The image * data can not be located after this block. */ if (img_ptr > off) return 0; /* Read the image info block */ ret = afs_read_iis_v1(mtd, &iis, iis_ptr); if (ret < 0) return ret; part->name = kstrdup(iis.name, GFP_KERNEL); if (!part->name) return -ENOMEM; part->size = (iis.length + mtd->erasesize - 1) & ~(mtd->erasesize - 1); part->offset = img_ptr; part->mask_flags = 0; printk(" mtd: at 0x%08x, %5lluKiB, %8u, %s\n", img_ptr, part->size / 1024, iis.imageNumber, part->name); return 0; } static int parse_afs_partitions(struct mtd_info *mtd, const struct mtd_partition **pparts, struct mtd_part_parser_data *data) { struct mtd_partition *parts; u_int off, sz; int ret = 0; int i; /* Count the partitions by looping over all erase blocks */ for (i = off = sz = 0; off < mtd->size; off += mtd->erasesize) { if (afs_is_v1(mtd, off)) { sz += sizeof(struct mtd_partition); i += 1; } } if (!i) return 0; parts = kzalloc(sz, GFP_KERNEL); if (!parts) return -ENOMEM; /* * Identify the partitions */ for (i = off = 0; off < mtd->size; off += mtd->erasesize) { if (afs_is_v1(mtd, off)) { ret = afs_parse_v1_partition(mtd, off, &parts[i]); if (ret) goto out_free_parts; i++; } } *pparts = parts; return i; out_free_parts: while (i >= 0) { if (parts[i].name) kfree(parts[i].name); i--; } kfree(parts); *pparts = NULL; return ret; } static const struct of_device_id mtd_parser_afs_of_match_table[] = { { .compatible = "arm,arm-firmware-suite" }, {}, }; MODULE_DEVICE_TABLE(of, mtd_parser_afs_of_match_table); static struct mtd_part_parser afs_parser = { .parse_fn = parse_afs_partitions, .name = "afs", .of_match_table = mtd_parser_afs_of_match_table, }; module_mtd_part_parser(afs_parser); MODULE_AUTHOR("ARM Ltd"); MODULE_DESCRIPTION("ARM Firmware Suite partition parser"); MODULE_LICENSE("GPL");